Merge branch 'sched-fixes-for-linus' of git://git.kernel.org/pub/scm/linux/kernel...
[linux-2.6] / arch / sparc / kernel / auxio_32.c
1 /* auxio.c: Probing for the Sparc AUXIO register at boot time.
2  *
3  * Copyright (C) 1996 David S. Miller (davem@caip.rutgers.edu)
4  */
5
6 #include <linux/stddef.h>
7 #include <linux/init.h>
8 #include <linux/spinlock.h>
9 #include <linux/of.h>
10 #include <linux/of_device.h>
11 #include <asm/oplib.h>
12 #include <asm/io.h>
13 #include <asm/auxio.h>
14 #include <asm/string.h>         /* memset(), Linux has no bzero() */
15
16 /* Probe and map in the Auxiliary I/O register */
17
18 /* auxio_register is not static because it is referenced 
19  * in entry.S::floppy_tdone
20  */
21 void __iomem *auxio_register = NULL;
22 static DEFINE_SPINLOCK(auxio_lock);
23
24 void __init auxio_probe(void)
25 {
26         int node, auxio_nd;
27         struct linux_prom_registers auxregs[1];
28         struct resource r;
29
30         switch (sparc_cpu_model) {
31         case sun4d:
32         case sun4:
33                 return;
34         default:
35                 break;
36         }
37         node = prom_getchild(prom_root_node);
38         auxio_nd = prom_searchsiblings(node, "auxiliary-io");
39         if(!auxio_nd) {
40                 node = prom_searchsiblings(node, "obio");
41                 node = prom_getchild(node);
42                 auxio_nd = prom_searchsiblings(node, "auxio");
43                 if(!auxio_nd) {
44 #ifdef CONFIG_PCI
45                         /* There may be auxio on Ebus */
46                         return;
47 #else
48                         if(prom_searchsiblings(node, "leds")) {
49                                 /* VME chassis sun4m machine, no auxio exists. */
50                                 return;
51                         }
52                         prom_printf("Cannot find auxio node, cannot continue...\n");
53                         prom_halt();
54 #endif
55                 }
56         }
57         if(prom_getproperty(auxio_nd, "reg", (char *) auxregs, sizeof(auxregs)) <= 0)
58                 return;
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));
69
70         set_auxio(AUXIO_LED, 0);
71 }
72
73 unsigned char get_auxio(void)
74 {
75         if(auxio_register) 
76                 return sbus_readb(auxio_register);
77         return 0;
78 }
79 EXPORT_SYMBOL(get_auxio);
80
81 void set_auxio(unsigned char bits_on, unsigned char bits_off)
82 {
83         unsigned char regval;
84         unsigned long flags;
85         spin_lock_irqsave(&auxio_lock, flags);
86         switch(sparc_cpu_model) {
87         case sun4c:
88                 regval = sbus_readb(auxio_register);
89                 sbus_writeb(((regval | bits_on) & ~bits_off) | AUXIO_ORMEIN,
90                         auxio_register);
91                 break;
92         case sun4m:
93                 if(!auxio_register)
94                         break;     /* VME chassis sun4m, no auxio. */
95                 regval = sbus_readb(auxio_register);
96                 sbus_writeb(((regval | bits_on) & ~bits_off) | AUXIO_ORMEIN4M,
97                         auxio_register);
98                 break;
99         case sun4d:
100                 break;
101         default:
102                 panic("Can't set AUXIO register on this machine.");
103         };
104         spin_unlock_irqrestore(&auxio_lock, flags);
105 }
106 EXPORT_SYMBOL(set_auxio);
107
108 /* sun4m power control register (AUXIO2) */
109
110 volatile unsigned char * auxio_power_register = NULL;
111
112 void __init auxio_power_probe(void)
113 {
114         struct linux_prom_registers regs;
115         int node;
116         struct resource r;
117
118         /* Attempt to find the sun4m power control node. */
119         node = prom_getchild(prom_root_node);
120         node = prom_searchsiblings(node, "obio");
121         node = prom_getchild(node);
122         node = prom_searchsiblings(node, "power");
123         if (node == 0 || node == -1)
124                 return;
125
126         /* Map the power control register. */
127         if (prom_getproperty(node, "reg", (char *)&regs, sizeof(regs)) <= 0)
128                 return;
129         prom_apply_obio_ranges(&regs, 1);
130         memset(&r, 0, sizeof(r));
131         r.flags = regs.which_io & 0xF;
132         r.start = regs.phys_addr;
133         r.end = regs.phys_addr + regs.reg_size - 1;
134         auxio_power_register = (unsigned char *) of_ioremap(&r, 0,
135             regs.reg_size, "auxpower");
136
137         /* Display a quick message on the console. */
138         if (auxio_power_register)
139                 printk(KERN_INFO "Power off control detected.\n");
140 }