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
|
/* $Id: central.c,v 1.6 1998/05/14 13:35:45 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;
cnode = prom_finddevice("/central");
if(cnode == 0 || cnode == -1)
return memory_start;
printk("CENTRAL: found central PROM node %08x.\n", cnode);
/* 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;
}
|
