Home | History | Annotate | Line # | Download | only in dev
auxio.c revision 1.22.12.1 
      1 /*	$NetBSD: auxio.c,v 1.22.12.1 2017/12/03 11:36:44 jdolecek Exp $	*/
      2 
      3 /*
      4  * Copyright (c) 2000, 2001, 2015 Matthew R. Green
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  *
     16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     21  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     22  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     23  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     24  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     26  * SUCH DAMAGE.
     27  */
     28 
     29 /*
     30  * AUXIO registers support on the sbus & ebus2, used for the floppy driver
     31  * and to control the system LED, for the BLINK option.
     32  */
     33 
     34 #include <sys/cdefs.h>
     35 __KERNEL_RCSID(0, "$NetBSD: auxio.c,v 1.22.12.1 2017/12/03 11:36:44 jdolecek Exp $");
     36 
     37 #include "opt_auxio.h"
     38 
     39 #include <sys/param.h>
     40 #include <sys/systm.h>
     41 #include <sys/kernel.h>
     42 #include <sys/callout.h>
     43 #include <sys/errno.h>
     44 #include <sys/device.h>
     45 #include <sys/malloc.h>
     46 
     47 #include <machine/autoconf.h>
     48 #include <machine/cpu.h>
     49 
     50 #include <dev/ebus/ebusreg.h>
     51 #include <dev/ebus/ebusvar.h>
     52 #include <dev/sbus/sbusvar.h>
     53 #include <sparc64/dev/auxioreg.h>
     54 #include <sparc64/dev/auxiovar.h>
     55 
     56 static uint32_t	auxio_read_led(struct auxio_softc *);
     57 static void	auxio_write_led(struct auxio_softc *, uint32_t);
     58 void	auxio_attach_common(struct auxio_softc *);
     59 
     60 extern struct cfdriver auxio_cd;
     61 
     62 static __inline__ uint32_t
     63 auxio_read_led(struct auxio_softc *sc)
     64 {
     65 	uint32_t led;
     66 
     67 	if (sc->sc_flags & AUXIO_EBUS)
     68 		led = le32toh(bus_space_read_4(sc->sc_tag, sc->sc_led, 0));
     69 	else
     70 		led = bus_space_read_1(sc->sc_tag, sc->sc_led, 0);
     71 
     72 	return led;
     73 }
     74 
     75 static __inline__ void
     76 auxio_write_led(struct auxio_softc *sc, uint32_t led)
     77 {
     78 
     79 	if (sc->sc_flags & AUXIO_EBUS)
     80 		bus_space_write_4(sc->sc_tag, sc->sc_led, 0, htole32(led));
     81 	else
     82 		bus_space_write_1(sc->sc_tag, sc->sc_led, 0, led);
     83 }
     84 
     85 #ifdef BLINK
     86 static callout_t blink_ch;
     87 static void auxio_blink(void *);
     88 
     89 /* let someone disable it if it's already turned on; XXX sysctl? */
     90 int do_blink = 1;
     91 
     92 static void
     93 auxio_blink(void *x)
     94 {
     95 	struct auxio_softc *sc = x;
     96 	int s;
     97 	uint32_t led;
     98 
     99 	if (do_blink == 0)
    100 		return;
    101 
    102 	mutex_enter(&sc->sc_lock);
    103 	led = auxio_read_led(sc);
    104 	led = led ^ AUXIO_LED_LED;
    105 	auxio_write_led(sc, led);
    106 	mutex_exit(&sc->sc_lock);
    107 
    108 	/*
    109 	 * Blink rate is:
    110 	 *	full cycle every second if completely idle (loadav = 0)
    111 	 *	full cycle every 2 seconds if loadav = 1
    112 	 *	full cycle every 3 seconds if loadav = 2
    113 	 * etc.
    114 	 */
    115 	s = (((averunnable.ldavg[0] + FSCALE) * hz) >> (FSHIFT + 1));
    116 	callout_reset(&blink_ch, s, auxio_blink, sc);
    117 }
    118 #endif
    119 
    120 void
    121 auxio_attach_common(struct auxio_softc *sc)
    122 {
    123 	static int do_once = 1;
    124 
    125 	/* only start one blinker */
    126 	if (do_once) {
    127 		mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_HIGH);
    128 #ifdef BLINK
    129 		callout_init(&blink_ch, CALLOUT_MPSAFE);
    130 		auxio_blink(sc);
    131 #endif
    132 		do_once = 0;
    133 	}
    134 	printf("\n");
    135 }
    136 
    137 int
    138 auxio_fd_control(u_int32_t bits)
    139 {
    140 	struct auxio_softc *sc;
    141 	u_int32_t led;
    142 
    143 	if (auxio_cd.cd_ndevs == 0) {
    144 		return ENXIO;
    145 	}
    146 
    147 	/*
    148 	 * XXX This does not handle > 1 auxio correctly.
    149 	 * We'll assume the floppy drive is tied to first auxio found.
    150 	 */
    151 	sc = device_lookup_private(&auxio_cd, 0);
    152 	if (!sc) {
    153 		return ENXIO;
    154 	}
    155 
    156 	mutex_enter(&sc->sc_lock);
    157 	led = auxio_read_led(sc);
    158 	led = (led & ~AUXIO_LED_FLOPPY_MASK) | bits;
    159 	auxio_write_led(sc, led);
    160 	mutex_exit(&sc->sc_lock);
    161 
    162 	return 0;
    163 }
    164