vserver 1.9.5.x5
[linux-2.6.git] / drivers / tc / tc.c
index 066170a..a89ef4d 100644 (file)
@@ -8,46 +8,46 @@
  * for more details.
  *
  * Copyright (c) Harald Koerfgen, 1998
+ * Copyright (c) 2001, 2003  Maciej W. Rozycki
  */
 #include <linux/string.h>
 #include <linux/init.h>
 #include <linux/ioport.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+
 #include <asm/addrspace.h>
 #include <asm/errno.h>
 #include <asm/dec/machtype.h>
+#include <asm/dec/prom.h>
 #include <asm/dec/tcinfo.h>
 #include <asm/dec/tcmodule.h>
 #include <asm/dec/interrupts.h>
-
+#include <asm/paccess.h>
 #include <asm/ptrace.h>
-#include <linux/kernel.h>
-#include <linux/module.h>
 
 #define TC_DEBUG
 
 MODULE_LICENSE("GPL");
 slot_info tc_bus[MAX_SLOT];
-static int max_tcslot;
+static int num_tcslots;
 static tcinfo *info;
 
 unsigned long system_base;
 
-extern void (*dbe_board_handler)(struct pt_regs *regs);
-extern unsigned long *(*rex_slot_address)(int);
-extern void *(*rex_gettcinfo)(void);
-
 /*
  * Interface to the world. Read comment in include/asm-mips/tc.h.
  */
 
