auxio.c revision 200815
1/*- 2 * Copyright (c) 2004 Pyun YongHyeon 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 * 26 */ 27 28/* $NetBSD: auxio.c,v 1.11 2003/07/15 03:36:04 lukem Exp $ */ 29 30/*- 31 * Copyright (c) 2000, 2001 Matthew R. Green 32 * All rights reserved. 33 * 34 * Redistribution and use in source and binary forms, with or without 35 * modification, are permitted provided that the following conditions 36 * are met: 37 * 1. Redistributions of source code must retain the above copyright 38 * notice, this list of conditions and the following disclaimer. 39 * 2. Redistributions in binary form must reproduce the above copyright 40 * notice, this list of conditions and the following disclaimer in the 41 * documentation and/or other materials provided with the distribution. 42 * 3. The name of the author may not be used to endorse or promote products 43 * derived from this software without specific prior written permission. 44 * 45 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 46 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 47 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 48 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 49 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 50 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 51 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 52 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 53 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 54 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 55 * SUCH DAMAGE. 56 */ 57 58/* 59 * AUXIO registers support on the SBus & EBus2, used for the floppy driver 60 * and to control the system LED, for the BLINK option. 61 */ 62 63#include <sys/cdefs.h> 64__FBSDID("$FreeBSD: head/sys/dev/auxio/auxio.c 200815 2009-12-21 21:29:16Z marius $"); 65 66#include <sys/param.h> 67#include <sys/systm.h> 68#include <sys/bus.h> 69#include <sys/kernel.h> 70#include <sys/lock.h> 71#include <sys/module.h> 72#include <sys/mutex.h> 73#include <sys/resource.h> 74#include <sys/rman.h> 75 76#include <dev/led/led.h> 77#include <dev/ofw/ofw_bus.h> 78#include <dev/ofw/openfirm.h> 79 80#include <machine/bus.h> 81#include <machine/ofw_machdep.h> 82#include <machine/resource.h> 83 84#include <sparc64/sbus/sbusvar.h> 85#include <dev/auxio/auxioreg.h> 86 87/* 88 * On sun4u, auxio exists with one register (LED) on the SBus, and 5 89 * registers on the EBus2 (pci) (LED, PCIMODE, FREQUENCY, SCSI 90 * OSCILLATOR, and TEMP SENSE. 91 */ 92 93#define AUXIO_PCIO_LED 0 94#define AUXIO_PCIO_PCI 1 95#define AUXIO_PCIO_FREQ 2 96#define AUXIO_PCIO_OSC 3 97#define AUXIO_PCIO_TEMP 4 98#define AUXIO_PCIO_NREG 5 99 100struct auxio_softc { 101 struct device *sc_dev; 102 103 int sc_nauxio; 104 struct resource *sc_res[AUXIO_PCIO_NREG]; 105 int sc_rid[AUXIO_PCIO_NREG]; 106 bus_space_tag_t sc_regt[AUXIO_PCIO_NREG]; 107 bus_space_handle_t sc_regh[AUXIO_PCIO_NREG]; 108 struct cdev *sc_led_dev; 109 u_int32_t sc_led_stat; 110 111 int sc_flags; 112#define AUXIO_LEDONLY 0x1 113#define AUXIO_EBUS 0x2 114#define AUXIO_SBUS 0x4 115 116 struct mtx sc_lock; 117}; 118 119static void auxio_led_func(void *arg, int onoff); 120static int auxio_attach_common(struct auxio_softc *); 121static int auxio_bus_probe(device_t); 122static int auxio_sbus_attach(device_t); 123static int auxio_ebus_attach(device_t); 124static int auxio_bus_detach(device_t); 125static void auxio_free_resource(struct auxio_softc *); 126static __inline u_int32_t auxio_led_read(struct auxio_softc *); 127static __inline void auxio_led_write(struct auxio_softc *, u_int32_t); 128 129/* SBus */ 130static device_method_t auxio_sbus_methods[] = { 131 DEVMETHOD(device_probe, auxio_bus_probe), 132 DEVMETHOD(device_attach, auxio_sbus_attach), 133 DEVMETHOD(device_detach, auxio_bus_detach), 134 {0, 0} 135}; 136 137static driver_t auxio_sbus_driver = { 138 "auxio", 139 auxio_sbus_methods, 140 sizeof(struct auxio_softc) 141}; 142 143static devclass_t auxio_devclass; 144DRIVER_MODULE(auxio, sbus, auxio_sbus_driver, auxio_devclass, 0, 0); 145MODULE_DEPEND(auxio, sbus, 1, 1, 1); 146 147/* EBus */ 148static device_method_t auxio_ebus_methods[] = { 149 DEVMETHOD(device_probe, auxio_bus_probe), 150 DEVMETHOD(device_attach, auxio_ebus_attach), 151 DEVMETHOD(device_detach, auxio_bus_detach), 152 {0, 0} 153}; 154 155static driver_t auxio_ebus_driver = { 156 "auxio", 157 auxio_ebus_methods, 158 sizeof(struct auxio_softc) 159}; 160 161DRIVER_MODULE(auxio, ebus, auxio_ebus_driver, auxio_devclass, 0, 0); 162MODULE_DEPEND(auxio, ebus, 1, 1, 1); 163MODULE_VERSION(auxio, 1); 164 165#define AUXIO_LOCK_INIT(sc) \ 166 mtx_init(&sc->sc_lock, "auxio mtx", NULL, MTX_DEF) 167#define AUXIO_LOCK(sc) mtx_lock(&sc->sc_lock) 168#define AUXIO_UNLOCK(sc) mtx_unlock(&sc->sc_lock) 169#define AUXIO_LOCK_DESTROY(sc) mtx_destroy(&sc->sc_lock) 170 171static __inline void 172auxio_led_write(struct auxio_softc *sc, u_int32_t v) 173{ 174 if (sc->sc_flags & AUXIO_EBUS) 175 bus_space_write_4(sc->sc_regt[AUXIO_PCIO_LED], 176 sc->sc_regh[AUXIO_PCIO_LED], 0, v); 177 else 178 bus_space_write_1(sc->sc_regt[AUXIO_PCIO_LED], 179 sc->sc_regh[AUXIO_PCIO_LED], 0, v); 180} 181 182static __inline u_int32_t 183auxio_led_read(struct auxio_softc *sc) 184{ 185 u_int32_t led; 186 187 if (sc->sc_flags & AUXIO_EBUS) 188 led = bus_space_read_4(sc->sc_regt[AUXIO_PCIO_LED], 189 sc->sc_regh[AUXIO_PCIO_LED], 0); 190 else 191 led = bus_space_read_1(sc->sc_regt[AUXIO_PCIO_LED], 192 sc->sc_regh[AUXIO_PCIO_LED], 0); 193 194 return (led); 195} 196 197static void 198auxio_led_func(void *arg, int onoff) 199{ 200 struct auxio_softc *sc; 201 u_int32_t led; 202 203 sc = (struct auxio_softc *)arg; 204 205 AUXIO_LOCK(sc); 206 /* 207 * NB: We must not touch the other bits of the SBus AUXIO reg. 208 */ 209 led = auxio_led_read(sc); 210 if (onoff) 211 led |= AUXIO_LED_LED; 212 else 213 led &= ~AUXIO_LED_LED; 214 auxio_led_write(sc, led); 215 AUXIO_UNLOCK(sc); 216} 217 218static int 219auxio_bus_probe(device_t dev) 220{ 221 const char *name; 222 223 name = ofw_bus_get_name(dev); 224 if (strcmp("auxio", name) == 0) { 225 device_set_desc(dev, "Sun Auxiliary I/O"); 226 return (0); 227 } 228 229 return (ENXIO); 230} 231 232static int 233auxio_ebus_attach(device_t dev) 234{ 235 struct auxio_softc *sc; 236 237 sc = device_get_softc(dev); 238 sc->sc_dev = dev; 239 240 AUXIO_LOCK_INIT(sc); 241 sc->sc_nauxio = AUXIO_PCIO_NREG; 242 sc->sc_flags = AUXIO_LEDONLY | AUXIO_EBUS; 243 244 return(auxio_attach_common(sc)); 245} 246 247static int 248auxio_attach_common(struct auxio_softc *sc) 249{ 250 struct resource *res; 251 int i; 252 253 for (i = 0; i < sc->sc_nauxio; i++) { 254 sc->sc_rid[i] = i; 255 res = bus_alloc_resource_any(sc->sc_dev, SYS_RES_MEMORY, 256 &sc->sc_rid[i], RF_ACTIVE); 257 if (res == NULL) { 258 device_printf(sc->sc_dev, 259 "could not allocate resources\n"); 260 goto attach_fail; 261 } 262 sc->sc_res[i] = res; 263 sc->sc_regt[i] = rman_get_bustag(res); 264 sc->sc_regh[i] = rman_get_bushandle(res); 265 } 266 267 sc->sc_led_stat = auxio_led_read(sc) & AUXIO_LED_LED; 268 sc->sc_led_dev = led_create(auxio_led_func, sc, "auxioled"); 269 /* turn on the LED */ 270 auxio_led_func(sc, 1); 271 272 return (0); 273 274attach_fail: 275 auxio_free_resource(sc); 276 277 return (ENXIO); 278} 279 280static int 281auxio_bus_detach(device_t dev) 282{ 283 struct auxio_softc *sc; 284 285 sc = device_get_softc(dev); 286 led_destroy(sc->sc_led_dev); 287 auxio_led_func(sc, sc->sc_led_stat); 288 auxio_free_resource(sc); 289 290 return (0); 291} 292 293static void 294auxio_free_resource(struct auxio_softc *sc) 295{ 296 int i; 297 298 for (i = 0; i < sc->sc_nauxio; i++) 299 if (sc->sc_res[i]) 300 bus_release_resource(sc->sc_dev, SYS_RES_MEMORY, 301 sc->sc_rid[i], sc->sc_res[i]); 302 AUXIO_LOCK_DESTROY(sc); 303} 304 305static int 306auxio_sbus_attach(device_t dev) 307{ 308 struct auxio_softc *sc; 309 310 sc = device_get_softc(dev); 311 sc->sc_dev = dev; 312 313 AUXIO_LOCK_INIT(sc); 314 sc->sc_nauxio = 1; 315 sc->sc_flags = AUXIO_LEDONLY | AUXIO_SBUS; 316 317 return (auxio_attach_common(sc)); 318} 319