1 // SPDX-License-Identifier: GPL-2.0
2 /* auxio.c: Probing for the Sparc AUXIO register at boot time.
4 * Copyright (C) 1996 David S. Miller (davem@caip.rutgers.edu)
6 * Refactoring for unified NCR/PCIO support 2002 Eric Brower (ebrower@usa.net)
9 #include <linux/module.h>
10 #include <linux/kernel.h>
11 #include <linux/init.h>
12 #include <linux/ioport.h>
13 #include <linux/of_device.h>
17 #include <asm/auxio.h>
19 void __iomem
*auxio_register
= NULL
;
20 EXPORT_SYMBOL(auxio_register
);
28 static enum auxio_type auxio_devtype
= AUXIO_TYPE_NODEV
;
29 static DEFINE_SPINLOCK(auxio_lock
);
31 static void __auxio_rmw(u8 bits_on
, u8 bits_off
, int ebus
)
37 spin_lock_irqsave(&auxio_lock
, flags
);
40 (u8
) readl(auxio_register
) :
41 sbus_readb(auxio_register
));
42 newval
= regval
| bits_on
;
45 newval
&= ~AUXIO_AUX1_MASK
;
47 writel((u32
) newval
, auxio_register
);
49 sbus_writeb(newval
, auxio_register
);
51 spin_unlock_irqrestore(&auxio_lock
, flags
);
55 static void __auxio_set_bit(u8 bit
, int on
, int ebus
)
57 u8 bits_on
= (ebus
? AUXIO_PCIO_LED
: AUXIO_AUX1_LED
);
65 __auxio_rmw(bits_on
, bits_off
, ebus
);
68 void auxio_set_led(int on
)
70 int ebus
= auxio_devtype
== AUXIO_TYPE_EBUS
;
73 bit
= (ebus
? AUXIO_PCIO_LED
: AUXIO_AUX1_LED
);
74 __auxio_set_bit(bit
, on
, ebus
);
76 EXPORT_SYMBOL(auxio_set_led
);
78 static void __auxio_sbus_set_lte(int on
)
80 __auxio_set_bit(AUXIO_AUX1_LTE
, on
, 0);
83 void auxio_set_lte(int on
)
85 switch(auxio_devtype
) {
87 __auxio_sbus_set_lte(on
);
94 EXPORT_SYMBOL(auxio_set_lte
);
96 static const struct of_device_id auxio_match
[] = {
103 MODULE_DEVICE_TABLE(of
, auxio_match
);
105 static int auxio_probe(struct platform_device
*dev
)
107 struct device_node
*dp
= dev
->dev
.of_node
;
110 if (of_node_name_eq(dp
->parent
, "ebus")) {
111 auxio_devtype
= AUXIO_TYPE_EBUS
;
113 } else if (of_node_name_eq(dp
->parent
, "sbus")) {
114 auxio_devtype
= AUXIO_TYPE_SBUS
;
117 printk("auxio: Unknown parent bus type [%pOFn]\n",
121 auxio_register
= of_ioremap(&dev
->resource
[0], 0, size
, "auxio");
125 printk(KERN_INFO
"AUXIO: Found device at %pOF\n", dp
);
127 if (auxio_devtype
== AUXIO_TYPE_EBUS
)
128 auxio_set_led(AUXIO_LED_ON
);
133 static struct platform_driver auxio_driver
= {
134 .probe
= auxio_probe
,
137 .of_match_table
= auxio_match
,
141 static int __init
auxio_init(void)
143 return platform_driver_register(&auxio_driver
);
146 /* Must be after subsys_initcall() so that busses are probed. Must
147 * be before device_initcall() because things like the floppy driver
148 * need to use the AUXIO register.
150 fs_initcall(auxio_init
);