Home | History | Annotate | Line # | Download | only in dev
admgpio.c revision 1.1 
      1 /* $NetBSD: admgpio.c,v 1.1 2007/03/20 08:52:01 dyoung Exp $ */
      2 
      3 /*-
      4  * Copyright (c) 2007 David Young.  All rights reserved.
      5  *
      6  * Redistribution and use in source and binary forms, with or
      7  * without modification, are permitted provided that the following
      8  * conditions are met:
      9  * 1. Redistributions of source code must retain the above copyright
     10  *    notice, this list of conditions and the following disclaimer.
     11  * 2. Redistributions in binary form must reproduce the above
     12  *    copyright notice, this list of conditions and the following
     13  *    disclaimer in the documentation and/or other materials provided
     14  *    with the distribution.
     15  * 3. The name of the author may not be used to endorse or promote
     16  *    products derived from this software without specific prior
     17  *    written permission.
     18  *
     19  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY
     20  * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
     21  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
     22  * PARTICULAR PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR
     23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
     24  * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
     25  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
     26  * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     27  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR
     28  * TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
     29  * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
     30  * OF SUCH DAMAGE.
     31  */
     32 #include <sys/cdefs.h>
     33 
     34 __KERNEL_RCSID(0, "$NetBSD: admgpio.c,v 1.1 2007/03/20 08:52:01 dyoung Exp $");
     35 
     36 #include <sys/param.h>
     37 #include <sys/systm.h>
     38 #include <sys/device.h>
     39 #include <sys/gpio.h>
     40 #include <sys/kernel.h>	/* for hz */
     41 
     42 #include <machine/bus.h>
     43 
     44 #include <dev/gpio/gpiovar.h>
     45 
     46 #include <mips/adm5120/include/adm5120reg.h>
     47 #include <mips/adm5120/include/adm5120var.h>
     48 #include <mips/adm5120/include/adm5120_mainbusvar.h>
     49 
     50 static inline uint32_t
     51 admgpio_read(struct mainbus_softc *sc)
     52 {
     53 	return bus_space_read_4(sc->sc_obiot, sc->sc_gpioh, ADM5120_GPIO0);
     54 }
     55 
     56 static inline void
     57 admgpio_write(struct mainbus_softc *sc, uint32_t val)
     58 {
     59 	bus_space_write_4(sc->sc_obiot, sc->sc_gpioh, ADM5120_GPIO0, val);
     60 }
     61 
     62 static void
     63 admgpio_pin_ctl(void *cookie, int pin, int flags)
     64 {
     65 	struct mainbus_softc *sc = cookie;
     66 	uint32_t gpio0, mask;
     67 
     68 	KASSERT(flags == GPIO_PIN_INPUT || flags == GPIO_PIN_OUTPUT);
     69 
     70 	mask = __SHIFTIN(1 << pin, ADM5120_GPIO0_OE);
     71 	gpio0 = admgpio_read(sc);
     72 
     73 	if (flags == GPIO_PIN_OUTPUT)
     74 		admgpio_write(sc, gpio0 | mask);
     75 	else
     76 		admgpio_write(sc, gpio0 & ~mask);
     77 }
     78 
     79 static int
     80 admgpio_pin_read(void *cookie, int pin)
     81 {
     82 	struct mainbus_softc *sc = cookie;
     83 	uint32_t gpio0, mask;
     84 
     85 	KASSERT(pin >= 0 && pin < 8);
     86 
     87 	if (sc->sc_pins[pin].pin_flags == GPIO_PIN_INPUT)
     88 		mask = __SHIFTIN(1 << pin, ADM5120_GPIO0_IV);
     89 	else
     90 		mask = __SHIFTIN(1 << pin, ADM5120_GPIO0_OV);
     91 
     92 	gpio0 = admgpio_read(sc);
     93 
     94 	return ((gpio0 & mask) != 0) ? GPIO_PIN_HIGH : GPIO_PIN_LOW;
     95 }
     96 
     97 static void
     98 admgpio_pin_write(void *cookie, int pin, int value)
     99 {
    100 	struct mainbus_softc *sc = cookie;
    101 	uint32_t gpio0, mask;
    102 
    103 	KASSERT(pin >= 0 && pin < 8);
    104 
    105 	mask = __SHIFTIN(1 << pin, ADM5120_GPIO0_OV);
    106 	gpio0 = admgpio_read(sc);
    107 
    108 	admgpio_write(sc,
    109 	    (value == GPIO_PIN_HIGH) ? (gpio0 | mask) : (gpio0 & ~mask));
    110 }
    111 
    112 device_t
    113 admgpio_attach(struct mainbus_softc *sc)
    114 {
    115 	int pin;
    116 	uint32_t oe;
    117 	struct gpiobus_attach_args gba;
    118 
    119 	oe = __SHIFTOUT(admgpio_read(sc), ADM5120_GPIO0_OE);
    120 
    121 	for (pin = 0; pin < __arraycount(sc->sc_pins); pin++) {
    122 		sc->sc_pins[pin].pin_num = pin;
    123 		sc->sc_pins[pin].pin_caps = GPIO_PIN_INPUT | GPIO_PIN_OUTPUT;
    124 
    125 		if ((oe & (1 << pin)) != 0)
    126 			sc->sc_pins[pin].pin_flags = GPIO_PIN_OUTPUT;
    127 		else
    128 			sc->sc_pins[pin].pin_flags = GPIO_PIN_INPUT;
    129 
    130 		sc->sc_pins[pin].pin_state = admgpio_pin_read(sc, pin);
    131 	}
    132 
    133 	sc->sc_gp.gp_cookie = sc;
    134 	sc->sc_gp.gp_pin_read = admgpio_pin_read;
    135 	sc->sc_gp.gp_pin_write = admgpio_pin_write;
    136 	sc->sc_gp.gp_pin_ctl = admgpio_pin_ctl;
    137 
    138 	gba.gba_gc = &sc->sc_gp;
    139 	gba.gba_pins = &sc->sc_pins[0];
    140 	gba.gba_npins = __arraycount(sc->sc_pins);
    141 
    142 	/* Attach GPIO framework */
    143 	return config_found_ia(&sc->sc_dev, "gpiobus", &gba, gpiobus_print);
    144 }
    145