#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/gpio.h>
#include <machine/bus.h>
#include <machine/intr.h>
#include <dev/isa/isavar.h>
#include <dev/gpio/gpiovar.h>
#define ISAGPIO_IOSIZE 1
#define ISAGPIO_NPINS 8
struct isagpio_softc {
struct device sc_dev;
bus_space_tag_t sc_iot;
bus_space_handle_t sc_ioh;
struct gpio_chipset_tag sc_gpio_gc;
struct gpio_pin sc_gpio_pins[ISAGPIO_NPINS];
u_int8_t sc_gpio_mask;
};
int isagpio_match(struct device *, void *, void *);
void isagpio_attach(struct device *, struct device *, void *);
int isagpio_pin_read(void *, int);
void isagpio_pin_write(void *, int, int);
void isagpio_pin_ctl(void *, int, int);
const struct cfattach isagpio_ca = {
sizeof(struct isagpio_softc), isagpio_match, isagpio_attach
};
struct cfdriver isagpio_cd = {
NULL, "isagpio", DV_DULL
};
int
isagpio_match(struct device *parent, void *match, void *aux)
{
struct isa_attach_args *ia = aux;
bus_space_handle_t ioh;
if (ia->ia_iobase == -1 || bus_space_map(ia->ia_iot, ia->ia_iobase,
ISAGPIO_IOSIZE, 0, &ioh) != 0)
return (0);
bus_space_unmap(ia->ia_iot, ioh, ISAGPIO_IOSIZE);
ia->ia_iosize = ISAGPIO_IOSIZE;
ia->ipa_nio = 1;
ia->ipa_nmem = 0;
ia->ipa_nirq = 0;
ia->ipa_ndrq = 0;
return (1);
}
void
isagpio_attach(struct device *parent, struct device *self, void *aux)
{
struct isagpio_softc *sc = (void *)self;
struct isa_attach_args *ia = aux;
struct gpiobus_attach_args gba;
int i;
if (bus_space_map(ia->ia_iot, ia->ia_iobase, ia->ia_iosize, 0,
&sc->sc_ioh) != 0) {
printf(": can't map i/o space\n");
return;
}
printf("\n");
sc->sc_iot = ia->ia_iot;
sc->sc_gpio_mask = 0;
for (i = 0; i < ISAGPIO_NPINS; i++) {
sc->sc_gpio_pins[i].pin_num = i;
sc->sc_gpio_pins[i].pin_caps = GPIO_PIN_INPUT | GPIO_PIN_OUTPUT;
sc->sc_gpio_pins[i].pin_state = GPIO_PIN_LOW;
}
sc->sc_gpio_gc.gp_cookie = sc;
sc->sc_gpio_gc.gp_pin_read = isagpio_pin_read;
sc->sc_gpio_gc.gp_pin_write = isagpio_pin_write;
sc->sc_gpio_gc.gp_pin_ctl = isagpio_pin_ctl;
gba.gba_name = "gpio";
gba.gba_gc = &sc->sc_gpio_gc;
gba.gba_pins = sc->sc_gpio_pins;
gba.gba_npins = ISAGPIO_NPINS;
(void)config_found(&sc->sc_dev, &gba, gpiobus_print);
}
int
isagpio_pin_read(void *arg, int pin)
{
struct isagpio_softc *sc = arg;
u_int8_t mask;
mask = bus_space_read_1(sc->sc_iot, sc->sc_ioh, 0);
return ((mask >> pin) & 0x01);
}
void
isagpio_pin_write(void *arg, int pin, int value)
{
struct isagpio_softc *sc = arg;
if (value == GPIO_PIN_LOW)
sc->sc_gpio_mask &= ~(0x01 << pin);
else if (value == GPIO_PIN_HIGH)
sc->sc_gpio_mask |= 0x01 << pin;
bus_space_write_1(sc->sc_iot, sc->sc_ioh, 0, sc->sc_gpio_mask);
}
void
isagpio_pin_ctl(void *arg, int pin, int flags)
{
}