#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: mvsocts.c,v 1.3 2023/06/19 08:40:29 msaitoh Exp $");
#include <sys/param.h>
#include <sys/bus.h>
#include <sys/device.h>
#include <sys/errno.h>
#include <dev/sysmon/sysmonvar.h>
#include <dev/marvell/marvellreg.h>
#include <dev/marvell/marvellvar.h>
#define TS_STATUS 0x0
#define STATUS_VAL(v) (((v) >> 10) & 0x1ff)
struct mvsocts_softc {
device_t sc_dev;
bool (*sc_isvalid)(int);
int (*sc_val2uc)(int);
struct sysmon_envsys *sc_sme;
envsys_data_t sc_sensor;
bus_space_tag_t sc_iot;
bus_space_handle_t sc_ioh;
};
static int mvsocts_match(device_t, struct cfdata *, void *);
static void mvsocts_attach(device_t, device_t, void *);
static void mvsocts_refresh(struct sysmon_envsys *, envsys_data_t *);
static bool mvsocts_isvalid_88f6282(int);
static int mvsocts_val2uc_88f6282(int);
static bool mvsocts_isvalid_armada(int);
static int mvsocts_val2uc_armada(int);
CFATTACH_DECL_NEW(mvsocts, sizeof(struct mvsocts_softc),
mvsocts_match, mvsocts_attach, NULL, NULL);
static int
mvsocts_match(device_t parent, struct cfdata *match, void *aux)
{
struct marvell_attach_args *mva = aux;
if (strcmp(mva->mva_name, match->cf_name) != 0)
return 0;
return 1;
}
static void
mvsocts_attach(device_t parent, device_t self, void *aux)
{
struct mvsocts_softc *sc = device_private(self);
struct marvell_attach_args *mva = aux;
aprint_naive("\n");
aprint_normal(": Marvell SoC Thermal Sensor\n");
sc->sc_dev = self;
sc->sc_iot = mva->mva_iot;
if (bus_space_subregion(mva->mva_iot, mva->mva_ioh,
mva->mva_offset, sizeof(uint32_t), &sc->sc_ioh))
panic("%s: Cannot map registers", device_xname(self));
switch (mva->mva_model) {
case MARVELL_KIRKWOOD_88F6282:
sc->sc_isvalid = mvsocts_isvalid_88f6282;
sc->sc_val2uc = mvsocts_val2uc_88f6282;
break;
case MARVELL_ARMADAXP_MV78130:
case MARVELL_ARMADAXP_MV78160:
case MARVELL_ARMADAXP_MV78230:
case MARVELL_ARMADAXP_MV78260:
case MARVELL_ARMADAXP_MV78460:
sc->sc_isvalid = mvsocts_isvalid_armada;
sc->sc_val2uc = mvsocts_val2uc_armada;
break;
default:
aprint_error_dev(self, "unknown model: 0x%x", mva->mva_model);
return;
}
sc->sc_sme = sysmon_envsys_create();
sc->sc_sensor.units = ENVSYS_STEMP;
sc->sc_sensor.state = ENVSYS_SINVALID;
strlcpy(sc->sc_sensor.desc, device_xname(self),
sizeof(sc->sc_sensor.desc));
if (sysmon_envsys_sensor_attach(sc->sc_sme, &sc->sc_sensor)) {
aprint_error_dev(self, "Unable to attach sysmon\n");
sysmon_envsys_destroy(sc->sc_sme);
return;
}
sc->sc_sme->sme_name = device_xname(self);
sc->sc_sme->sme_cookie = sc;
sc->sc_sme->sme_refresh = mvsocts_refresh;
if (sysmon_envsys_register(sc->sc_sme)) {
aprint_error_dev(self, "Unable to register with sysmon\n");
sysmon_envsys_destroy(sc->sc_sme);
}
}
static void
mvsocts_refresh(struct sysmon_envsys *sme, envsys_data_t *edata)
{
struct mvsocts_softc *sc = sme->sme_cookie;
uint32_t val, uc, uk;
val = bus_space_read_4(sc->sc_iot, sc->sc_ioh, TS_STATUS);
if (!sc->sc_isvalid(val)) {
aprint_error_dev(sc->sc_dev, "status value is invalid\n");
return;
}
uc = sc->sc_val2uc(STATUS_VAL(val));
uk = uc + 273150000;
sc->sc_sensor.value_cur = uk;
sc->sc_sensor.state = ENVSYS_SVALID;
}
static bool
mvsocts_isvalid_88f6282(int v)
{
return (v & (1 << 9)) != 0;
}
static int
mvsocts_val2uc_88f6282(int v)
{
return (322 - v) * 10 * 1000000 / 13625 * 1000;
}
static bool
mvsocts_isvalid_armada(int v)
{
return (v & (1 << 0)) != 0;
}
static int
mvsocts_val2uc_armada(int v)
{
return (3153 - v * 10) * 1000000 / 13825 * 1000;
}