1 /* auxio.c: Probing for the Sparc AUXIO register at boot time.
3 * Copyright (C) 1996 David S. Miller (davem@caip.rutgers.edu)
6 #include <linux/stddef.h>
7 #include <linux/init.h>
8 #include <linux/spinlock.h>
10 #include <linux/of_device.h>
11 #include <asm/oplib.h>
13 #include <asm/auxio.h>
14 #include <asm/string.h> /* memset(), Linux has no bzero() */
16 /* Probe and map in the Auxiliary I/O register */
18 /* auxio_register is not static because it is referenced
19 * in entry.S::floppy_tdone
21 void __iomem
*auxio_register
= NULL
;
22 static DEFINE_SPINLOCK(auxio_lock
);
24 void __init
auxio_probe(void)
27 struct linux_prom_registers auxregs
[1];
30 switch (sparc_cpu_model
) {
37 node
= prom_getchild(prom_root_node
);
38 auxio_nd
= prom_searchsiblings(node
, "auxiliary-io");
40 node
= prom_searchsiblings(node
, "obio");
41 node
= prom_getchild(node
);
42 auxio_nd
= prom_searchsiblings(node
, "auxio");
45 /* There may be auxio on Ebus */
48 if(prom_searchsiblings(node
, "leds")) {
49 /* VME chassis sun4m machine, no auxio exists. */
52 prom_printf("Cannot find auxio node, cannot continue...\n");
57 if(prom_getproperty(auxio_nd
, "reg", (char *) auxregs
, sizeof(auxregs
)) <= 0)
59 prom_apply_obio_ranges(auxregs
, 0x1);
60 /* Map the register both read and write */
61 r
.flags
= auxregs
[0].which_io
& 0xF;
62 r
.start
= auxregs
[0].phys_addr
;
63 r
.end
= auxregs
[0].phys_addr
+ auxregs
[0].reg_size
- 1;
64 auxio_register
= of_ioremap(&r
, 0, auxregs
[0].reg_size
, "auxio");
65 /* Fix the address on sun4m and sun4c. */
66 if((((unsigned long) auxregs
[0].phys_addr
) & 3) == 3 ||
67 sparc_cpu_model
== sun4c
)
68 auxio_register
+= (3 - ((unsigned long)auxio_register
& 3));
70 set_auxio(AUXIO_LED
, 0);
73 unsigned char get_auxio(void)
76 return sbus_readb(auxio_register
);
80 void set_auxio(unsigned char bits_on
, unsigned char bits_off
)
84 spin_lock_irqsave(&auxio_lock
, flags
);
85 switch(sparc_cpu_model
) {
87 regval
= sbus_readb(auxio_register
);
88 sbus_writeb(((regval
| bits_on
) & ~bits_off
) | AUXIO_ORMEIN
,
93 break; /* VME chassis sun4m, no auxio. */
94 regval
= sbus_readb(auxio_register
);
95 sbus_writeb(((regval
| bits_on
) & ~bits_off
) | AUXIO_ORMEIN4M
,
101 panic("Can't set AUXIO register on this machine.");
103 spin_unlock_irqrestore(&auxio_lock
, flags
);
107 /* sun4m power control register (AUXIO2) */
109 volatile unsigned char * auxio_power_register
= NULL
;
111 void __init
auxio_power_probe(void)
113 struct linux_prom_registers regs
;
117 /* Attempt to find the sun4m power control node. */
118 node
= prom_getchild(prom_root_node
);
119 node
= prom_searchsiblings(node
, "obio");
120 node
= prom_getchild(node
);
121 node
= prom_searchsiblings(node
, "power");
122 if (node
== 0 || node
== -1)
125 /* Map the power control register. */
126 if (prom_getproperty(node
, "reg", (char *)®s
, sizeof(regs
)) <= 0)
128 prom_apply_obio_ranges(®s
, 1);
129 memset(&r
, 0, sizeof(r
));
130 r
.flags
= regs
.which_io
& 0xF;
131 r
.start
= regs
.phys_addr
;
132 r
.end
= regs
.phys_addr
+ regs
.reg_size
- 1;
133 auxio_power_register
= (unsigned char *) of_ioremap(&r
, 0,
134 regs
.reg_size
, "auxpower");
136 /* Display a quick message on the console. */
137 if (auxio_power_register
)
138 printk(KERN_INFO
"Power off control detected.\n");