Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 | /* $Id: central.c,v 1.5 1998/02/12 15:57:59 jj Exp $ * central.c: Central FHC driver for Sunfire/Starfire/Wildfire. * * Copyright (C) 1997 David S. Miller (davem@caip.rutgers.edu) */ #include <linux/kernel.h> #include <linux/types.h> #include <linux/string.h> #include <asm/page.h> #include <asm/fhc.h> struct linux_central *central_bus = NULL; static inline unsigned long long_align(unsigned long addr) { return ((addr + (sizeof(unsigned long) - 1)) & ~(sizeof(unsigned long) - 1)); } extern void prom_central_ranges_init(int cnode, struct linux_central *central); extern void prom_fhc_ranges_init(int fnode, struct linux_fhc *fhc); unsigned long central_probe(unsigned long memory_start) { struct linux_prom_registers fpregs[6]; struct linux_fhc *fhc; char namebuf[128]; int cnode, fnode, err; printk("CENTRAL: "); cnode = prom_finddevice("/central"); if(cnode == 0 || cnode == -1) { printk("no central found.\n"); return memory_start; } printk("found central PROM node.\n"); /* Ok we got one, grab some memory for software state. */ memory_start = long_align(memory_start); central_bus = (struct linux_central *) (memory_start); memory_start += sizeof(struct linux_central); memory_start = long_align(memory_start); fhc = (struct linux_fhc *)(memory_start); memory_start += sizeof(struct linux_fhc); memory_start = long_align(memory_start); /* First init central. */ central_bus->child = fhc; central_bus->prom_node = cnode; prom_getstring(cnode, "name", namebuf, sizeof(namebuf)); strcpy(central_bus->prom_name, namebuf); prom_central_ranges_init(cnode, central_bus); /* And then central's FHC. */ fhc->next = NULL; fhc->parent = central_bus; fnode = prom_searchsiblings(prom_getchild(cnode), "fhc"); if(fnode == 0 || fnode == -1) { prom_printf("Critical error, central board lacks fhc.\n"); prom_halt(); } fhc->prom_node = fnode; prom_getstring(fnode, "name", namebuf, sizeof(namebuf)); strcpy(fhc->prom_name, namebuf); prom_fhc_ranges_init(fnode, fhc); /* Finally, map in FHC register set. */ if (prom_getproperty(fnode, "reg", (char *)&fpregs[0], sizeof(fpregs)) == -1) { prom_printf("CENTRAL: fatal error, cannot get fhc regs.\n"); prom_halt(); } prom_apply_central_ranges(central_bus, &fpregs[0], 6); fhc->fhc_regs.pregs = (struct fhc_internal_regs *) __va((((unsigned long)fpregs[0].which_io)<<32) | (((unsigned long)fpregs[0].phys_addr))); fhc->fhc_regs.ireg = (struct fhc_ign_reg *) __va((((unsigned long)fpregs[1].which_io)<<32) | (((unsigned long)fpregs[1].phys_addr))); fhc->fhc_regs.ffregs = (struct fhc_fanfail_regs *) __va((((unsigned long)fpregs[2].which_io)<<32) | (((unsigned long)fpregs[2].phys_addr))); fhc->fhc_regs.sregs = (struct fhc_system_regs *) __va((((unsigned long)fpregs[3].which_io)<<32) | (((unsigned long)fpregs[3].phys_addr))); fhc->fhc_regs.uregs = (struct fhc_uart_regs *) __va((((unsigned long)fpregs[4].which_io)<<32) | (((unsigned long)fpregs[4].phys_addr))); fhc->fhc_regs.tregs = (struct fhc_tod_regs *) __va((((unsigned long)fpregs[5].which_io)<<32) | (((unsigned long)fpregs[5].phys_addr))); err = fhc->fhc_regs.pregs->fhc_id; printk("FHC Version[%x] PartID[%x] Manufacturer[%x]\n", ((err & FHC_ID_VERS) >> 28), ((err & FHC_ID_PARTID) >> 12), ((err & FHC_ID_MANUF) >> 1)); return memory_start; } |