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

File:

• kernel/arch/ia64/include/asm.h (modified) (6 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)
 {
-        if (port < (ioport8_t *) IO_SPACE_BOUNDARY) {
-                uintptr_t prt = (uintptr_t) port;
-        
-                *((ioport8_t *) (IA64_IOSPACE_ADDRESS +
-                    ((prt & 0xfff) | ((prt >> 2) << 12)))) = v;
-        } else {
+        if (port < (ioport8_t *) IO_SPACE_BOUNDARY)
+                *((ioport8_t *) p2a(port)) = v;
+        else
                 *port = v;
-        }
-        
-        asm volatile (
-                "mf\n"
+        
+        asm volatile (
+                "mf\n"
+                "mf.a\n"
                 ::: "memory"
         );
@@ -65 +68 @@
 NO_TRACE static inline void pio_write_16(ioport16_t *port, uint16_t v)
 {
-        if (port < (ioport16_t *) IO_SPACE_BOUNDARY) {
-                uintptr_t prt = (uintptr_t) port;
-        
-                *((ioport16_t *) (IA64_IOSPACE_ADDRESS +
-                    ((prt & 0xfff) | ((prt >> 2) << 12)))) = v;
-        } else {
+        if (port < (ioport16_t *) IO_SPACE_BOUNDARY)
+                *((ioport16_t *) p2a(port)) = v;
+        else
                 *port = v;
-        }
-        
-        asm volatile (
-                "mf\n"
+        
+        asm volatile (
+                "mf\n"
+                "mf.a\n"
                 ::: "memory"
         );
@@ -82 +82 @@
 NO_TRACE static inline void pio_write_32(ioport32_t *port, uint32_t v)
 {
-        if (port < (ioport32_t *) IO_SPACE_BOUNDARY) {
-                uintptr_t prt = (uintptr_t) port;
-        
-                *((ioport32_t *) (IA64_IOSPACE_ADDRESS +
-                    ((prt & 0xfff) | ((prt >> 2) << 12)))) = v;
-        } else {
+        if (port < (ioport32_t *) IO_SPACE_BOUNDARY)
+                *((ioport32_t *) p2a(port)) = v;
+        else
                 *port = v;
-        }
-        
-        asm volatile (
-                "mf\n"
+        
+        asm volatile (
+                "mf\n"
+                "mf.a\n"
                 ::: "memory"
         );
@@ -106 +103 @@
         );
 
-        if (port < (ioport8_t *) IO_SPACE_BOUNDARY) {
-                uintptr_t prt = (uintptr_t) port;
-
-                v = *((ioport8_t *) (IA64_IOSPACE_ADDRESS +
-                    ((prt & 0xfff) | ((prt >> 2) << 12))));
-        } else {
+        if (port < (ioport8_t *) IO_SPACE_BOUNDARY)
+                v = *((ioport8_t *) p2a(port));
+        else
                 v = *port;
-        }
+
+        asm volatile (
+                "mf.a\n"
+                ::: "memory"
+        );
         
         return v;
@@ -127 +125 @@
         );
 
-        if (port < (ioport16_t *) IO_SPACE_BOUNDARY) {
-                uintptr_t prt = (uintptr_t) port;
-
-                v = *((ioport16_t *) (IA64_IOSPACE_ADDRESS +
-                    ((prt & 0xfff) | ((prt >> 2) << 12))));
-        } else {
+        if (port < (ioport16_t *) IO_SPACE_BOUNDARY)
+                v = *((ioport16_t *) p2a(port));
+        else
                 v = *port;
-        }
+
+        asm volatile (
+                "mf.a\n"
+                ::: "memory"
+        );
         
         return v;
@@ -148 +147 @@
         );
         
-        if (port < (ioport32_t *) IO_SPACE_BOUNDARY) {
-                uintptr_t prt = (uintptr_t) port;
-                
-                v = *((ioport32_t *) (IA64_IOSPACE_ADDRESS +
-                    ((prt & 0xfff) | ((prt >> 2) << 12))));
-        } else {
+        if (port < (ioport32_t *) IO_SPACE_BOUNDARY)
+                v = *((ioport32_t *) p2a(port));
+        else
                 v = *port;
-        }
+
+        asm volatile (
+                "mf.a\n"
+                ::: "memory"
+        );
 
         return v;