fedora core 6 1.2949 + vserver 2.2.0
[linux-2.6.git] / arch / ia64 / sn / kernel / iomv.c
index a98d674..4aa4f30 100644 (file)
@@ -3,17 +3,23 @@
  * License.  See the file "COPYING" in the main directory of this archive
  * for more details.
  *
- * Copyright (C) 2000-2003 Silicon Graphics, Inc. All rights reserved.
+ * Copyright (C) 2000-2003, 2006 Silicon Graphics, Inc. All rights reserved.
  */
 
 #include <linux/module.h>
+#include <linux/acpi.h>
 #include <asm/io.h>
 #include <asm/delay.h>
+#include <asm/vga.h>
 #include <asm/sn/nodepda.h>
 #include <asm/sn/simulator.h>
 #include <asm/sn/pda.h>
 #include <asm/sn/sn_cpuid.h>
 #include <asm/sn/shub_mmr.h>
+#include <asm/sn/acpi.h>
+
+#define IS_LEGACY_VGA_IOPORT(p) \
+       (((p) >= 0x3b0 && (p) <= 0x3bb) || ((p) >= 0x3c0 && (p) <= 0x3df))
 
 /**
  * sn_io_addr - convert an in/out port to an i/o address
 void *sn_io_addr(unsigned long port)
 {
        if (!IS_RUNNING_ON_SIMULATOR()) {
+               if (IS_LEGACY_VGA_IOPORT(port))
+                       return (__ia64_mk_io_addr(port));
                /* On sn2, legacy I/O ports don't point at anything */
                if (port < (64 * 1024))
                        return NULL;
-               return ((void *)(port | __IA64_UNCACHED_OFFSET));
+               if (SN_ACPI_BASE_SUPPORT())
+                       return (__ia64_mk_io_addr(port));
+               else
+                       return ((void *)(port | __IA64_UNCACHED_OFFSET));
        } else {
                /* but the simulator uses them... */
-               unsigned long io_base;
                unsigned long addr;
 
                /*
@@ -40,14 +50,9 @@ void *sn_io_addr(unsigned long port)
                 * for accessing registers in bedrock local block
                 * (so we don't do port&0xfff)
                 */
-               if ((port >= 0x1f0 && port <= 0x1f7) ||
-                   port == 0x3f6 || port == 0x3f7) {
-                       io_base = (0xc000000fcc000000UL |
-                                  ((unsigned long)get_nasid() << 38));
-                       addr = io_base | ((port >> 2) << 12) | (port & 0xfff);
-               } else {
-                       addr = __ia64_get_io_port_base() | ((port >> 2) << 2);
-               }
+               addr = (is_shub2() ? 0xc00000028c000000UL : 0xc0000087cc000000UL) | ((port >> 2) << 12);
+               if ((port >= 0x1f0 && port <= 0x1f7) || port == 0x3f6 || port == 0x3f7)
+                       addr |= port;
                return (void *)addr;
        }
 }
@@ -66,9 +71,10 @@ EXPORT_SYMBOL(sn_io_addr);
  */
 void __sn_mmiowb(void)
 {
-       while ((((volatile unsigned long)(*pda->pio_write_status_addr)) &
-               SH_PIO_WRITE_STATUS_0_PENDING_WRITE_COUNT_MASK) !=
-              SH_PIO_WRITE_STATUS_0_PENDING_WRITE_COUNT_MASK)
+       volatile unsigned long *adr = pda->pio_write_status_addr;
+       unsigned long val = pda->pio_write_status_val;
+
+       while ((*adr & SH_PIO_WRITE_STATUS_PENDING_WRITE_COUNT_MASK) != val)
                cpu_relax();
 }