X-Git-Url: http://git.onelab.eu/?a=blobdiff_plain;f=drivers%2Ftc%2Ftc.c;h=a89ef4df80c3efbb72fbdefbedfc27a328bd4a8f;hb=6a77f38946aaee1cd85eeec6cf4229b204c15071;hp=066170aabe2e37c63b983c6efb0b82ec96d52fde;hpb=87fc8d1bb10cd459024a742c6a10961fefcef18f;p=linux-2.6.git diff --git a/drivers/tc/tc.c b/drivers/tc/tc.c index 066170aab..a89ef4df8 100644 --- a/drivers/tc/tc.c +++ b/drivers/tc/tc.c @@ -8,46 +8,46 @@ * for more details. * * Copyright (c) Harald Koerfgen, 1998 + * Copyright (c) 2001, 2003 Maciej W. Rozycki */ #include #include #include +#include +#include + #include #include #include +#include #include #include #include - +#include #include -#include -#include #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);