#include "use_gpio.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/kernel.h>
#include <sys/sensors.h>
#include <sys/module.h>
#include <sys/rman.h>
#include <sys/bus.h>
#include <bus/isa/isareg.h>
#include <bus/isa/isavar.h>
#include <dev/misc/gpio/gpio.h>
#if defined(NSC_LPC_SIO_DEBUG)
#define DPRINTF(x) do { kprintf x; } while (0)
#else
#define DPRINTF(x)
#endif
#define SIO_REG_SID 0x20
#define SIO_SID_PC87366 0xE9
#define SIO_REG_SRID 0x27
#define SIO_REG_LDN 0x07
#define SIO_LDN_FDC 0x00
#define SIO_LDN_PP 0x01
#define SIO_LDN_SP2 0x02
#define SIO_LDN_SP1 0x03
#define SIO_LDN_SWC 0x04
#define SIO_LDN_KBCM 0x05
#define SIO_LDN_KBCK 0x06
#define SIO_LDN_GPIO 0x07
#define SIO_LDN_ACB 0x08
#define SIO_LDN_FSCM 0x09
#define SIO_LDN_WDT 0x0A
#define SIO_LDN_GMP 0x0B
#define SIO_LDN_MIDI 0x0C
#define SIO_LDN_VLM 0x0D
#define SIO_LDN_TMS 0x0E
#define SIO_REG_ACTIVE 0x30
#define SIO_ACTIVE_EN 0x01
#define SIO_REG_IO_MSB 0x60
#define SIO_REG_IO_LSB 0x61
#define SIO_LDNUM 15
static const struct {
const char *ld_name;
int ld_num;
int ld_iosize;
} sio_ld[] = {
{ "GPIO", SIO_LDN_GPIO, 16 },
{ "VLM", SIO_LDN_VLM, 16 },
{ "TMS", SIO_LDN_TMS, 16 },
};
#define SIO_GPIO_PINSEL 0xf0
#define SIO_GPIO_PINCFG 0xf1
#define SIO_GPIO_PINEV 0xf2
#define SIO_GPIO_CONF_OUTPUTEN (1 << 0)
#define SIO_GPIO_CONF_PUSHPULL (1 << 1)
#define SIO_GPIO_CONF_PULLUP (1 << 2)
#define SIO_GPDO0 0x00
#define SIO_GPDI0 0x01
#define SIO_GPEVEN0 0x02
#define SIO_GPEVST0 0x03
#define SIO_GPDO1 0x04
#define SIO_GPDI1 0x05
#define SIO_GPEVEN1 0x06
#define SIO_GPEVST1 0x07
#define SIO_GPDO2 0x08
#define SIO_GPDI2 0x09
#define SIO_GPDO3 0x0a
#define SIO_GPDI3 0x0b
#define SIO_GPIO_NPINS 29
#define SIO_TEVSTS 0x00
#define SIO_TEVSMI 0x02
#define SIO_TEVIRQ 0x04
#define SIO_TMSCFG 0x08
#define SIO_TMSBS 0x09
#define SIO_TCHCFST 0x0A
#define SIO_RDCHT 0x0B
#define SIO_CHTH 0x0C
#define SIO_CHTL 0x0D
#define SIO_CHOTL 0x0E
#define SIO_VEVSTS0 0x00
#define SIO_VEVSTS1 0x01
#define SIO_VEVSMI0 0x02
#define SIO_VEVSMI1 0x03
#define SIO_VEVIRQ0 0x04
#define SIO_VEVIRQ1 0x05
#define SIO_VID 0x06
#define SIO_VCNVR 0x07
#define SIO_VLMCFG 0x08
#define SIO_VLMBS 0x09
#define SIO_VCHCFST 0x0A
#define SIO_RDCHV 0x0B
#define SIO_CHVH 0x0C
#define SIO_CHVL 0x0D
#define SIO_OTSL 0x0E
#define SIO_REG_SIOCF1 0x21
#define SIO_REG_SIOCF2 0x22
#define SIO_REG_SIOCF3 0x23
#define SIO_REG_SIOCF4 0x24
#define SIO_REG_SIOCF5 0x25
#define SIO_REG_SIOCF8 0x28
#define SIO_REG_SIOCFA 0x2A
#define SIO_REG_SIOCFB 0x2B
#define SIO_REG_SIOCFC 0x2C
#define SIO_REG_SIOCFD 0x2D
#define SIO_NUM_SENSORS (3+14)
#define SIO_VLM_OFF 3
#define SIO_VREF 1235
struct nsclpcsio_softc {
device_t sc_dev;
struct resource *sc_iores;
int sc_iorid;
bus_space_tag_t sc_iot;
bus_space_handle_t sc_ioh;
bus_space_handle_t sc_ld_ioh[SIO_LDNUM];
int sc_ld_en[SIO_LDNUM];
#if NGPIO > 0
struct gpio sc_gpio_gc;
struct gpio_pin sc_gpio_pins[SIO_GPIO_NPINS];
#endif
struct ksensor sensors[SIO_NUM_SENSORS];
struct ksensordev sensordev;
};
#define GPIO_READ(sc, reg) \
bus_space_read_1((sc)->sc_iot, \
(sc)->sc_ld_ioh[SIO_LDN_GPIO], (reg))
#define GPIO_WRITE(sc, reg, val) \
bus_space_write_1((sc)->sc_iot, \
(sc)->sc_ld_ioh[SIO_LDN_GPIO], (reg), (val))
#define TMS_WRITE(sc, reg, val) \
bus_space_write_1((sc)->sc_iot, \
(sc)->sc_ld_ioh[SIO_LDN_TMS], (reg), (val))
#define TMS_READ(sc, reg) \
bus_space_read_1((sc)->sc_iot, \
(sc)->sc_ld_ioh[SIO_LDN_TMS], (reg))
#define VLM_WRITE(sc, reg, val) \
bus_space_write_1((sc)->sc_iot, \
(sc)->sc_ld_ioh[SIO_LDN_VLM], (reg), (val))
#define VLM_READ(sc, reg) \
bus_space_read_1((sc)->sc_iot, \
(sc)->sc_ld_ioh[SIO_LDN_VLM], (reg))
int nsclpcsio_isa_probe(device_t);
int nsclpcsio_isa_attach(device_t);
static device_method_t nsclpcsio_isa_methods[] = {
DEVMETHOD(device_probe, nsclpcsio_isa_probe),
DEVMETHOD(device_attach, nsclpcsio_isa_attach),
DEVMETHOD_END
};
static driver_t nsclpcsio_isa_driver = {
"nsclpcsio",
nsclpcsio_isa_methods,
sizeof (struct nsclpcsio_softc)
};
static devclass_t nsclpcsio_devclass;
DRIVER_MODULE(nsclpcsio_isa, isa, nsclpcsio_isa_driver, nsclpcsio_devclass, NULL, NULL);
static u_int8_t nsread(bus_space_tag_t, bus_space_handle_t, int);
static void nswrite(bus_space_tag_t, bus_space_handle_t, int, u_int8_t);
#if NGPIO > 0
void nsclpcsio_gpio_init(struct nsclpcsio_softc *);
int nsclpcsio_gpio_pin_read(void *, int);
void nsclpcsio_gpio_pin_write(void *, int, int);
void nsclpcsio_gpio_pin_ctl(void *, int, int);
#endif
void nsclpcsio_tms_init(struct nsclpcsio_softc *);
void nsclpcsio_vlm_init(struct nsclpcsio_softc *);
void nsclpcsio_tms_update(struct nsclpcsio_softc *);
void nsclpcsio_vlm_update(struct nsclpcsio_softc *);
void nsclpcsio_refresh(void *);
static u_int8_t
nsread(bus_space_tag_t iot, bus_space_handle_t ioh, int idx)
{
bus_space_write_1(iot, ioh, 0, idx);
return (bus_space_read_1(iot, ioh, 1));
}
static void
nswrite(bus_space_tag_t iot, bus_space_handle_t ioh, int idx, u_int8_t data)
{
bus_space_write_1(iot, ioh, 0, idx);
bus_space_write_1(iot, ioh, 1, data);
}
int
nsclpcsio_isa_probe(device_t dev)
{
struct resource *iores;
int iorid = 0;
bus_space_tag_t iot;
bus_space_handle_t ioh;
int rv = 0;
iores = bus_alloc_resource(dev, SYS_RES_IOPORT, &iorid, 0ul, ~0ul, 8, RF_ACTIVE);
if (iores == NULL) {
return 1;
}
iot = rman_get_bustag(iores);
ioh = rman_get_bushandle(iores);
if (nsread(iot, ioh, SIO_REG_SID) == SIO_SID_PC87366)
rv = 1;
bus_release_resource(dev, SYS_RES_IOPORT, iorid, iores);
if (rv) {
return 0;
}
return 1;
}
int
nsclpcsio_isa_attach(device_t dev)
{
int iobase;
struct nsclpcsio_softc *sc = device_get_softc(dev);
int i;
sc->sc_dev = dev;
sc->sc_iores = bus_alloc_resource(dev, SYS_RES_IOPORT, &sc->sc_iorid, 0ul, ~0ul, 8, RF_ACTIVE);
if (sc->sc_iores == NULL) {
return 1;
}
sc->sc_iot = rman_get_bustag(sc->sc_iores);
sc->sc_ioh = rman_get_bushandle(sc->sc_iores);
kprintf("%s: NSC PC87366 rev %d:", device_get_nameunit(sc->sc_dev),
nsread(sc->sc_iot, sc->sc_ioh, SIO_REG_SRID));
for (i = 0; i < NELEM(sio_ld); i++) {
sc->sc_ld_en[sio_ld[i].ld_num] = 0;
nswrite(sc->sc_iot, sc->sc_ioh, SIO_REG_LDN, sio_ld[i].ld_num);
if ((nsread(sc->sc_iot, sc->sc_ioh,
SIO_REG_ACTIVE) & SIO_ACTIVE_EN) == 0)
continue;
if (sio_ld[i].ld_iosize != 0) {
iobase = (nsread(sc->sc_iot, sc->sc_ioh,
SIO_REG_IO_MSB) << 8);
iobase |= nsread(sc->sc_iot, sc->sc_ioh,
SIO_REG_IO_LSB);
#if 0
kprintf("debugging: iobase = %x\n", iobase);
iores = bus_alloc_resource(dev, SYS_RES_IOPORT, &iorid,
iobase, sio_ld[i].ld_iosize, sio_ld[i].ld_iosize, RF_ACTIVE);
if (iores == NULL) {
kprintf("messed up alloc3\n");
continue;
}
#endif
sc->sc_ld_ioh[sio_ld[i].ld_num] = iobase;
}
sc->sc_ld_en[sio_ld[i].ld_num] = 1;
kprintf(" %s", sio_ld[i].ld_name);
}
kprintf("\n");
#if NGPIO > 0
nsclpcsio_gpio_init(sc);
#endif
nsclpcsio_tms_init(sc);
nsclpcsio_vlm_init(sc);
strlcpy(sc->sensordev.xname, device_get_nameunit(sc->sc_dev),
sizeof(sc->sensordev.xname));
for (i = 0; i < SIO_NUM_SENSORS; i++) {
if (i < SIO_VLM_OFF && !sc->sc_ld_en[SIO_LDN_TMS])
continue;
if (i >= SIO_VLM_OFF && !sc->sc_ld_en[SIO_LDN_VLM])
continue;
sensor_attach(&sc->sensordev, &sc->sensors[i]);
}
sensordev_install(&sc->sensordev);
if (sc->sc_ld_en[SIO_LDN_TMS] || sc->sc_ld_en[SIO_LDN_VLM]) {
sensor_task_register(sc, nsclpcsio_refresh, 2);
}
#if NGPIO > 0
if (sc->sc_ld_en[SIO_LDN_GPIO]) {
sc->sc_gpio_gc.driver_name = "pc83766";
sc->sc_gpio_gc.arg = sc;
sc->sc_gpio_gc.pin_read = nsclpcsio_gpio_pin_read;
sc->sc_gpio_gc.pin_write = nsclpcsio_gpio_pin_write;
sc->sc_gpio_gc.pin_ctl = nsclpcsio_gpio_pin_ctl;
sc->sc_gpio_gc.pins = sc->sc_gpio_pins;
sc->sc_gpio_gc.npins = SIO_GPIO_NPINS;
gpio_register(&sc->sc_gpio_gc);
}
#endif
return 0;
}
void
nsclpcsio_refresh(void *arg)
{
struct nsclpcsio_softc *sc = (struct nsclpcsio_softc *)arg;
if (sc->sc_ld_en[SIO_LDN_TMS])
nsclpcsio_tms_update(sc);
if (sc->sc_ld_en[SIO_LDN_VLM])
nsclpcsio_vlm_update(sc);
}
void
nsclpcsio_tms_init(struct nsclpcsio_softc *sc)
{
int i;
TMS_WRITE(sc, 0x08, 0x00);
TMS_WRITE(sc, 0x09, 0x0f);
TMS_WRITE(sc, 0x0a, 0x08);
TMS_WRITE(sc, 0x0b, 0x04);
TMS_WRITE(sc, 0x0c, 0x35);
TMS_WRITE(sc, 0x0d, 0x05);
TMS_WRITE(sc, 0x0e, 0x05);
TMS_WRITE(sc, SIO_TMSCFG, 0x00);
for (i = 0; i < 3; i++) {
TMS_WRITE(sc, SIO_TMSBS, i);
TMS_WRITE(sc, SIO_TCHCFST, 0x01);
sc->sensors[i].type = SENSOR_TEMP;
}
strlcpy(sc->sensors[0].desc, "Remote", sizeof(sc->sensors[0].desc));
strlcpy(sc->sensors[1].desc, "Remote", sizeof(sc->sensors[1].desc));
strlcpy(sc->sensors[2].desc, "Local", sizeof(sc->sensors[2].desc));
nsclpcsio_tms_update(sc);
}
void
nsclpcsio_tms_update(struct nsclpcsio_softc *sc)
{
u_int8_t status;
int8_t sdata;
int i;
for (i = 0; i < 3; i++) {
TMS_WRITE(sc, SIO_TMSBS, i);
status = TMS_READ(sc, SIO_TCHCFST);
if (!(status & 0x01)) {
DPRINTF(("%s: status %d: disabled\n",
sc->sensors[i].desc, status));
sc->sensors[i].value = 0;
continue;
}
sdata = TMS_READ(sc, SIO_RDCHT);
DPRINTF(("%s: status %d C %d\n", sc->sensors[i].desc,
status, sdata));
sc->sensors[i].value = sdata * 1000000 + 273150000;
}
}
void
nsclpcsio_vlm_init(struct nsclpcsio_softc *sc)
{
int i;
char *desc = NULL;
VLM_WRITE(sc, SIO_VLMCFG, 0x00);
for (i = 0; i < 14; i++) {
VLM_WRITE(sc, SIO_VLMBS, i);
VLM_WRITE(sc, SIO_VCHCFST, 0x01);
desc = NULL;
switch (i) {
case 7:
desc = "VSB";
break;
case 8:
desc = "VDD";
break;
case 9:
desc = "VBAT";
break;
case 10:
desc = "AVDD";
break;
case 11:
desc = "TS1";
break;
case 12:
desc = "TS2";
break;
case 13:
desc = "TS3";
break;
}
if (desc != NULL)
strlcpy(sc->sensors[SIO_VLM_OFF + i].desc, desc,
sizeof(sc->sensors[SIO_VLM_OFF + i].desc));
sc->sensors[SIO_VLM_OFF + i].type = SENSOR_VOLTS_DC;
}
nsclpcsio_vlm_update(sc);
}
void
nsclpcsio_vlm_update(struct nsclpcsio_softc *sc)
{
u_int8_t status;
u_int8_t data;
int scale, rfact, i;
for (i = 0; i < 14; i++) {
VLM_WRITE(sc, SIO_VLMBS, i);
status = VLM_READ(sc, SIO_VCHCFST);
if (!(status & 0x01)) {
DPRINTF(("%s: status %d: disabled\n",
sc->sensors[SIO_VLM_OFF + i].desc, status));
sc->sensors[SIO_VLM_OFF + i].value = 0;
continue;
}
data = VLM_READ(sc, SIO_RDCHV);
DPRINTF(("%s: status %d V %d\n",
sc->sensors[SIO_VLM_OFF + i].desc, status, data));
scale = 1;
switch (i) {
case 7:
case 8:
case 10:
scale = 2;
}
rfact = 10 * scale * ((245 * SIO_VREF) >> 8);
sc->sensors[SIO_VLM_OFF + i].value = data * rfact;
}
}
#if NGPIO > 0
static __inline void
nsclpcsio_gpio_pin_select(struct nsclpcsio_softc *sc, int pin)
{
int port, shift;
u_int8_t data;
port = pin / 8;
shift = pin % 8;
data = (port << 4) | shift;
nswrite(sc->sc_iot, sc->sc_ioh, SIO_REG_LDN, SIO_LDN_GPIO);
nswrite(sc->sc_iot, sc->sc_ioh, SIO_GPIO_PINSEL, data);
}
void
nsclpcsio_gpio_init(struct nsclpcsio_softc *sc)
{
int i;
for (i = 0; i < SIO_GPIO_NPINS; i++) {
sc->sc_gpio_pins[i].pin_num = i;
sc->sc_gpio_pins[i].pin_caps = GPIO_PIN_INPUT |
GPIO_PIN_OUTPUT | GPIO_PIN_OPENDRAIN |
GPIO_PIN_PUSHPULL | GPIO_PIN_TRISTATE |
GPIO_PIN_PULLUP;
sc->sc_gpio_pins[i].pin_state = nsclpcsio_gpio_pin_read(sc,
i) ? GPIO_PIN_HIGH : GPIO_PIN_LOW;
}
}
int
nsclpcsio_gpio_pin_read(void *arg, int pin)
{
struct nsclpcsio_softc *sc = arg;
int port, shift, reg;
u_int8_t data;
port = pin / 8;
shift = pin % 8;
switch (port) {
case 0:
reg = SIO_GPDI0;
break;
case 1:
reg = SIO_GPDI1;
break;
case 2:
reg = SIO_GPDI2;
break;
case 3:
reg = SIO_GPDI3;
break;
default:
return 0;
}
data = GPIO_READ(sc, reg);
return ((data >> shift) & 0x1);
}
void
nsclpcsio_gpio_pin_write(void *arg, int pin, int value)
{
struct nsclpcsio_softc *sc = arg;
int port, shift, reg;
u_int8_t data;
port = pin / 8;
shift = pin % 8;
switch (port) {
case 0:
reg = SIO_GPDO0;
break;
case 1:
reg = SIO_GPDO1;
break;
case 2:
reg = SIO_GPDO2;
break;
case 3:
reg = SIO_GPDO3;
break;
default:
return;
}
data = GPIO_READ(sc, reg);
if (value == 0)
data &= ~(1 << shift);
else if (value == 1)
data |= (1 << shift);
GPIO_WRITE(sc, reg, data);
}
void
nsclpcsio_gpio_pin_ctl(void *arg, int pin, int flags)
{
struct nsclpcsio_softc *sc = arg;
u_int8_t conf = 1;
nswrite(sc->sc_iot, sc->sc_ioh, SIO_REG_LDN, SIO_LDN_GPIO);
nsclpcsio_gpio_pin_select(sc, pin);
conf = nsread(sc->sc_iot, sc->sc_ioh, SIO_GPIO_PINCFG);
conf &= ~(SIO_GPIO_CONF_OUTPUTEN | SIO_GPIO_CONF_PUSHPULL |
SIO_GPIO_CONF_PULLUP);
if ((flags & GPIO_PIN_TRISTATE) == 0)
conf |= SIO_GPIO_CONF_OUTPUTEN;
if (flags & GPIO_PIN_PUSHPULL)
conf |= SIO_GPIO_CONF_PUSHPULL;
if (flags & GPIO_PIN_PULLUP)
conf |= SIO_GPIO_CONF_PULLUP;
nswrite(sc->sc_iot, sc->sc_ioh, SIO_GPIO_PINCFG, conf);
}
#endif