-int search_tc_card(char *name)
+int search_tc_card(const char *name)
 {
        int slot;
        slot_info *sip;
 
-       for (slot = 0; slot <= max_tcslot; slot++) {
+       for (slot = 0; slot < num_tcslots; slot++) {
                sip = &tc_bus[slot];
-               if ((sip->flags & FREE) && (strncmp(sip->name, name, strlen(name)) == 0)) {
+               if ((sip->flags & FREE) &&
+                   (strncmp(sip->name, name, strlen(name)) == 0)) {
                        return slot;
                }
        }
@@ -68,7 +68,8 @@ void claim_tc_card(int slot)
 void release_tc_card(int slot)
 {
        if (tc_bus[slot].flags & FREE) {
-               printk("release_tc_card: attempting to release a card already free\n");
+               printk("release_tc_card: "
+                      "attempting to release a card already free\n");
                return;
        }
        tc_bus[slot].flags &= ~IN_USE;
@@ -93,73 +94,84 @@ unsigned long get_tc_speed(void)
 /*
  * Probing for TURBOchannel modules
  */
-static void __init my_dbe_handler(struct pt_regs *regs)
+static void __init tc_probe(unsigned long startaddr, unsigned long size,
+                           int slots)
 {
-       regs->cp0_epc += 4;
-}
-
-static void __init tc_probe(unsigned long startaddr, unsigned long size, int max_slot)
-{
-       int i, slot;
+       int i, slot, err;
        long offset;
+       unsigned char pattern[4];
        unsigned char *module;
-       void (*old_be_handler)(struct pt_regs *regs);
-
-       /* Install our exception handler temporarily */
 
-       old_be_handler = dbe_board_handler;
-       dbe_board_handler = my_dbe_handler;
-       for (slot = 0; slot <= max_slot; slot++) {
+       for (slot = 0; slot < slots; slot++) {
                module = (char *)(startaddr + slot * size);
-               offset = -1;
-               if (module[OLDCARD + TC_PATTERN0] == 0x55 && module[OLDCARD + TC_PATTERN1] == 0x00
-                 && module[OLDCARD + TC_PATTERN2] == 0xaa && module[OLDCARD + TC_PATTERN3] == 0xff)
-                       offset = OLDCARD;
-               if (module[TC_PATTERN0] == 0x55 && module[TC_PATTERN1] == 0x00
-                 && module[TC_PATTERN2] == 0xaa && module[TC_PATTERN3] == 0xff)
-                       offset = 0;
-
-               if (offset != -1) {
-                       tc_bus[slot].base_addr = (unsigned long)module;
-                       for(i = 0; i < 8; i++) {
-                               tc_bus[slot].firmware[i] = module[TC_FIRM_VER + offset + 4 * i];
-                               tc_bus[slot].vendor[i] = module[TC_VENDOR + offset + 4 * i];
-                               tc_bus[slot].name[i] = module[TC_MODULE + offset + 4 * i];
-                       }
-                       tc_bus[slot].firmware[8] = 0;
-                       tc_bus[slot].vendor[8] = 0;
-                       tc_bus[slot].name[8] = 0;
-                       /*
-                        * Looks unneccesary, but we may change
-                        * TC? in the future
-                        */
-                       switch (slot) {
-                       case 0:
-                               tc_bus[slot].interrupt = TC0;
-                               break;
-                       case 1:
-                               tc_bus[slot].interrupt = TC1;
-                               break;
-                       case 2:
-                               tc_bus[slot].interrupt = TC2;
-                               break;
-                       /*
-                        * Yuck! DS5000/200 onboard devices
-                        */
-                       case 5:
-                               tc_bus[slot].interrupt = SCSI_INT;
-                               break;
-                       case 6:
-                               tc_bus[slot].interrupt = ETHER;
-                               break;
-                       default:
-                               tc_bus[slot].interrupt = -1;
-                               break;
-                       }       
+
+               offset = OLDCARD;
+
+               err = 0;
+               err |= get_dbe(pattern[0], module + OLDCARD + TC_PATTERN0);
+               err |= get_dbe(pattern[1], module + OLDCARD + TC_PATTERN1);
+               err |= get_dbe(pattern[2], module + OLDCARD + TC_PATTERN2);
+               err |= get_dbe(pattern[3], module + OLDCARD + TC_PATTERN3);
+               if (err)
+                       continue;
+
+               if (pattern[0] != 0x55 || pattern[1] != 0x00 ||
+                   pattern[2] != 0xaa || pattern[3] != 0xff) {
+                       offset = NEWCARD;
+
+                       err = 0;
+                       err |= get_dbe(pattern[0], module + TC_PATTERN0);
+                       err |= get_dbe(pattern[1], module + TC_PATTERN1);
+                       err |= get_dbe(pattern[2], module + TC_PATTERN2);
+                       err |= get_dbe(pattern[3], module + TC_PATTERN3);
+                       if (err)
+                               continue;
                }
-       }
 
-       dbe_board_handler = old_be_handler;
+               if (pattern[0] != 0x55 || pattern[1] != 0x00 ||
+                   pattern[2] != 0xaa || pattern[3] != 0xff)
+                       continue;
+
+               tc_bus[slot].base_addr = (unsigned long)module;
+               for(i = 0; i < 8; i++) {
+                       tc_bus[slot].firmware[i] =
+                               module[TC_FIRM_VER + offset + 4 * i];
+                       tc_bus[slot].vendor[i] =
+                               module[TC_VENDOR + offset + 4 * i];
+                       tc_bus[slot].name[i] =
+                               module[TC_MODULE + offset + 4 * i];
+               }
+               tc_bus[slot].firmware[8] = 0;
+               tc_bus[slot].vendor[8] = 0;
+               tc_bus[slot].name[8] = 0;
+               /*
+                * Looks unneccesary, but we may change
+                * TC? in the future
+                */
+               switch (slot) {
+               case 0:
+                       tc_bus[slot].interrupt = dec_interrupt[DEC_IRQ_TC0];
+                       break;
+               case 1:
+                       tc_bus[slot].interrupt = dec_interrupt[DEC_IRQ_TC1];
+                       break;
+               case 2:
+                       tc_bus[slot].interrupt = dec_interrupt[DEC_IRQ_TC2];
+                       break;
+               /*
+                * Yuck! DS5000/200 onboard devices
+                */
+               case 5:
+                       tc_bus[slot].interrupt = dec_interrupt[DEC_IRQ_TC5];
+                       break;
+               case 6:
+                       tc_bus[slot].interrupt = dec_interrupt[DEC_IRQ_TC6];
+                       break;
+               default:
+                       tc_bus[slot].interrupt = -1;
+                       break;
+               }
+       }
 }
 
 /*
@@ -189,15 +201,16 @@ void __init tc_init(void)
 
        switch (mips_machtype) {
        case MACH_DS5000_200:
-               max_tcslot = 6;
+               num_tcslots = 7;
                break;
        case MACH_DS5000_1XX:
        case MACH_DS5000_2X0:
-               max_tcslot = 2;
+       case MACH_DS5900:
+               num_tcslots = 3;
                break;
        case MACH_DS5000_XX:
        default:
-               max_tcslot = 1;
+               num_tcslots = 2;
                break;
        }
 
@@ -210,22 +223,22 @@ void __init tc_init(void)
 
                slot_size = info->slot_size << 20;
 
-               tc_probe(slot0addr, slot_size, max_tcslot);
+               tc_probe(slot0addr, slot_size, num_tcslots);
 
                /*
                 * All TURBOchannel DECstations have the onboard devices
-                * where the (max_tcslot + 1 or 2 on DS5k/xx) Option Module
+                * where the (num_tcslots + 0 or 1 on DS5k/xx) Option Module
                 * would be.
                 */
                if(mips_machtype == MACH_DS5000_XX)
-                       i = 2;
-               else
                        i = 1;
-               
-               system_base = slot0addr + slot_size * (max_tcslot + i);
+               else
+                       i = 0;
+
+               system_base = slot0addr + slot_size * (num_tcslots + i);
 
 #ifdef TC_DEBUG
-               for (i = 0; i <= max_tcslot; i++)
+               for (i = 0; i < num_tcslots; i++)
                        if (tc_bus[i].base_addr) {
                                printk("    slot %d: ", i);
                                printk("%s %s %s\n", tc_bus[i].vendor,
@@ -244,4 +257,4 @@ EXPORT_SYMBOL(release_tc_card);
 EXPORT_SYMBOL(get_tc_base_addr);
 EXPORT_SYMBOL(get_tc_irq_nr);
 EXPORT_SYMBOL(get_tc_speed);
-
+EXPORT_SYMBOL(system_base);