A update

include/port_io.h

@@ -0,0 +1,46 @@
+#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