47 lines
966 B
C
47 lines
966 B
C
|
#ifndef _PORT_IO_H
|
||
|
|
#define _PORT_IO_H
|
||
|
|
|
||
|
|
#include <stdint.h>
|
||
|
|
|
||
|
|
static inline uint32_t inl(uint16_t port)
|
||
|
|
{
|
||
|
|
uint32_t rv;
|
||
|
|
asm volatile ("inl %%dx, %%eax" : "=a" (rv) : "dN" (port));
|
||
|
|
return rv;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void outl(uint16_t port, uint32_t data)
|
||
|
|
{
|
||
|
|
asm volatile ("outl %%eax, %%dx" : : "dN" (port), "a" (data));
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void outb(uint16_t port, uint8_t val)
|
||
|
|
{
|
||
|
|
asm volatile ( "outb %0, %1" : : "a"(val), "Nd"(port) : "memory");
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline uint8_t inb(uint16_t port)
|
||
|
|
{
|
||
|
|
uint8_t ret;
|
||
|
|
asm volatile ( "inb %1, %0"
|
||
|
|
: "=a"(ret)
|
||
|
|
: "Nd"(port)
|
||
|
|
: "memory");
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void io_wait()
|
||
|
|
{
|
||
|
|
outb(0x80, 0);
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void insw(uint16_t port, void* addr, uint32_t count) {
|
||
|
|
__asm__ volatile ("rep insw" : "+D"(addr), "+c"(count) : "d"(port) : "memory");
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void outsw(uint16_t port, const void* addr, uint32_t count) {
|
||
|
|
__asm__ volatile ("rep outsw" : "+S"(addr), "+c"(count) : "d"(port));
|
||
|
|
}
|
||
|
|
|
||
|
|
#endif
|