1 /* auxio.c: Probing for the Sparc AUXIO register at boot time.
3 * Copyright (C) 1996 David S. Miller (davem@caip.rutgers.edu)
5 * Refactoring for unified NCR/PCIO support 2002 Eric Brower (ebrower@usa.net)
8 #include <linux/config.h>
9 #include <linux/module.h>
10 #include <linux/kernel.h>
11 #include <linux/init.h>
12 #include <linux/ioport.h>
14 #include <asm/oplib.h>
18 #include <asm/auxio.h>
20 void __iomem
*auxio_register
= NULL
;
21 EXPORT_SYMBOL(auxio_register
);
29 static enum auxio_type auxio_devtype
= AUXIO_TYPE_NODEV
;
30 static DEFINE_SPINLOCK(auxio_lock
);
32 static void __auxio_sbus_set(u8 bits_on
, u8 bits_off
)
39 spin_lock_irqsave(&auxio_lock
, flags
);
41 regval
= sbus_readb(auxio_register
);
42 newval
= regval
| bits_on
;
44 newval
&= ~AUXIO_AUX1_MASK
;
45 sbus_writeb(newval
, auxio_register
);
47 spin_unlock_irqrestore(&auxio_lock
, flags
);
51 static void __auxio_ebus_set(u8 bits_on
, u8 bits_off
)
58 spin_lock_irqsave(&auxio_lock
, flags
);
60 regval
= (u8
)readl(auxio_register
);
61 newval
= regval
| bits_on
;
63 writel((u32
)newval
, auxio_register
);
65 spin_unlock_irqrestore(&auxio_lock
, flags
);
69 static inline void __auxio_ebus_set_led(int on
)
71 (on
) ? __auxio_ebus_set(AUXIO_PCIO_LED
, 0) :
72 __auxio_ebus_set(0, AUXIO_PCIO_LED
) ;
75 static inline void __auxio_sbus_set_led(int on
)
77 (on
) ? __auxio_sbus_set(AUXIO_AUX1_LED
, 0) :
78 __auxio_sbus_set(0, AUXIO_AUX1_LED
) ;
81 void auxio_set_led(int on
)
83 switch(auxio_devtype
) {
85 __auxio_sbus_set_led(on
);
88 __auxio_ebus_set_led(on
);
95 static inline void __auxio_sbus_set_lte(int on
)
97 (on
) ? __auxio_sbus_set(AUXIO_AUX1_LTE
, 0) :
98 __auxio_sbus_set(0, AUXIO_AUX1_LTE
) ;
101 void auxio_set_lte(int on
)
103 switch(auxio_devtype
) {
104 case AUXIO_TYPE_SBUS
:
105 __auxio_sbus_set_lte(on
);
107 case AUXIO_TYPE_EBUS
:
114 static struct of_device_id auxio_match
[] = {
121 MODULE_DEVICE_TABLE(of
, auxio_match
);
123 static int __devinit
auxio_probe(struct of_device
*dev
, const struct of_device_id
*match
)
125 struct device_node
*dp
= dev
->node
;
128 if (!strcmp(dp
->parent
->name
, "ebus")) {
129 auxio_devtype
= AUXIO_TYPE_EBUS
;
131 } else if (!strcmp(dp
->parent
->name
, "sbus")) {
132 auxio_devtype
= AUXIO_TYPE_SBUS
;
135 printk("auxio: Unknown parent bus type [%s]\n",
139 auxio_register
= of_ioremap(&dev
->resource
[0], 0, size
, "auxio");
143 printk(KERN_INFO
"AUXIO: Found device at %s\n",
146 if (auxio_devtype
== AUXIO_TYPE_EBUS
)
147 auxio_set_led(AUXIO_LED_ON
);
152 static struct of_platform_driver auxio_driver
= {
154 .match_table
= auxio_match
,
155 .probe
= auxio_probe
,
158 static int __init
auxio_init(void)
160 return of_register_driver(&auxio_driver
, &of_bus_type
);
163 /* Must be after subsys_initcall() so that busses are probed. Must
164 * be before device_initcall() because things like the floppy driver
165 * need to use the AUXIO register.
167 fs_initcall(auxio_init
);