auxio.c revision 146965
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 146965 2005-06-04 20:27:39Z 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_MAX 8 99 100struct auxio_softc { 101 struct device *sc_dev; 102 103 int sc_nauxio; 104 struct resource *sc_res[AUXIO_PCIO_MAX]; 105 int sc_rid[AUXIO_PCIO_MAX]; 106 bus_space_tag_t sc_regt[AUXIO_PCIO_MAX]; 107 bus_space_handle_t sc_regh[AUXIO_PCIO_MAX]; 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); 145 146/* EBus */ 147static device_method_t auxio_ebus_methods[] = { 148 DEVMETHOD(device_probe, auxio_bus_probe), 149 DEVMETHOD(device_attach, auxio_ebus_attach), 150 DEVMETHOD(device_detach, auxio_bus_detach), 151 {0, 0} 152}; 153 154static driver_t auxio_ebus_driver = { 155 "auxio", 156 auxio_ebus_methods, 157 sizeof(struct auxio_softc) 158}; 159 160DRIVER_MODULE(auxio, ebus, auxio_ebus_driver, auxio_devclass, 0, 0); 161MODULE_VERSION(auxio, 1); 162 163#define AUXIO_LOCK_INIT(sc) \ 164 mtx_init(&sc->sc_lock, "auxio mtx", NULL, MTX_DEF) 165#define AUXIO_LOCK(sc) mtx_lock(&sc->sc_lock) 166#define AUXIO_UNLOCK(sc) mtx_unlock(&sc->sc_lock) 167#define AUXIO_LOCK_DESTROY(sc) mtx_destroy(&sc->sc_lock) 168 169static __inline void 170auxio_led_write(struct auxio_softc *sc, u_int32_t v) 171{ 172 if (sc->sc_flags & AUXIO_EBUS) 173 bus_space_write_4(sc->sc_regt[AUXIO_PCIO_LED], 174 sc->sc_regh[AUXIO_PCIO_LED], 0, v); 175 else 176 bus_space_write_1(sc->sc_regt[AUXIO_PCIO_LED], 177 sc->sc_regh[AUXIO_PCIO_LED], 0, v); 178} 179 180static __inline u_int32_t 181auxio_led_read(struct auxio_softc *sc) 182{ 183 u_int32_t led; 184 185 if (sc->sc_flags & AUXIO_EBUS) 186 led = bus_space_read_4(sc->sc_regt[AUXIO_PCIO_LED], 187 sc->sc_regh[AUXIO_PCIO_LED], 0); 188 else 189 led = bus_space_read_1(sc->sc_regt[AUXIO_PCIO_LED], 190 sc->sc_regh[AUXIO_PCIO_LED], 0); 191 192 return (led); 193} 194 195static void 196auxio_led_func(void *arg, int onoff) 197{ 198 struct auxio_softc *sc; 199 u_int32_t led; 200 201 sc = (struct auxio_softc *)arg; 202 203 led = onoff ? AUXIO_LED_LED : 0; 204 AUXIO_LOCK(sc); 205 auxio_led_write(sc, led); 206 AUXIO_UNLOCK(sc); 207} 208 209static int 210auxio_bus_probe(device_t dev) 211{ 212 const char *name; 213 214 name = ofw_bus_get_name(dev); 215 if (strcmp("auxio", name) == 0) { 216 device_set_desc(dev, "Sun Auxiliary I/O"); 217 return (0); 218 } 219 220 return (ENXIO); 221} 222 223static int 224auxio_ebus_attach(device_t dev) 225{ 226 struct auxio_softc *sc; 227 u_long start, count; 228 int i; 229 230 sc = device_get_softc(dev); 231 bzero(sc, sizeof(*sc)); 232 sc->sc_dev = dev; 233 234 AUXIO_LOCK_INIT(sc); 235 for (i = 0; 236 i < AUXIO_PCIO_MAX && 237 bus_get_resource(dev, SYS_RES_MEMORY, i, &start, &count) == 0; i++) 238 if (bootverbose) 239 device_printf(sc->sc_dev, 240 "Got rid %d, start %#lx, count %#lx\n", 241 i, start, count); 242 if (i < 1) { 243 device_printf(dev, "no LED resource\n"); 244 return (ENXIO); 245 } 246 sc->sc_nauxio = i; 247 sc->sc_flags = AUXIO_LEDONLY | AUXIO_EBUS; 248 249 return(auxio_attach_common(sc)); 250} 251 252static int 253auxio_attach_common(struct auxio_softc *sc) 254{ 255 struct resource *res; 256 int i; 257 258 for (i = 0; i < sc->sc_nauxio; i++) { 259 sc->sc_rid[i] = i; 260 res = bus_alloc_resource_any(sc->sc_dev, SYS_RES_MEMORY, 261 &sc->sc_rid[i], RF_ACTIVE); 262 if (res == NULL) { 263 device_printf(sc->sc_dev, 264 "could not allocate resources\n"); 265 goto attach_fail; 266 } 267 sc->sc_res[i] = res; 268 sc->sc_regt[i] = rman_get_bustag(res); 269 sc->sc_regh[i] = rman_get_bushandle(res); 270 } 271 272 sc->sc_led_stat = auxio_led_read(sc); 273 sc->sc_led_dev = led_create(auxio_led_func, sc, "auxioled"); 274 /* turn on the LED */ 275 auxio_led_func(sc, 1); 276 277 return (0); 278 279attach_fail: 280 auxio_free_resource(sc); 281 282 return (ENXIO); 283} 284 285static int 286auxio_bus_detach(device_t dev) 287{ 288 struct auxio_softc *sc; 289 290 sc = device_get_softc(dev); 291 led_destroy(sc->sc_led_dev); 292 auxio_led_func(sc, sc->sc_led_stat); 293 auxio_free_resource(sc); 294 295 return (0); 296} 297 298static void 299auxio_free_resource(struct auxio_softc *sc) 300{ 301 int i; 302 303 for (i = 0; i < sc->sc_nauxio; i++) 304 if (sc->sc_res[i]) 305 bus_release_resource(sc->sc_dev, SYS_RES_MEMORY, 306 sc->sc_rid[i], sc->sc_res[i]); 307 AUXIO_LOCK_DESTROY(sc); 308} 309 310static int 311auxio_sbus_attach(device_t dev) 312{ 313 struct auxio_softc *sc; 314 315 sc = device_get_softc(dev); 316 bzero(sc, sizeof(*sc)); 317 sc->sc_dev = dev; 318 319 AUXIO_LOCK_INIT(sc); 320 sc->sc_nauxio = 1; 321 sc->sc_flags = AUXIO_LEDONLY | AUXIO_SBUS; 322 323 return (auxio_attach_common(sc)); 324} 325