#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: smsc.c,v 1.13 2022/06/29 15:56:58 mlelstv Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/module.h>
#include <sys/bus.h>
#include <dev/isa/isareg.h>
#include <dev/isa/isavar.h>
#include <dev/sysmon/sysmonvar.h>
#include <dev/isa/smscvar.h>
#if defined(LMDEBUG)
#define DPRINTF(x) do { printf x; } while (0)
#else
#define DPRINTF(x)
#endif
static int smsc_match(device_t, cfdata_t, void *);
static void smsc_attach(device_t, device_t, void *);
static int smsc_detach(device_t, int);
static uint8_t smsc_readreg(bus_space_tag_t, bus_space_handle_t, int);
static void smsc_writereg(bus_space_tag_t, bus_space_handle_t, int, int);
static void smsc_refresh(struct sysmon_envsys *, envsys_data_t *);
CFATTACH_DECL_NEW(smsc, sizeof(struct smsc_softc),
smsc_match, smsc_attach, smsc_detach, NULL);
static int
smsc_match(device_t parent, cfdata_t match, void *aux)
{
bus_space_handle_t ioh;
struct isa_attach_args *ia = aux;
int rv;
uint8_t cr;
if (ia->ia_nio < 1)
return 0;
if (ISA_DIRECT_CONFIG(ia))
return 0;
if (ia->ia_io[0].ir_addr == ISA_UNKNOWN_PORT)
return 0;
if (bus_space_map(ia->ia_iot, ia->ia_io[0].ir_addr, 2, 0, &ioh))
return 0;
bus_space_write_1(ia->ia_iot, ioh, SMSC_ADDR, SMSC_CONFIG_START);
cr = smsc_readreg(ia->ia_iot, ioh, SMSC_DEVICE_ID);
bus_space_write_1(ia->ia_iot, ioh, SMSC_ADDR, SMSC_CONFIG_END);
switch (cr) {
case SMSC_ID_47B397:
case SMSC_ID_SCH5307NS:
case SMSC_ID_SCH5317:
rv = 1;
break;
default:
rv = 0;
break;
}
DPRINTF(("smsc: rv = %d, cr = %x\n", rv, cr));
bus_space_unmap(ia->ia_iot, ioh, 2);
if (rv) {
ia->ia_nio = 1;
ia->ia_io[0].ir_size = 2;
ia->ia_niomem = 0;
ia->ia_nirq = 0;
ia->ia_ndrq = 0;
}
return rv;
}
static void
smsc_attach(device_t parent, device_t self, void *aux)
{
struct smsc_softc *sc = device_private(self);
struct isa_attach_args *ia = aux;
bus_space_handle_t ioh;
uint8_t rev, msb, lsb, chipid;
unsigned address;
int i;
sc->sc_iot = ia->ia_iot;
aprint_naive("\n");
if (bus_space_map(ia->ia_iot, ia->ia_io[0].ir_addr, 2, 0,
&ioh)) {
aprint_error(": can't map base i/o space\n");
return;
}
bus_space_write_1(ia->ia_iot, ioh, SMSC_ADDR, SMSC_CONFIG_START);
rev = smsc_readreg(ia->ia_iot, ioh, SMSC_DEVICE_REVISION);
chipid = smsc_readreg(ia->ia_iot, ioh, SMSC_DEVICE_ID);
smsc_writereg(ia->ia_iot, ioh, SMSC_LOGICAL_DEV_SEL,
SMSC_LOGICAL_DEVICE);
msb = smsc_readreg(ia->ia_iot, ioh, SMSC_IO_BASE_MSB);
lsb = smsc_readreg(ia->ia_iot, ioh, SMSC_IO_BASE_LSB);
address = (msb << 8) | lsb;
bus_space_write_1(ia->ia_iot, ioh, SMSC_ADDR, SMSC_CONFIG_END);
bus_space_unmap(ia->ia_iot, ioh, 2);
if (bus_space_map(ia->ia_iot, address, 2, 0, &sc->sc_ioh)) {
aprint_error(": can't map register i/o space\n");
return;
}
sc->sc_sme = sysmon_envsys_create();
#define INITSENSOR(index, string, reg, type) \
do { \
strlcpy(sc->sc_sensor[index].desc, string, \
sizeof(sc->sc_sensor[index].desc)); \
sc->sc_sensor[index].units = type; \
sc->sc_regs[index] = reg; \
sc->sc_sensor[index].state = ENVSYS_SVALID; \
} while ( 0)
INITSENSOR(0, "Temp0", SMSC_TEMP1, ENVSYS_STEMP);
INITSENSOR(1, "Temp1", SMSC_TEMP2, ENVSYS_STEMP);
INITSENSOR(2, "Temp2", SMSC_TEMP3, ENVSYS_STEMP);
INITSENSOR(3, "Temp3", SMSC_TEMP4, ENVSYS_STEMP);
INITSENSOR(4, "Fan0", SMSC_FAN1_LSB, ENVSYS_SFANRPM);
INITSENSOR(5, "Fan1", SMSC_FAN2_LSB, ENVSYS_SFANRPM);
INITSENSOR(6, "Fan2", SMSC_FAN3_LSB, ENVSYS_SFANRPM);
INITSENSOR(7, "Fan3", SMSC_FAN4_LSB, ENVSYS_SFANRPM);
for (i = 0; i < SMSC_MAX_SENSORS; i++) {
sc->sc_sensor[i].state = ENVSYS_SINVALID;
if (sysmon_envsys_sensor_attach(sc->sc_sme,
&sc->sc_sensor[i])) {
sysmon_envsys_destroy(sc->sc_sme);
sc->sc_sme = NULL;
bus_space_unmap(sc->sc_iot, sc->sc_ioh, 2);
return;
}
}
sc->sc_sme->sme_name = device_xname(self);
sc->sc_sme->sme_cookie = sc;
sc->sc_sme->sme_refresh = smsc_refresh;
if ((i = sysmon_envsys_register(sc->sc_sme)) != 0) {
aprint_error(": unable to register with sysmon (%d)\n", i);
sysmon_envsys_destroy(sc->sc_sme);
sc->sc_sme = NULL;
bus_space_unmap(sc->sc_iot, sc->sc_ioh, 2);
return;
}
switch (chipid) {
case SMSC_ID_47B397:
aprint_normal(": SMSC LPC47B397 Super I/O");
break;
case SMSC_ID_SCH5307NS:
aprint_normal(": SMSC SCH5307-NS Super I/O");
break;
case SMSC_ID_SCH5317:
aprint_normal(": SMSC SCH5317 Super I/O");
break;
}
aprint_normal(" (rev %u)\n", rev);
aprint_normal_dev(self, "Hardware Monitor registers at 0x%04x\n",
address);
}
static int
smsc_detach(device_t self, int flags)
{
struct smsc_softc *sc = device_private(self);
if (sc->sc_sme != NULL)
sysmon_envsys_unregister(sc->sc_sme);
bus_space_unmap(sc->sc_iot, sc->sc_ioh, 2);
return 0;
}
static uint8_t
smsc_readreg(bus_space_tag_t iot, bus_space_handle_t ioh, int reg)
{
bus_space_write_1(iot, ioh, SMSC_ADDR, reg);
return bus_space_read_1(iot, ioh, SMSC_DATA);
}
static void
smsc_writereg(bus_space_tag_t iot, bus_space_handle_t ioh, int reg, int val)
{
bus_space_write_1(iot, ioh, SMSC_ADDR, reg);
bus_space_write_1(iot, ioh, SMSC_DATA, val);
}
static inline int
smsc_temp2muk(uint8_t t)
{
int temp=t;
return temp * 1000000 + 273150000U;
}
static inline int
smsc_reg2rpm(unsigned int r)
{
unsigned long rpm;
if (r == 0x0)
return 0;
rpm = (90000 * 60) / ((unsigned long) r);
return (int) rpm;
}
#define SMSC_MIN_TEMP_UK ((-127 * 1000000) + 273150000)
#define SMSC_MAX_TEMP_UK ((127 * 1000000) + 273150000)
static void
smsc_refresh(struct sysmon_envsys *sme, envsys_data_t *edata)
{
struct smsc_softc *sc = sme->sme_cookie;
int reg;
unsigned int rpm;
uint8_t msb, lsb;
reg = sc->sc_regs[edata->sensor];
switch (edata->units) {
case ENVSYS_STEMP:
edata->value_cur =
smsc_temp2muk(smsc_readreg(sc->sc_iot, sc->sc_ioh, reg));
break;
case ENVSYS_SFANRPM:
lsb = smsc_readreg(sc->sc_iot, sc->sc_ioh, reg);
msb = smsc_readreg(sc->sc_iot, sc->sc_ioh, reg + 1);
rpm = (msb << 8) | lsb;
edata->value_cur = smsc_reg2rpm(rpm);
break;
}
}
MODULE(MODULE_CLASS_DRIVER, smsc, "sysmon_envsys");
#ifdef _MODULE
#include "ioconf.c"
#endif
static int
smsc_modcmd(modcmd_t cmd, void *opaque)
{
int error = 0;
switch (cmd) {
case MODULE_CMD_INIT:
#ifdef _MODULE
error = config_init_component(cfdriver_ioconf_smsc,
cfattach_ioconf_smsc, cfdata_ioconf_smsc);
#endif
return error;
case MODULE_CMD_FINI:
#ifdef _MODULE
error = config_fini_component(cfdriver_ioconf_smsc,
cfattach_ioconf_smsc, cfdata_ioconf_smsc);
#endif
return error;
default:
return ENOTTY;
}
}