portio.hpp

#if !defined(__SYSTEM_L4_X86_PORTIO_HPP__)
#define __SYSTEM_L4_X86_PORTIO_HPP__

//
// L4 includes
//
#include <l4/vmm/api/l4util.h>

#if L4VMM_ARCH_HAS_IOSPACE

//
// standard includes
//
#include <stdint.h>

//
// L4 includes
//
#include <l4/util/port_io.h>

//
// sanity check: do not include the compat header(s) before this file.
//     we need to call the real functions.
//
#if defined(l4util_in8) || defined(l4util_in16) || defined(l4util_in32) ||              \
        defined(l4util_out8) || defined(l4util_out16) || defined(l4util_out32) ||       \
        defined(l4util_ins8) || defined(l4util_ins16) || defined(l4util_ins32) ||       \
        defined(l4util_outs8) || defined(l4util_outs16) || defined(l4util_outs32)
    #error someone included the compat header(s). fix this.
#endif

//
// l4util has no l4util_outs{8,16,32} routines, so define them using inline assembler.
//
namespace detail
{
    #define L4VMM_OUTS(bits, instruction)                                               \
        inline void l4vmm_outs ## bits(const l4_port_t port, const l4_umword_t src,     \
                                       const l4_umword_t num)                           \
        {                                                                               \
            l4_umword_t dummy;                                                          \
            asm volatile ("rep " #instruction                                           \
                              : "=S"(dummy), "=c"(dummy)                                \
                              : "d"(port), "S"(src), "c"(num));                         \
        }

    L4VMM_OUTS(8,  outsb)
    L4VMM_OUTS(16, outsw)
    L4VMM_OUTS(32, outsl)

    #undef L4VMM_OUTS
}

//
// define type to wrap l4util's port I/O functions
//
template <typename>
struct portio
{};

template <>
struct portio<uint8_t>
{
    static inline uint8_t in(const l4_port_t port)
    {
        return l4util_in8(port);
    }

    static inline int out(const l4_port_t port, const uint8_t value)
    {
        l4util_out8(value, port);
        return 0;
    }

    static inline void ins(const l4_port_t port, void *dst, const l4_umword_t num)
    {
        l4util_ins8(port, reinterpret_cast<l4_umword_t>(dst), num);
    }

    static inline void outs(const l4_port_t port, const void *src, const l4_umword_t num)
    {
        detail::l4vmm_outs8(port, reinterpret_cast<l4_umword_t>(src), num);
    }
};

template <>
struct portio<uint16_t>
{
    static inline uint16_t in(const l4_port_t port)
    {
        return l4util_in16(port);
    }

    static inline int out(const l4_port_t port, const uint16_t value)
    {
        l4util_out16(value, port);
        return 0;
    }

    static inline void ins(const l4_port_t port, void *dst, const l4_umword_t num)
    {
        l4util_ins16(port, reinterpret_cast<l4_umword_t>(dst), num);
    }

    static inline void outs(const l4_port_t port, const void *src, const l4_umword_t num)
    {
        detail::l4vmm_outs16(port, reinterpret_cast<l4_umword_t>(src), num);
    }
};

template <>
struct portio<uint32_t>
{
    static inline uint32_t in(const l4_port_t port)
    {
        return l4util_in32(port);
    }

    static inline int out(const l4_port_t port, const uint32_t value)
    {
        l4util_out32(value, port);
        return 0;
    }

    static inline void ins(const l4_port_t port, void *dst, const l4_umword_t num)
    {
        l4util_ins32(port, reinterpret_cast<l4_umword_t>(dst), num);
    }

    static inline void outs(const l4_port_t port, const void *src, const l4_umword_t num)
    {
        detail::l4vmm_outs32(port, reinterpret_cast<l4_umword_t>(src), num);
    }
};

#endif

#endif

// ***** end of source ***** //