Changes in kernel/arch/ia64/include/asm.h [2f23341:314f3a3c] in mainline

File:

• kernel/arch/ia64/include/asm.h (modified) (4 diffs)

kernel/arch/ia64/include/asm.h

@@ -38 +38 @@
 #include <config.h>
 #include <typedefs.h>
-#include <typedefs.h>
 #include <arch/register.h>
+#include <arch/legacyio.h>
 #include <trace.h>
 
-#define IA64_IOSPACE_ADDRESS  0xE001000000000000ULL
-
+#define IO_SPACE_BOUNDARY       ((void *) (64 * 1024))
+
+/** Map the I/O port address to a legacy I/O address. */
+NO_TRACE static inline uintptr_t p2a(volatile void *p)
+{
+        uintptr_t prt = (uintptr_t) p;
+
+        return legacyio_virt_base + (((prt >> 2) << 12) | (prt & 0xfff));
+}
+        
 NO_TRACE static inline void pio_write_8(ioport8_t *port, uint8_t v)
 {
-        uintptr_t prt = (uintptr_t) port;
-        
-        *((ioport8_t *) (IA64_IOSPACE_ADDRESS +
-            ((prt & 0xfff) | ((prt >> 2) << 12)))) = v;
-        
-        asm volatile (
-                "mf\n"
+        if (port < (ioport8_t *) IO_SPACE_BOUNDARY)
+                *((ioport8_t *) p2a(port)) = v;
+        else
+                *port = v;
+        
+        asm volatile (
+                "mf\n"
+                "mf.a\n"
                 ::: "memory"
         );
@@ -59 +68 @@
 NO_TRACE static inline void pio_write_16(ioport16_t *port, uint16_t v)
 {
-        uintptr_t prt = (uintptr_t) port;
-        
-        *((ioport16_t *) (IA64_IOSPACE_ADDRESS +
-            ((prt & 0xfff) | ((prt >> 2) << 12)))) = v;
-        
-        asm volatile (
-                "mf\n"
+        if (port < (ioport16_t *) IO_SPACE_BOUNDARY)
+                *((ioport16_t *) p2a(port)) = v;
+        else
+                *port = v;
+        
+        asm volatile (
+                "mf\n"
+                "mf.a\n"
                 ::: "memory"
         );
@@ -72 +82 @@
 NO_TRACE static inline void pio_write_32(ioport32_t *port, uint32_t v)
 {
-        uintptr_t prt = (uintptr_t) port;
-        
-        *((ioport32_t *) (IA64_IOSPACE_ADDRESS +
-            ((prt & 0xfff) | ((prt >> 2) << 12)))) = v;
-        
-        asm volatile (
-                "mf\n"
+        if (port < (ioport32_t *) IO_SPACE_BOUNDARY)
+                *((ioport32_t *) p2a(port)) = v;
+        else
+                *port = v;
+        
+        asm volatile (
+                "mf\n"
+                "mf.a\n"
                 ::: "memory"
         );
@@ -85 +96 @@
 NO_TRACE static inline uint8_t pio_read_8(ioport8_t *port)
 {
-        uintptr_t prt = (uintptr_t) port;
-        
-        asm volatile (
-                "mf\n"
-                ::: "memory"
-        );
-        
-        return *((ioport8_t *) (IA64_IOSPACE_ADDRESS +
-            ((prt & 0xfff) | ((prt >> 2) << 12))));
+        uint8_t v;
+
+        asm volatile (
+                "mf\n"
+                ::: "memory"
+        );
+
+        if (port < (ioport8_t *) IO_SPACE_BOUNDARY)
+                v = *((ioport8_t *) p2a(port));
+        else
+                v = *port;
+
+        asm volatile (
+                "mf.a\n"
+                ::: "memory"
+        );
+        
+        return v;
 }
 
 NO_TRACE static inline uint16_t pio_read_16(ioport16_t *port)
 {
-        uintptr_t prt = (uintptr_t) port;
-        
-        asm volatile (
-                "mf\n"
-                ::: "memory"
-        );
-        
-        return *((ioport16_t *) (IA64_IOSPACE_ADDRESS +
-            ((prt & 0xfff) | ((prt >> 2) << 12))));
+        uint16_t v;
+
+        asm volatile (
+                "mf\n"
+                ::: "memory"
+        );
+
+        if (port < (ioport16_t *) IO_SPACE_BOUNDARY)
+                v = *((ioport16_t *) p2a(port));
+        else
+                v = *port;
+
+        asm volatile (
+                "mf.a\n"
+                ::: "memory"
+        );
+        
+        return v;
 }
 
 NO_TRACE static inline uint32_t pio_read_32(ioport32_t *port)
 {
-        uintptr_t prt = (uintptr_t) port;
-        
-        asm volatile (
-                "mf\n"
-                ::: "memory"
-        );
-        
-        return *((ioport32_t *) (IA64_IOSPACE_ADDRESS +
-            ((prt & 0xfff) | ((prt >> 2) << 12))));
+        uint32_t v;
+        
+        asm volatile (
+                "mf\n"
+                ::: "memory"
+        );
+        
+        if (port < (ioport32_t *) IO_SPACE_BOUNDARY)
+                v = *((ioport32_t *) p2a(port));
+        else
+                v = *port;
+
+        asm volatile (
+                "mf.a\n"
+                ::: "memory"
+        );
+
+        return v;
 }