a0716ccc2f4a2227c211f19a77017b2790379a31
[linux-3.10.git] / arch / sparc64 / kernel / auxio.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  * Refactoring for unified NCR/PCIO support 2002 Eric Brower (ebrower@usa.net)
6  */
7
8 #include <linux/config.h>
9 #include <linux/kernel.h>
10 #include <linux/init.h>
11 #include <linux/ioport.h>
12
13 #include <asm/oplib.h>
14 #include <asm/io.h>
15 #include <asm/sbus.h>
16 #include <asm/ebus.h>
17 #include <asm/auxio.h>
18
19 /* This cannot be static, as it is referenced in entry.S */
20 void __iomem *auxio_register = NULL;
21
22 enum auxio_type {
23         AUXIO_TYPE_NODEV,
24         AUXIO_TYPE_SBUS,
25         AUXIO_TYPE_EBUS
26 };
27
28 static enum auxio_type auxio_devtype = AUXIO_TYPE_NODEV;
29 static DEFINE_SPINLOCK(auxio_lock);
30
31 static void __auxio_sbus_set(u8 bits_on, u8 bits_off)
32 {
33         if (auxio_register) {
34                 unsigned char regval;
35                 unsigned long flags;
36                 unsigned char newval;
37
38                 spin_lock_irqsave(&auxio_lock, flags);
39
40                 regval =  sbus_readb(auxio_register);
41                 newval =  regval | bits_on;
42                 newval &= ~bits_off;
43                 newval &= ~AUXIO_AUX1_MASK;
44                 sbus_writeb(newval, auxio_register);
45                 
46                 spin_unlock_irqrestore(&auxio_lock, flags);
47         }
48 }
49
50 static void __auxio_ebus_set(u8 bits_on, u8 bits_off)
51 {
52         if (auxio_register) {
53                 unsigned char regval;
54                 unsigned long flags;
55                 unsigned char newval;
56
57                 spin_lock_irqsave(&auxio_lock, flags);
58
59                 regval =  (u8)readl(auxio_register);
60                 newval =  regval | bits_on;
61                 newval &= ~bits_off;
62                 writel((u32)newval, auxio_register);
63
64                 spin_unlock_irqrestore(&auxio_lock, flags);
65         }
66 }
67
68 static inline void __auxio_ebus_set_led(int on)
69 {
70         (on) ? __auxio_ebus_set(AUXIO_PCIO_LED, 0) :
71                 __auxio_ebus_set(0, AUXIO_PCIO_LED) ;
72 }
73
74 static inline void __auxio_sbus_set_led(int on)
75 {
76         (on) ? __auxio_sbus_set(AUXIO_AUX1_LED, 0) :
77                 __auxio_sbus_set(0, AUXIO_AUX1_LED) ;
78 }
79
80 void auxio_set_led(int on)
81 {
82         switch(auxio_devtype) {
83         case AUXIO_TYPE_SBUS:
84                 __auxio_sbus_set_led(on);
85                 break;
86         case AUXIO_TYPE_EBUS:
87                 __auxio_ebus_set_led(on);
88                 break;
89         default:
90                 break;
91         }
92 }
93
94 static inline void __auxio_sbus_set_lte(int on)
95 {
96         (on) ? __auxio_sbus_set(AUXIO_AUX1_LTE, 0) : 
97                 __auxio_sbus_set(0, AUXIO_AUX1_LTE) ;
98 }
99
100 void auxio_set_lte(int on)
101 {
102         switch(auxio_devtype) {
103         case AUXIO_TYPE_SBUS:
104                 __auxio_sbus_set_lte(on);
105                 break;
106         case AUXIO_TYPE_EBUS:
107                 /* FALL-THROUGH */
108         default:
109                 break;
110         }
111 }
112
113 void __init auxio_probe(void)
114 {
115         struct sbus_bus *sbus;
116         struct sbus_dev *sdev = NULL;
117
118         for_each_sbus(sbus) {
119                 for_each_sbusdev(sdev, sbus) {
120                         if(!strcmp(sdev->prom_name, "auxio"))
121                                 goto found_sdev;
122                 }
123         }
124
125 found_sdev:
126         if (sdev) {
127                 auxio_devtype  = AUXIO_TYPE_SBUS;
128                 auxio_register = sbus_ioremap(&sdev->resource[0], 0,
129                                               sdev->reg_addrs[0].reg_size,
130                                               "auxiliaryIO");
131         }
132 #ifdef CONFIG_PCI
133         else {
134                 struct linux_ebus *ebus;
135                 struct linux_ebus_device *edev = NULL;
136
137                 for_each_ebus(ebus) {
138                         for_each_ebusdev(edev, ebus) {
139                                 if (!strcmp(edev->prom_name, "auxio"))
140                                         goto ebus_done;
141                         }
142                 }
143         ebus_done:
144                 if (edev) {
145                         auxio_devtype  = AUXIO_TYPE_EBUS;
146                         auxio_register =
147                                 ioremap(edev->resource[0].start, sizeof(u32));
148                 }
149         }
150         auxio_set_led(AUXIO_LED_ON);
151 #endif
152 }