#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: ppbus_gpio.c,v 1.3 2021/08/07 16:19:15 thorpej Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/gpio.h>
#include <sys/kernel.h>
#include <dev/gpio/gpiovar.h>
#include <dev/ppbus/ppbus_conf.h>
#include <dev/ppbus/ppbus_base.h>
#include <dev/ppbus/ppbus_io.h>
static int gpio_ppbus_open(void *, device_t);
static void gpio_ppbus_close(void *, device_t);
static int gpio_ppbus_pin_read(void *, int);
static void gpio_ppbus_pin_write(void *, int, int);
static void gpio_ppbus_pin_ctl(void *, int, int);
#define PORT(r, b, i) { PPBUS_R##r##TR, PPBUS_W##r##TR, b, i}
static const struct {
u_char rreg;
u_char wreg;
u_char bit;
u_char inv;
} ppbus_port[PPBUS_NPINS] = {
PORT(C, 0, 1),
PORT(D, 0, 0),
PORT(D, 1, 0),
PORT(D, 2, 0),
PORT(D, 3, 0),
PORT(D, 4, 0),
PORT(D, 5, 0),
PORT(D, 6, 0),
PORT(D, 7, 0),
PORT(S, 6, 0),
PORT(S, 7, 1),
PORT(S, 5, 0),
PORT(S, 4, 0),
PORT(C, 1, 1),
PORT(S, 3, 0),
PORT(C, 2, 0),
PORT(C, 3, 1),
};
void
gpio_ppbus_attach(struct ppbus_softc *sc)
{
struct gpiobus_attach_args gba;
gpio_pin_t *pin;
int i;
for (pin = &sc->sc_gpio_pins[0], i = 0; i < PPBUS_NPINS; pin++, i++) {
pin->pin_num = i;
if (((i >= 9) && (i <= 12)) || (i == 14)) {
pin->pin_caps = GPIO_PIN_INPUT;
pin->pin_flags = GPIO_PIN_INPUT;
pin->pin_state = gpio_ppbus_pin_read(sc, i);
} else {
pin->pin_caps = GPIO_PIN_OUTPUT;
pin->pin_flags = GPIO_PIN_OUTPUT;
pin->pin_state = GPIO_PIN_LOW;
gpio_ppbus_pin_write(sc, i, pin->pin_state);
}
gpio_ppbus_pin_ctl(sc, i, pin->pin_flags);
}
sc->sc_gpio_gc.gp_cookie = sc;
sc->sc_gpio_gc.gp_gc_open = gpio_ppbus_open;
sc->sc_gpio_gc.gp_gc_close = gpio_ppbus_close;
sc->sc_gpio_gc.gp_pin_read = gpio_ppbus_pin_read;
sc->sc_gpio_gc.gp_pin_write = gpio_ppbus_pin_write;
sc->sc_gpio_gc.gp_pin_ctl = gpio_ppbus_pin_ctl;
gba.gba_gc = &sc->sc_gpio_gc;
gba.gba_pins = sc->sc_gpio_pins;
gba.gba_npins = PPBUS_NPINS;
config_found(sc->sc_dev, &gba, gpiobus_print,
CFARGS(.iattr = "gpiobus"));
}
static int
gpio_ppbus_open(void *arg, device_t dev)
{
struct ppbus_softc *sc = arg;
return ppbus_request_bus(sc->sc_dev, dev, PPBUS_WAIT|PPBUS_INTR, (hz));
}
static void
gpio_ppbus_close(void *arg, device_t dev)
{
struct ppbus_softc *sc = arg;
(void) ppbus_release_bus(sc->sc_dev, dev, PPBUS_WAIT|PPBUS_INTR, (hz));
}
static int
gpio_ppbus_pin_read(void *arg, int pin)
{
struct ppbus_softc *sc = arg;
u_char port = ppbus_io(sc->sc_dev, ppbus_port[pin].rreg, NULL, 0, 0);
return ((port >> ppbus_port[pin].bit) & 1) ^ ppbus_port[pin].inv;
}
static void
gpio_ppbus_pin_write(void *arg, int pin, int value)
{
struct ppbus_softc *sc = arg;
u_char port = ppbus_io(sc->sc_dev, ppbus_port[pin].rreg, NULL, 0, 0);
value ^= ppbus_port[pin].inv;
value <<= ppbus_port[pin].bit;
port &= ~(1 << ppbus_port[pin].bit);
port |= value;
ppbus_io(sc->sc_dev, ppbus_port[pin].wreg, NULL, 0, port);
}
static void
gpio_ppbus_pin_ctl(void *arg, int pin, int flags)
{
}