654 lines
18 KiB
C
654 lines
18 KiB
C
/* $NetBSD: nct.c,v 1.5 2021/08/07 16:19:12 thorpej Exp $ */
|
|
|
|
/*-
|
|
* Copyright (c) 2019, 2020 The NetBSD Foundation, Inc.
|
|
* All rights reserved.
|
|
*
|
|
* This code is derived from software contributed to The NetBSD Foundation
|
|
* by Andrew Doran.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
|
|
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
|
|
* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
|
|
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
|
|
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
|
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
|
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
|
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
|
* POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
/*
|
|
* Nuvoton NCT5104D
|
|
*
|
|
* - GPIO: full support.
|
|
* - Watchdog: no support. Watchdog uses GPIO pins.
|
|
* - UARTS: handled by com driver. 3rd & 4th UARTs use GPIO pins.
|
|
*
|
|
* If asked to probe with a wildcard address, we'll only do so if known to
|
|
* be running on a PC Engines system. Probe is invasive.
|
|
*
|
|
* Register access on Super I/O chips typically involves one or two levels
|
|
* of indirection, so we try hard to avoid needless register access.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__KERNEL_RCSID(0, "$NetBSD: nct.c,v 1.5 2021/08/07 16:19:12 thorpej Exp $");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/types.h>
|
|
#include <sys/device.h>
|
|
#include <sys/module.h>
|
|
#include <sys/bus.h>
|
|
#include <sys/gpio.h>
|
|
|
|
#include <machine/autoconf.h>
|
|
|
|
#include <dev/isa/isavar.h>
|
|
|
|
#include <dev/gpio/gpiovar.h>
|
|
|
|
/*
|
|
* Hardware interface definition (enough for GPIO only).
|
|
*/
|
|
|
|
/* I/O basics */
|
|
#define NCT_IOBASE_A 0x2e
|
|
#define NCT_IOBASE_B 0x4e
|
|
#define NCT_IOSIZE 2
|
|
#define NCT_CHIP_ID_1 0x1061
|
|
#define NCT_CHIP_ID_2 0xc452 /* PC Engines APU */
|
|
#define NCT_NUM_PINS 17
|
|
|
|
/* Enable/disable keys */
|
|
#define NCT_KEY_UNLOCK 0x87
|
|
#define NCT_KEY_LOCK 0xaa
|
|
|
|
/* I/O ports */
|
|
#define NCT_PORT_SELECT 0
|
|
#define NCT_PORT_DATA 1
|
|
|
|
/* Global registers */
|
|
#define GD_DEVSEL 0x0007 /* logical device select */
|
|
#define GD_MULTIFUN 0x001c /* multi function selection */
|
|
#define GD_MULTIFUN_GPIO1 0x04 /* clr: gpio1 available */
|
|
#define GD_MULTIFUN_GPIO0 0x08 /* clr: gpio0 available */
|
|
#define GD_MULTIFUN_GPIO67 0x10 /* set: gpio67 available */
|
|
#define GD_GLOBOPT 0x0027 /* global option */
|
|
#define GD_GLOBOPT_GPIO67 0x04 /* clr: gpio67 available */
|
|
#define GD_ID_HIGH 0x0020 /* ID high byte */
|
|
#define GD_ID_LOW 0x0021 /* ID low byte */
|
|
|
|
/* Logical device 7 */
|
|
#define LD7_ENABLE 0x0730 /* GPIO function enable */
|
|
#define LD7_ENABLE_GPIO0 0x01
|
|
#define LD7_ENABLE_GPIO1 0x02
|
|
#define LD7_ENABLE_GPIO67 0x40
|
|
#define LD7_GPIO0_DIRECTION 0x07e0 /* clr for output, set for input */
|
|
#define LD7_GPIO0_DATA 0x07e1 /* current status */
|
|
#define LD7_GPIO0_INVERSION 0x07e2 /* set to invert i/o */
|
|
#define LD7_GPIO0_STATUS 0x07e3 /* edge detect, reading clears */
|
|
#define LD7_GPIO1_DIRECTION 0x07e4 /* clr for output, set for input */
|
|
#define LD7_GPIO1_DATA 0x07e5 /* current status */
|
|
#define LD7_GPIO1_INVERSION 0x07e6 /* set to invert i/o */
|
|
#define LD7_GPIO1_STATUS 0x07e7 /* edge detect, reading clears */
|
|
#define LD7_GPIO67_DIRECTION 0x07f8 /* clr for output, set for input */
|
|
#define LD7_GPIO67_DATA 0x07f9 /* current status */
|
|
#define LD7_GPIO67_INVERSION 0x07fa /* set to invert i/o */
|
|
#define LD7_GPIO67_STATUS 0x07fb /* edge detect, reading clears */
|
|
|
|
/* Logical device 8 */
|
|
#define LD8_DEVCFG 0x0830 /* WDT/GPIO device config */
|
|
#define LD8_GPIO0_MULTIFUNC 0x08e0 /* clr: gpio, set: pin unusable */
|
|
#define LD8_GPIO1_MULTIFUNC 0x08e1 /* clr: gpio, set: pin unusable */
|
|
#define LD8_GPIO67_MULTIFUNC 0x08e7 /* clr: gpio, set: pin unusable */
|
|
|
|
/* Logical device 10 */
|
|
#define LDA_UARTC_ENABLE 0x0a30 /* bit 0: UARTC active */
|
|
|
|
/* Logical device 11 */
|
|
#define LDB_UARTD_ENABLE 0x0b30 /* bit 0: UARTD active */
|
|
|
|
/* Logical device 15 */
|
|
#define LDF_GPIO0_OUTMODE 0x0fe0 /* clr: push/pull, set: open drain */
|
|
#define LDF_GPIO1_OUTMODE 0x0fe1 /* clr: push/pull, set: open drain */
|
|
#define LDF_GPIO67_OUTMODE 0x0fe6 /* clr: push/pull, set: open drain */
|
|
|
|
/*
|
|
* Internal GPIO bank description, including register addresses and cached
|
|
* register content.
|
|
*/
|
|
struct nct_bank {
|
|
/* Pin descriptions */
|
|
u_int8_t nb_firstpin;
|
|
u_int8_t nb_numpins;
|
|
u_int8_t nb_enabled;
|
|
|
|
/* Cached values */
|
|
u_int8_t nb_val_dir;
|
|
u_int8_t nb_val_inv;
|
|
u_int8_t nb_val_mode;
|
|
|
|
/* Register addresses */
|
|
u_int16_t nb_reg_dir;
|
|
u_int16_t nb_reg_data;
|
|
u_int16_t nb_reg_inv;
|
|
u_int16_t nb_reg_stat;
|
|
u_int16_t nb_reg_mode;
|
|
};
|
|
|
|
/*
|
|
* Driver instance.
|
|
*/
|
|
struct nct_softc {
|
|
device_t sc_dev; /* MI device */
|
|
bus_space_tag_t sc_iot; /* I/O tag */
|
|
bus_space_handle_t sc_ioh; /* I/O handle */
|
|
struct gpio_chipset_tag sc_gc; /* GPIO tag */
|
|
gpio_pin_t sc_pins[NCT_NUM_PINS]; /* GPIO pin descr. */
|
|
|
|
/* Access to the remaining members is covered by sc_lock. */
|
|
kmutex_t sc_lock; /* Serialization */
|
|
int sc_curdev; /* Cur. logical dev */
|
|
int sc_curreg; /* Cur. register */
|
|
struct nct_bank sc_bank[3]; /* Bank descriptions */
|
|
};
|
|
|
|
static void nct_attach(device_t, device_t, void *);
|
|
static int nct_detach(device_t, int);
|
|
static void nct_gpio_ctl(void *, int, int);
|
|
static int nct_gpio_read(void *, int);
|
|
static void nct_gpio_write(void *, int, int);
|
|
static int nct_match(device_t, cfdata_t , void *);
|
|
static u_int8_t nct_rd(struct nct_softc *, int);
|
|
static struct nct_bank *nct_sel(struct nct_softc *, int, u_int8_t *);
|
|
static void nct_wr(struct nct_softc *, int, u_int8_t);
|
|
|
|
static inline void
|
|
nct_outb(struct nct_softc *sc, int reg, u_int8_t data)
|
|
{
|
|
|
|
bus_space_write_1(sc->sc_iot, sc->sc_ioh, reg, data);
|
|
}
|
|
|
|
static inline u_int8_t
|
|
nct_inb(struct nct_softc *sc, int reg)
|
|
{
|
|
|
|
return bus_space_read_1(sc->sc_iot, sc->sc_ioh, reg);
|
|
}
|
|
|
|
CFATTACH_DECL_NEW(nct,
|
|
sizeof(struct nct_softc),
|
|
nct_match,
|
|
nct_attach,
|
|
nct_detach,
|
|
NULL);
|
|
|
|
MODULE(MODULE_CLASS_DRIVER, nct, "gpio");
|
|
|
|
/*
|
|
* Module linkage.
|
|
*/
|
|
#ifdef _MODULE
|
|
#include "ioconf.c"
|
|
#endif
|
|
|
|
static int
|
|
nct_modcmd(modcmd_t cmd, void *priv)
|
|
{
|
|
int error = 0;
|
|
|
|
switch (cmd) {
|
|
case MODULE_CMD_INIT:
|
|
#ifdef _MODULE
|
|
error = config_init_component(cfdriver_ioconf_nct,
|
|
cfattach_ioconf_nct, cfdata_ioconf_nct);
|
|
#endif
|
|
return error;
|
|
case MODULE_CMD_FINI:
|
|
#ifdef _MODULE
|
|
error = config_fini_component(cfdriver_ioconf_nct,
|
|
cfattach_ioconf_nct, cfdata_ioconf_nct);
|
|
#endif
|
|
return error;
|
|
default:
|
|
return ENOTTY;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Probe for device.
|
|
*/
|
|
static int
|
|
nct_match(device_t parent, cfdata_t match, void *aux)
|
|
{
|
|
int ioaddrs[2] = { 0x2e, 0x4e };
|
|
struct isa_attach_args *ia = aux;
|
|
bus_space_handle_t ioh;
|
|
int nioaddr, i;
|
|
u_int8_t low, high;
|
|
u_int16_t id;
|
|
const char *vendor;
|
|
|
|
/*
|
|
* Allow override of I/O base address. If no I/O base address is
|
|
* provided, proceed to probe if running on a PC Engines system.
|
|
*/
|
|
if (ia->ia_nio > 0 && ia->ia_io[0].ir_addr != ISA_UNKNOWN_PORT) {
|
|
ioaddrs[0] = ia->ia_io[0].ir_addr;
|
|
nioaddr = 1;
|
|
} else {
|
|
vendor = pmf_get_platform("system-vendor");
|
|
if (vendor != NULL && strstr(vendor, "PC Engines") != NULL) {
|
|
nioaddr = __arraycount(ioaddrs);
|
|
} else {
|
|
nioaddr = 0;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Probe at the selected addresses, if any.
|
|
*/
|
|
for (i = 0; i < nioaddr; i++) {
|
|
if (bus_space_map(ia->ia_iot, ioaddrs[i], NCT_IOSIZE, 0,
|
|
&ioh) != 0) {
|
|
continue;
|
|
}
|
|
/* Unlock chip */
|
|
bus_space_write_1(ia->ia_iot, ioh, NCT_PORT_SELECT,
|
|
NCT_KEY_UNLOCK);
|
|
bus_space_write_1(ia->ia_iot, ioh, NCT_PORT_SELECT,
|
|
NCT_KEY_UNLOCK);
|
|
/* Read ID */
|
|
bus_space_write_1(ia->ia_iot, ioh, NCT_PORT_SELECT, GD_ID_LOW);
|
|
low = bus_space_read_1(ia->ia_iot, ioh, NCT_PORT_DATA);
|
|
bus_space_write_1(ia->ia_iot, ioh, NCT_PORT_SELECT, GD_ID_HIGH);
|
|
high = bus_space_read_1(ia->ia_iot, ioh, NCT_PORT_DATA);
|
|
id = (u_int16_t)low | ((u_int16_t)high << 8);
|
|
bus_space_unmap(ia->ia_iot, ioh, NCT_IOSIZE);
|
|
if (id == NCT_CHIP_ID_1 || id == NCT_CHIP_ID_2) {
|
|
ia->ia_nirq = 0;
|
|
ia->ia_ndrq = 0;
|
|
ia->ia_niomem = 0;
|
|
ia->ia_nio = 1;
|
|
ia->ia_io[0].ir_size = NCT_IOSIZE;
|
|
ia->ia_io[0].ir_addr = ioaddrs[i];
|
|
return 1;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Attach device instance.
|
|
*/
|
|
static void
|
|
nct_attach(device_t parent, device_t self, void *aux)
|
|
{
|
|
struct nct_softc *sc = device_private(self);
|
|
struct isa_attach_args *ia = aux;
|
|
struct gpiobus_attach_args gba;
|
|
struct nct_bank *nb;
|
|
u_int8_t multifun, enable;
|
|
int i, j;
|
|
|
|
/*
|
|
* Set up register space and basics of our state.
|
|
*/
|
|
if (bus_space_map(ia->ia_iot, ia->ia_io[0].ir_addr,
|
|
ia->ia_io[0].ir_size, 0, &sc->sc_ioh) != 0) {
|
|
aprint_normal(": can't map i/o space\n");
|
|
return;
|
|
}
|
|
aprint_normal(": Nuvoton NCT5104D GPIO\n");
|
|
sc->sc_dev = self;
|
|
sc->sc_iot = ia->ia_iot;
|
|
sc->sc_curdev = -1;
|
|
sc->sc_curreg = -1;
|
|
|
|
/*
|
|
* All pin access is funneled through a common, indirect register
|
|
* interface. The gpio framework doesn't serialize calls to our
|
|
* access methods, so do it internally. This is likely such a
|
|
* common requirement that it should be factored out as is done for
|
|
* audio devices, allowing the driver to specify the appropriate
|
|
* locks. Anyhow, acquire the lock immediately to pacify locking
|
|
* assertions.
|
|
*/
|
|
mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_VM);
|
|
mutex_spin_enter(&sc->sc_lock);
|
|
|
|
/*
|
|
* Disable watchdog timer and GPIO alternate I/O mapping.
|
|
*/
|
|
nct_wr(sc, LD8_DEVCFG, 0);
|
|
|
|
/*
|
|
* The BIOS doesn't set things up the way we want. Pfft.
|
|
* Enable all GPIO0/GPIO1 pins.
|
|
*/
|
|
multifun = nct_rd(sc, GD_MULTIFUN);
|
|
nct_wr(sc, GD_MULTIFUN,
|
|
multifun & ~(GD_MULTIFUN_GPIO0 | GD_MULTIFUN_GPIO1));
|
|
nct_wr(sc, LDA_UARTC_ENABLE, 0);
|
|
nct_wr(sc, LD8_GPIO0_MULTIFUNC, 0);
|
|
nct_wr(sc, LDB_UARTD_ENABLE, 0);
|
|
nct_wr(sc, LD8_GPIO1_MULTIFUNC, 0);
|
|
multifun = nct_rd(sc, GD_MULTIFUN);
|
|
enable = nct_rd(sc, LD7_ENABLE) | LD7_ENABLE_GPIO0 | LD7_ENABLE_GPIO1;
|
|
|
|
nb = &sc->sc_bank[0];
|
|
nb->nb_firstpin = 0;
|
|
nb->nb_numpins = 8;
|
|
nb->nb_enabled = 0xff;
|
|
nb->nb_reg_dir = LD7_GPIO0_DIRECTION;
|
|
nb->nb_reg_data = LD7_GPIO0_DATA;
|
|
nb->nb_reg_inv = LD7_GPIO0_INVERSION;
|
|
nb->nb_reg_stat = LD7_GPIO0_STATUS;
|
|
nb->nb_reg_mode = LDF_GPIO0_OUTMODE;
|
|
|
|
nb = &sc->sc_bank[1];
|
|
nb->nb_firstpin = 8;
|
|
nb->nb_numpins = 8;
|
|
nb->nb_enabled = 0xff;
|
|
nb->nb_reg_dir = LD7_GPIO1_DIRECTION;
|
|
nb->nb_reg_data = LD7_GPIO1_DATA;
|
|
nb->nb_reg_inv = LD7_GPIO1_INVERSION;
|
|
nb->nb_reg_stat = LD7_GPIO1_STATUS;
|
|
nb->nb_reg_mode = LDF_GPIO1_OUTMODE;
|
|
|
|
nb = &sc->sc_bank[2];
|
|
nb->nb_firstpin = 16;
|
|
nb->nb_numpins = 1;
|
|
nb->nb_reg_dir = LD7_GPIO67_DIRECTION;
|
|
nb->nb_reg_data = LD7_GPIO67_DATA;
|
|
nb->nb_reg_stat = LD7_GPIO67_STATUS;
|
|
nb->nb_reg_mode = LDF_GPIO67_OUTMODE;
|
|
if ((multifun & GD_MULTIFUN_GPIO67) != 0 &&
|
|
(nct_rd(sc, GD_GLOBOPT) & GD_GLOBOPT_GPIO67) == 0) {
|
|
nct_wr(sc, LD8_GPIO67_MULTIFUNC, 0);
|
|
nb->nb_enabled = 0x01;
|
|
enable |= LD7_ENABLE_GPIO67;
|
|
} else {
|
|
sc->sc_bank[2].nb_enabled = 0;
|
|
}
|
|
|
|
/*
|
|
* Display enabled pins and enable GPIO devices accordingly.
|
|
*/
|
|
nct_wr(sc, LD7_ENABLE, enable);
|
|
mutex_spin_exit(&sc->sc_lock);
|
|
|
|
aprint_normal_dev(self,
|
|
"enabled pins: GPIO0(%02x) GPIO1(%02x) GPIO67(%01x)\n",
|
|
(unsigned)sc->sc_bank[0].nb_enabled,
|
|
(unsigned)sc->sc_bank[1].nb_enabled,
|
|
(unsigned)sc->sc_bank[2].nb_enabled);
|
|
|
|
/*
|
|
* Fill pin descriptions and initialize registers.
|
|
*/
|
|
memset(sc->sc_pins, 0, sizeof(sc->sc_pins));
|
|
for (i = 0; i < __arraycount(sc->sc_bank); i++) {
|
|
nb = &sc->sc_bank[i];
|
|
mutex_spin_enter(&sc->sc_lock);
|
|
nb->nb_val_dir = nct_rd(sc, nb->nb_reg_dir);
|
|
nb->nb_val_inv = nct_rd(sc, nb->nb_reg_inv);
|
|
nb->nb_val_mode = nct_rd(sc, nb->nb_reg_mode);
|
|
mutex_spin_exit(&sc->sc_lock);
|
|
for (j = 0; j < nb->nb_numpins; j++) {
|
|
gpio_pin_t *pin = &sc->sc_pins[nb->nb_firstpin + j];
|
|
pin->pin_num = nb->nb_firstpin + j;
|
|
/* Skip pin if not configured as GPIO. */
|
|
if ((nb->nb_enabled & (1 << j)) == 0) {
|
|
continue;
|
|
}
|
|
pin->pin_caps =
|
|
GPIO_PIN_INPUT | GPIO_PIN_OUTPUT |
|
|
GPIO_PIN_OPENDRAIN |
|
|
GPIO_PIN_PUSHPULL | GPIO_PIN_TRISTATE |
|
|
GPIO_PIN_INVIN | GPIO_PIN_INVOUT;
|
|
pin->pin_flags =
|
|
GPIO_PIN_INPUT | GPIO_PIN_OPENDRAIN;
|
|
nct_gpio_ctl(sc, pin->pin_num, pin->pin_flags);
|
|
pin->pin_state = nct_gpio_read(sc, pin->pin_num);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Attach to gpio framework, and attach all pins unconditionally.
|
|
* If the pins are disabled, we'll ignore any access later.
|
|
*/
|
|
sc->sc_gc.gp_cookie = sc;
|
|
sc->sc_gc.gp_pin_read = nct_gpio_read;
|
|
sc->sc_gc.gp_pin_write = nct_gpio_write;
|
|
sc->sc_gc.gp_pin_ctl = nct_gpio_ctl;
|
|
|
|
gba.gba_gc = &sc->sc_gc;
|
|
gba.gba_pins = sc->sc_pins;
|
|
gba.gba_npins = NCT_NUM_PINS;
|
|
|
|
(void)config_found(sc->sc_dev, &gba, gpiobus_print, CFARGS_NONE);
|
|
}
|
|
|
|
/*
|
|
* Detach device instance.
|
|
*/
|
|
static int
|
|
nct_detach(device_t self, int flags)
|
|
{
|
|
struct nct_softc *sc = device_private(self);
|
|
|
|
bus_space_unmap(sc->sc_iot, sc->sc_ioh, NCT_IOSIZE);
|
|
mutex_destroy(&sc->sc_lock);
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Read byte from specified register.
|
|
*/
|
|
static u_int8_t
|
|
nct_rd(struct nct_softc *sc, int reg)
|
|
{
|
|
int dev;
|
|
|
|
KASSERT(mutex_owned(&sc->sc_lock));
|
|
|
|
dev = reg >> 8;
|
|
reg &= 0xff;
|
|
|
|
if (dev != sc->sc_curdev && dev != 0x00) {
|
|
sc->sc_curdev = dev;
|
|
sc->sc_curreg = reg;
|
|
nct_outb(sc, NCT_PORT_SELECT, GD_DEVSEL);
|
|
nct_outb(sc, NCT_PORT_DATA, dev);
|
|
nct_outb(sc, NCT_PORT_SELECT, reg);
|
|
return nct_inb(sc, NCT_PORT_DATA);
|
|
} else if (reg != sc->sc_curreg) {
|
|
sc->sc_curreg = reg;
|
|
nct_outb(sc, NCT_PORT_SELECT, reg);
|
|
return nct_inb(sc, NCT_PORT_DATA);
|
|
} else {
|
|
return nct_inb(sc, NCT_PORT_DATA);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Write byte to specified register.
|
|
*/
|
|
static void
|
|
nct_wr(struct nct_softc *sc, int reg, u_int8_t data)
|
|
{
|
|
int dev;
|
|
|
|
KASSERT(mutex_owned(&sc->sc_lock));
|
|
|
|
dev = reg >> 8;
|
|
reg &= 0xff;
|
|
|
|
if (dev != sc->sc_curdev && dev != 0x00) {
|
|
sc->sc_curdev = dev;
|
|
sc->sc_curreg = reg;
|
|
nct_outb(sc, NCT_PORT_SELECT, GD_DEVSEL);
|
|
nct_outb(sc, NCT_PORT_DATA, dev);
|
|
nct_outb(sc, NCT_PORT_SELECT, reg);
|
|
nct_outb(sc, NCT_PORT_DATA, data);
|
|
} else if (reg != sc->sc_curreg) {
|
|
sc->sc_curreg = reg;
|
|
nct_outb(sc, NCT_PORT_SELECT, reg);
|
|
nct_outb(sc, NCT_PORT_DATA, data);
|
|
} else {
|
|
nct_outb(sc, NCT_PORT_DATA, data);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Given pin number, return bank and pin mask. This alters no state and so
|
|
* can safely be called without the mutex held.
|
|
*/
|
|
static struct nct_bank *
|
|
nct_sel(struct nct_softc *sc, int pin, u_int8_t *mask)
|
|
{
|
|
struct nct_bank *nb;
|
|
|
|
KASSERT(pin >= 0 && pin < NCT_NUM_PINS);
|
|
nb = &sc->sc_bank[pin >> 3];
|
|
KASSERT(pin >= nb->nb_firstpin);
|
|
KASSERT((pin & 7) < nb->nb_numpins);
|
|
*mask = (u_int8_t)(1 << (pin & 7)) & nb->nb_enabled;
|
|
return nb;
|
|
}
|
|
|
|
/*
|
|
* GPIO hook: read pin.
|
|
*/
|
|
static int
|
|
nct_gpio_read(void *arg, int pin)
|
|
{
|
|
struct nct_softc *sc = arg;
|
|
struct nct_bank *nb;
|
|
u_int8_t data, mask;
|
|
int rv = GPIO_PIN_LOW;
|
|
|
|
nb = nct_sel(sc, pin, &mask);
|
|
if (__predict_true(mask != 0)) {
|
|
mutex_spin_enter(&sc->sc_lock);
|
|
data = nct_rd(sc, nb->nb_reg_data);
|
|
if ((data & mask) != 0) {
|
|
rv = GPIO_PIN_HIGH;
|
|
}
|
|
mutex_spin_exit(&sc->sc_lock);
|
|
}
|
|
return rv;
|
|
}
|
|
|
|
/*
|
|
* GPIO hook: write pin.
|
|
*/
|
|
static void
|
|
nct_gpio_write(void *arg, int pin, int val)
|
|
{
|
|
struct nct_softc *sc = arg;
|
|
struct nct_bank *nb;
|
|
u_int8_t data, mask;
|
|
|
|
nb = nct_sel(sc, pin, &mask);
|
|
if (__predict_true(mask != 0)) {
|
|
mutex_spin_enter(&sc->sc_lock);
|
|
data = nct_rd(sc, nb->nb_reg_data);
|
|
if (val == GPIO_PIN_LOW) {
|
|
data &= ~mask;
|
|
} else if (val == GPIO_PIN_HIGH) {
|
|
data |= mask;
|
|
}
|
|
nct_wr(sc, nb->nb_reg_data, data);
|
|
mutex_spin_exit(&sc->sc_lock);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* GPIO hook: change pin parameters.
|
|
*/
|
|
static void
|
|
nct_gpio_ctl(void *arg, int pin, int flg)
|
|
{
|
|
struct nct_softc *sc = arg;
|
|
struct nct_bank *nb;
|
|
u_int8_t data, mask;
|
|
|
|
nb = nct_sel(sc, pin, &mask);
|
|
if (__predict_false(mask == 0)) {
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* Set input direction early to avoid perturbation.
|
|
*/
|
|
mutex_spin_enter(&sc->sc_lock);
|
|
data = nb->nb_val_dir;
|
|
if ((flg & (GPIO_PIN_INPUT | GPIO_PIN_TRISTATE)) != 0) {
|
|
data |= mask;
|
|
}
|
|
if (data != nb->nb_val_dir) {
|
|
nct_wr(sc, nb->nb_reg_dir, data);
|
|
nb->nb_val_dir = data;
|
|
}
|
|
|
|
/*
|
|
* Set inversion.
|
|
*/
|
|
data = nb->nb_val_inv;
|
|
if ((flg & (GPIO_PIN_OUTPUT | GPIO_PIN_INVOUT)) ==
|
|
(GPIO_PIN_OUTPUT | GPIO_PIN_INVOUT) ||
|
|
(flg & (GPIO_PIN_INPUT | GPIO_PIN_INVIN)) ==
|
|
(GPIO_PIN_INPUT | GPIO_PIN_INVIN)) {
|
|
data |= mask;
|
|
} else {
|
|
data &= ~mask;
|
|
}
|
|
if (data != nb->nb_val_inv) {
|
|
nct_wr(sc, nb->nb_reg_inv, data);
|
|
nb->nb_val_inv = data;
|
|
}
|
|
|
|
/*
|
|
* Set drain mode.
|
|
*/
|
|
data = nb->nb_val_mode;
|
|
if ((flg & GPIO_PIN_PUSHPULL) != 0) {
|
|
data |= mask;
|
|
} else /* GPIO_PIN_OPENDRAIN */ {
|
|
data &= ~mask;
|
|
}
|
|
if (data != nb->nb_val_mode) {
|
|
nct_wr(sc, nb->nb_reg_mode, data);
|
|
nb->nb_val_mode = data;
|
|
}
|
|
|
|
/*
|
|
* Set output direction late to avoid perturbation.
|
|
*/
|
|
data = nb->nb_val_dir;
|
|
if ((flg & (GPIO_PIN_OUTPUT | GPIO_PIN_TRISTATE)) == GPIO_PIN_OUTPUT) {
|
|
data &= ~mask;
|
|
}
|
|
if (data != nb->nb_val_dir) {
|
|
nct_wr(sc, nb->nb_reg_dir, data);
|
|
nb->nb_val_dir = data;
|
|
}
|
|
mutex_spin_exit(&sc->sc_lock);
|
|
}
|