#include <sys/param.h>
#include <sys/systm.h>
#include <sys/bus.h>
#include <sys/sensors.h>
#include "lm78var.h"
#include "../wbsio/wbsioreg.h"
#if defined(LMDEBUG)
#define DPRINTF(x) do { kprintf x; } while (0)
#else
#define DPRINTF(x)
#endif
#define RFACT_NONE 10000
#define RFACT(x, y) (RFACT_NONE * ((x) + (y)) / (y))
#define NRFACT(x, y) (-RFACT_NONE * (x) / (y))
int lm_match(struct lm_softc *);
int wb_match(struct lm_softc *);
int def_match(struct lm_softc *);
void lm_setup_sensors(struct lm_softc *, struct lm_sensor *);
void lm_refresh(void *);
void lm_refresh_sensor_data(struct lm_softc *);
void lm_refresh_volt(struct lm_softc *, int);
void lm_refresh_temp(struct lm_softc *, int);
void lm_refresh_fanrpm(struct lm_softc *, int);
void wb_refresh_sensor_data(struct lm_softc *);
void wb_w83637hf_refresh_vcore(struct lm_softc *, int);
void wb_refresh_nvolt(struct lm_softc *, int);
void wb_w83627ehf_refresh_nvolt(struct lm_softc *, int);
void wb_refresh_temp(struct lm_softc *, int);
void wb_refresh_fanrpm(struct lm_softc *, int);
void wb_nct6776f_refresh_fanrpm(struct lm_softc *, int);
void wb_w83792d_refresh_fanrpm(struct lm_softc *, int);
void as_refresh_temp(struct lm_softc *, int);
struct lm_chip {
int (*chip_match)(struct lm_softc *);
};
struct lm_chip lm_chips[] = {
{ wb_match },
{ lm_match },
{ def_match }
};
struct lm_sensor lm78_sensors[] = {
{ "VCore A", SENSOR_VOLTS_DC, 0, 0x20, lm_refresh_volt, RFACT_NONE },
{ "VCore B", SENSOR_VOLTS_DC, 0, 0x21, lm_refresh_volt, RFACT_NONE },
{ "+3.3V", SENSOR_VOLTS_DC, 0, 0x22, lm_refresh_volt, RFACT_NONE },
{ "+5V", SENSOR_VOLTS_DC, 0, 0x23, lm_refresh_volt, RFACT(68, 100) },
{ "+12V", SENSOR_VOLTS_DC, 0, 0x24, lm_refresh_volt, RFACT(30, 10) },
{ "-12V", SENSOR_VOLTS_DC, 0, 0x25, lm_refresh_volt, NRFACT(240, 60) },
{ "-5V", SENSOR_VOLTS_DC, 0, 0x26, lm_refresh_volt, NRFACT(100, 60) },
{ "", SENSOR_TEMP, 0, 0x27, lm_refresh_temp },
{ "", SENSOR_FANRPM, 0, 0x28, lm_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x29, lm_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x2a, lm_refresh_fanrpm },
{ NULL }
};
struct lm_sensor w83627hf_sensors[] = {
{ "VCore A", SENSOR_VOLTS_DC, 0, 0x20, lm_refresh_volt, RFACT_NONE },
{ "VCore B", SENSOR_VOLTS_DC, 0, 0x21, lm_refresh_volt, RFACT_NONE },
{ "+3.3V", SENSOR_VOLTS_DC, 0, 0x22, lm_refresh_volt, RFACT_NONE },
{ "+5V", SENSOR_VOLTS_DC, 0, 0x23, lm_refresh_volt, RFACT(34, 50) },
{ "+12V", SENSOR_VOLTS_DC, 0, 0x24, lm_refresh_volt, RFACT(28, 10) },
{ "-12V", SENSOR_VOLTS_DC, 0, 0x25, wb_refresh_nvolt, RFACT(232, 56) },
{ "-5V", SENSOR_VOLTS_DC, 0, 0x26, wb_refresh_nvolt, RFACT(120, 56) },
{ "5VSB", SENSOR_VOLTS_DC, 5, 0x50, lm_refresh_volt, RFACT(17, 33) },
{ "VBAT", SENSOR_VOLTS_DC, 5, 0x51, lm_refresh_volt, RFACT_NONE },
{ "", SENSOR_TEMP, 0, 0x27, lm_refresh_temp },
{ "", SENSOR_TEMP, 1, 0x50, wb_refresh_temp },
{ "", SENSOR_TEMP, 2, 0x50, wb_refresh_temp },
{ "", SENSOR_FANRPM, 0, 0x28, wb_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x29, wb_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x2a, wb_refresh_fanrpm },
{ NULL }
};
struct lm_sensor w83627ehf_sensors[] = {
{ "VCore", SENSOR_VOLTS_DC, 0, 0x20, lm_refresh_volt, RFACT_NONE / 2},
{ "+12V", SENSOR_VOLTS_DC, 0, 0x21, lm_refresh_volt, RFACT(56, 10) / 2 },
{ "+3.3V", SENSOR_VOLTS_DC, 0, 0x22, lm_refresh_volt, RFACT(34, 34) / 2 },
{ "+3.3V", SENSOR_VOLTS_DC, 0, 0x23, lm_refresh_volt, RFACT(34, 34) / 2 },
{ "-12V", SENSOR_VOLTS_DC, 0, 0x24, wb_w83627ehf_refresh_nvolt },
{ "", SENSOR_VOLTS_DC, 0, 0x25, lm_refresh_volt, RFACT_NONE / 2 },
{ "", SENSOR_VOLTS_DC, 0, 0x26, lm_refresh_volt, RFACT_NONE / 2 },
{ "3.3VSB", SENSOR_VOLTS_DC, 5, 0x50, lm_refresh_volt, RFACT(34, 34) / 2 },
{ "VBAT", SENSOR_VOLTS_DC, 5, 0x51, lm_refresh_volt, RFACT_NONE / 2 },
{ "", SENSOR_VOLTS_DC, 5, 0x52, lm_refresh_volt, RFACT_NONE / 2 },
{ "", SENSOR_TEMP, 0, 0x27, lm_refresh_temp },
{ "", SENSOR_TEMP, 1, 0x50, wb_refresh_temp },
{ "", SENSOR_TEMP, 2, 0x50, wb_refresh_temp },
{ "", SENSOR_FANRPM, 0, 0x28, wb_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x29, wb_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x2a, wb_refresh_fanrpm },
{ NULL }
};
struct lm_sensor w83627dhg_sensors[] = {
{ "VCore", SENSOR_VOLTS_DC, 0, 0x20, lm_refresh_volt, RFACT_NONE / 2},
{ "+12V", SENSOR_VOLTS_DC, 0, 0x21, lm_refresh_volt, RFACT(56, 10) / 2 },
{ "+3.3V", SENSOR_VOLTS_DC, 0, 0x22, lm_refresh_volt, RFACT(34, 34) / 2 },
{ "+3.3V", SENSOR_VOLTS_DC, 0, 0x23, lm_refresh_volt, RFACT(34, 34) / 2 },
{ "-12V", SENSOR_VOLTS_DC, 0, 0x24, wb_w83627ehf_refresh_nvolt },
{ "", SENSOR_VOLTS_DC, 0, 0x25, lm_refresh_volt, RFACT_NONE / 2 },
{ "", SENSOR_VOLTS_DC, 0, 0x26, lm_refresh_volt, RFACT_NONE / 2 },
{ "3.3VSB", SENSOR_VOLTS_DC, 5, 0x50, lm_refresh_volt, RFACT(34, 34) / 2 },
{ "VBAT", SENSOR_VOLTS_DC, 5, 0x51, lm_refresh_volt, RFACT_NONE / 2 },
{ "", SENSOR_TEMP, 0, 0x27, lm_refresh_temp },
{ "", SENSOR_TEMP, 1, 0x50, wb_refresh_temp },
{ "", SENSOR_TEMP, 2, 0x50, wb_refresh_temp },
{ "", SENSOR_FANRPM, 0, 0x28, wb_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x29, wb_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x2a, wb_refresh_fanrpm },
{ NULL }
};
struct lm_sensor nct6776f_sensors[] = {
{ "VCore", SENSOR_VOLTS_DC, 0, 0x20, lm_refresh_volt, RFACT_NONE / 2},
{ "+12V", SENSOR_VOLTS_DC, 0, 0x21, lm_refresh_volt, RFACT(56, 10) / 2 },
{ "+3.3V", SENSOR_VOLTS_DC, 0, 0x22, lm_refresh_volt, RFACT(34, 34) / 2 },
{ "+3.3V", SENSOR_VOLTS_DC, 0, 0x23, lm_refresh_volt, RFACT(34, 34) / 2 },
{ "-12V", SENSOR_VOLTS_DC, 0, 0x24, wb_w83627ehf_refresh_nvolt },
{ "", SENSOR_VOLTS_DC, 0, 0x25, lm_refresh_volt, RFACT_NONE / 2 },
{ "", SENSOR_VOLTS_DC, 0, 0x26, lm_refresh_volt, RFACT_NONE / 2 },
{ "3.3VSB", SENSOR_VOLTS_DC, 5, 0x50, lm_refresh_volt, RFACT(34, 34) / 2 },
{ "VBAT", SENSOR_VOLTS_DC, 5, 0x51, lm_refresh_volt, RFACT_NONE / 2 },
{ "", SENSOR_TEMP, 0, 0x27, lm_refresh_temp },
{ "", SENSOR_TEMP, 1, 0x50, wb_refresh_temp },
{ "", SENSOR_TEMP, 2, 0x50, wb_refresh_temp },
{ "", SENSOR_FANRPM, 6, 0x56, wb_nct6776f_refresh_fanrpm },
{ "", SENSOR_FANRPM, 6, 0x58, wb_nct6776f_refresh_fanrpm },
{ "", SENSOR_FANRPM, 6, 0x5a, wb_nct6776f_refresh_fanrpm },
{ "", SENSOR_FANRPM, 6, 0x5c, wb_nct6776f_refresh_fanrpm },
{ "", SENSOR_FANRPM, 6, 0x5e, wb_nct6776f_refresh_fanrpm },
{ NULL }
};
struct lm_sensor w83637hf_sensors[] = {
{ "VCore", SENSOR_VOLTS_DC, 0, 0x20, wb_w83637hf_refresh_vcore },
{ "+12V", SENSOR_VOLTS_DC, 0, 0x21, lm_refresh_volt, RFACT(28, 10) },
{ "+3.3V", SENSOR_VOLTS_DC, 0, 0x22, lm_refresh_volt, RFACT_NONE },
{ "+5V", SENSOR_VOLTS_DC, 0, 0x23, lm_refresh_volt, RFACT(34, 51) },
{ "-12V", SENSOR_VOLTS_DC, 0, 0x24, wb_refresh_nvolt, RFACT(232, 56) },
{ "5VSB", SENSOR_VOLTS_DC, 5, 0x50, lm_refresh_volt, RFACT(34, 51) },
{ "VBAT", SENSOR_VOLTS_DC, 5, 0x51, lm_refresh_volt, RFACT_NONE },
{ "", SENSOR_TEMP, 0, 0x27, lm_refresh_temp },
{ "", SENSOR_TEMP, 1, 0x50, wb_refresh_temp },
{ "", SENSOR_TEMP, 2, 0x50, wb_refresh_temp },
{ "", SENSOR_FANRPM, 0, 0x28, wb_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x29, wb_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x2a, wb_refresh_fanrpm },
{ NULL }
};
struct lm_sensor w83697hf_sensors[] = {
{ "VCore", SENSOR_VOLTS_DC, 0, 0x20, lm_refresh_volt, RFACT_NONE },
{ "+3.3V", SENSOR_VOLTS_DC, 0, 0x22, lm_refresh_volt, RFACT_NONE },
{ "+5V", SENSOR_VOLTS_DC, 0, 0x23, lm_refresh_volt, RFACT(34, 50) },
{ "+12V", SENSOR_VOLTS_DC, 0, 0x24, lm_refresh_volt, RFACT(28, 10) },
{ "-12V", SENSOR_VOLTS_DC, 0, 0x25, wb_refresh_nvolt, RFACT(232, 56) },
{ "-5V", SENSOR_VOLTS_DC, 0, 0x26, wb_refresh_nvolt, RFACT(120, 56) },
{ "5VSB", SENSOR_VOLTS_DC, 5, 0x50, lm_refresh_volt, RFACT(17, 33) },
{ "VBAT", SENSOR_VOLTS_DC, 5, 0x51, lm_refresh_volt, RFACT_NONE },
{ "", SENSOR_TEMP, 0, 0x27, lm_refresh_temp },
{ "", SENSOR_TEMP, 1, 0x50, wb_refresh_temp },
{ "", SENSOR_FANRPM, 0, 0x28, wb_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x29, wb_refresh_fanrpm },
{ NULL }
};
struct lm_sensor w83781d_sensors[] = {
{ "VCore A", SENSOR_VOLTS_DC, 0, 0x20, lm_refresh_volt, RFACT_NONE },
{ "VCore B", SENSOR_VOLTS_DC, 0, 0x21, lm_refresh_volt, RFACT_NONE },
{ "+3.3V", SENSOR_VOLTS_DC, 0, 0x22, lm_refresh_volt, RFACT_NONE },
{ "+5V", SENSOR_VOLTS_DC, 0, 0x23, lm_refresh_volt, RFACT(34, 50) },
{ "+12V", SENSOR_VOLTS_DC, 0, 0x24, lm_refresh_volt, RFACT(28, 10) },
{ "-12V", SENSOR_VOLTS_DC, 0, 0x25, lm_refresh_volt, NRFACT(2100, 604) },
{ "-5V", SENSOR_VOLTS_DC, 0, 0x26, lm_refresh_volt, NRFACT(909, 604) },
{ "", SENSOR_TEMP, 0, 0x27, lm_refresh_temp },
{ "", SENSOR_TEMP, 1, 0x50, wb_refresh_temp },
{ "", SENSOR_TEMP, 2, 0x50, wb_refresh_temp },
{ "", SENSOR_FANRPM, 0, 0x28, lm_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x29, lm_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x2a, lm_refresh_fanrpm },
{ NULL }
};
struct lm_sensor w83782d_sensors[] = {
{ "VCore", SENSOR_VOLTS_DC, 0, 0x20, lm_refresh_volt, RFACT_NONE },
{ "VINR0", SENSOR_VOLTS_DC, 0, 0x21, lm_refresh_volt, RFACT_NONE },
{ "+3.3V", SENSOR_VOLTS_DC, 0, 0x22, lm_refresh_volt, RFACT_NONE },
{ "+5V", SENSOR_VOLTS_DC, 0, 0x23, lm_refresh_volt, RFACT(34, 50) },
{ "+12V", SENSOR_VOLTS_DC, 0, 0x24, lm_refresh_volt, RFACT(28, 10) },
{ "-12V", SENSOR_VOLTS_DC, 0, 0x25, wb_refresh_nvolt, RFACT(232, 56) },
{ "-5V", SENSOR_VOLTS_DC, 0, 0x26, wb_refresh_nvolt, RFACT(120, 56) },
{ "5VSB", SENSOR_VOLTS_DC, 5, 0x50, lm_refresh_volt, RFACT(17, 33) },
{ "VBAT", SENSOR_VOLTS_DC, 5, 0x51, lm_refresh_volt, RFACT_NONE },
{ "", SENSOR_TEMP, 0, 0x27, lm_refresh_temp },
{ "", SENSOR_TEMP, 1, 0x50, wb_refresh_temp },
{ "", SENSOR_TEMP, 2, 0x50, wb_refresh_temp },
{ "", SENSOR_FANRPM, 0, 0x28, wb_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x29, wb_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x2a, wb_refresh_fanrpm },
{ NULL }
};
struct lm_sensor w83783s_sensors[] = {
{ "VCore", SENSOR_VOLTS_DC, 0, 0x20, lm_refresh_volt, RFACT_NONE },
{ "+3.3V", SENSOR_VOLTS_DC, 0, 0x22, lm_refresh_volt, RFACT_NONE },
{ "+5V", SENSOR_VOLTS_DC, 0, 0x23, lm_refresh_volt, RFACT(34, 50) },
{ "+12V", SENSOR_VOLTS_DC, 0, 0x24, lm_refresh_volt, RFACT(28, 10) },
{ "-12V", SENSOR_VOLTS_DC, 0, 0x25, wb_refresh_nvolt, RFACT(232, 56) },
{ "-5V", SENSOR_VOLTS_DC, 0, 0x26, wb_refresh_nvolt, RFACT(120, 56) },
{ "", SENSOR_TEMP, 0, 0x27, lm_refresh_temp },
{ "", SENSOR_TEMP, 1, 0x50, wb_refresh_temp },
{ "", SENSOR_FANRPM, 0, 0x28, wb_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x29, wb_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x2a, wb_refresh_fanrpm },
{ NULL }
};
struct lm_sensor w83791d_sensors[] = {
{ "VCore", SENSOR_VOLTS_DC, 0, 0x20, lm_refresh_volt, RFACT_NONE },
{ "VINR0", SENSOR_VOLTS_DC, 0, 0x21, lm_refresh_volt, RFACT_NONE },
{ "+3.3V", SENSOR_VOLTS_DC, 0, 0x22, lm_refresh_volt, RFACT_NONE },
{ "+5V", SENSOR_VOLTS_DC, 0, 0x23, lm_refresh_volt, RFACT(34, 50) },
{ "+12V", SENSOR_VOLTS_DC, 0, 0x24, lm_refresh_volt, RFACT(28, 10) },
{ "-12V", SENSOR_VOLTS_DC, 0, 0x25, wb_refresh_nvolt, RFACT(232, 56) },
{ "-5V", SENSOR_VOLTS_DC, 0, 0x26, wb_refresh_nvolt, RFACT(120, 56) },
{ "5VSB", SENSOR_VOLTS_DC, 0, 0xb0, lm_refresh_volt, RFACT(17, 33) },
{ "VBAT", SENSOR_VOLTS_DC, 0, 0xb1, lm_refresh_volt, RFACT_NONE },
{ "VINR1", SENSOR_VOLTS_DC, 0, 0xb2, lm_refresh_volt, RFACT_NONE },
{ "", SENSOR_TEMP, 0, 0x27, lm_refresh_temp },
{ "", SENSOR_TEMP, 0, 0xc0, wb_refresh_temp },
{ "", SENSOR_TEMP, 0, 0xc8, wb_refresh_temp },
{ "", SENSOR_FANRPM, 0, 0x28, wb_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x29, wb_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x2a, wb_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0xba, wb_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0xbb, wb_refresh_fanrpm },
{ NULL }
};
struct lm_sensor w83792d_sensors[] = {
{ "VCore A", SENSOR_VOLTS_DC, 0, 0x20, lm_refresh_volt, RFACT_NONE },
{ "VCore B", SENSOR_VOLTS_DC, 0, 0x21, lm_refresh_volt, RFACT_NONE },
{ "+3.3V", SENSOR_VOLTS_DC, 0, 0x22, lm_refresh_volt, RFACT_NONE },
{ "-5V", SENSOR_VOLTS_DC, 0, 0x23, wb_refresh_nvolt, RFACT(120, 56) },
{ "+12V", SENSOR_VOLTS_DC, 0, 0x24, lm_refresh_volt, RFACT(28, 10) },
{ "-12V", SENSOR_VOLTS_DC, 0, 0x25, wb_refresh_nvolt, RFACT(232, 56) },
{ "+5V", SENSOR_VOLTS_DC, 0, 0x26, lm_refresh_volt, RFACT(34, 50) },
{ "5VSB", SENSOR_VOLTS_DC, 0, 0xb0, lm_refresh_volt, RFACT(17, 33) },
{ "VBAT", SENSOR_VOLTS_DC, 0, 0xb1, lm_refresh_volt, RFACT_NONE },
{ "", SENSOR_TEMP, 0, 0x27, lm_refresh_temp },
{ "", SENSOR_TEMP, 0, 0xc0, wb_refresh_temp },
{ "", SENSOR_TEMP, 0, 0xc8, wb_refresh_temp },
{ "", SENSOR_FANRPM, 0, 0x28, wb_w83792d_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x29, wb_w83792d_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x2a, wb_w83792d_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0xb8, wb_w83792d_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0xb9, wb_w83792d_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0xba, wb_w83792d_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0xbe, wb_w83792d_refresh_fanrpm },
{ NULL }
};
struct lm_sensor as99127f_sensors[] = {
{ "VCore A", SENSOR_VOLTS_DC, 0, 0x20, lm_refresh_volt, RFACT_NONE },
{ "VCore B", SENSOR_VOLTS_DC, 0, 0x21, lm_refresh_volt, RFACT_NONE },
{ "+3.3V", SENSOR_VOLTS_DC, 0, 0x22, lm_refresh_volt, RFACT_NONE },
{ "+5V", SENSOR_VOLTS_DC, 0, 0x23, lm_refresh_volt, RFACT(34, 50) },
{ "+12V", SENSOR_VOLTS_DC, 0, 0x24, lm_refresh_volt, RFACT(28, 10) },
{ "-12V", SENSOR_VOLTS_DC, 0, 0x25, wb_refresh_nvolt, RFACT(232, 56) },
{ "-5V", SENSOR_VOLTS_DC, 0, 0x26, wb_refresh_nvolt, RFACT(120, 56) },
{ "", SENSOR_TEMP, 0, 0x27, lm_refresh_temp },
{ "", SENSOR_TEMP, 1, 0x50, as_refresh_temp },
{ "", SENSOR_TEMP, 2, 0x50, as_refresh_temp },
{ "", SENSOR_FANRPM, 0, 0x28, lm_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x29, lm_refresh_fanrpm },
{ "", SENSOR_FANRPM, 0, 0x2a, lm_refresh_fanrpm },
{ NULL }
};
void
lm_probe(struct lm_softc *sc)
{
int i;
for (i = 0; i < NELEM(lm_chips); i++)
if (lm_chips[i].chip_match(sc))
break;
}
void
lm_attach(struct lm_softc *sc)
{
u_int i, config;
if (sc->numsensors == 0)
return;
sensor_task_register(sc, lm_refresh, 5);
config = sc->lm_readreg(sc, LM_CONFIG);
sc->lm_writereg(sc, LM_CONFIG, config | 0x01);
strlcpy(sc->sensordev.xname, device_get_nameunit(sc->sc_dev),
sizeof(sc->sensordev.xname));
for (i = 0; i < sc->numsensors; ++i)
sensor_attach(&sc->sensordev, &sc->sensors[i]);
sensordev_install(&sc->sensordev);
}
int
lm_detach(struct lm_softc *sc)
{
int i;
sensordev_deinstall(&sc->sensordev);
for (i = 0; i < sc->numsensors; i++)
sensor_detach(&sc->sensordev, &sc->sensors[i]);
sensor_task_unregister(sc);
return 0;
}
int
lm_match(struct lm_softc *sc)
{
int chipid;
const char *cdesc;
char fulldesc[64];
chipid = sc->lm_readreg(sc, LM_CHIPID) & LM_CHIPID_MASK;
switch(chipid) {
case LM_CHIPID_LM78:
cdesc = "LM78";
break;
case LM_CHIPID_LM78J:
cdesc = "LM78J";
break;
case LM_CHIPID_LM79:
cdesc = "LM79";
break;
case LM_CHIPID_LM81:
cdesc = "LM81";
break;
default:
return 0;
}
ksnprintf(fulldesc, sizeof(fulldesc),
"National Semiconductor %s Hardware Monitor", cdesc);
device_set_desc_copy(sc->sc_dev, fulldesc);
lm_setup_sensors(sc, lm78_sensors);
sc->refresh_sensor_data = lm_refresh_sensor_data;
return 1;
}
int
def_match(struct lm_softc *sc)
{
int chipid;
char fulldesc[64];
chipid = sc->lm_readreg(sc, LM_CHIPID) & LM_CHIPID_MASK;
ksnprintf(fulldesc, sizeof(fulldesc),
"unknown Hardware Monitor (ID 0x%x)", chipid);
device_set_desc_copy(sc->sc_dev, fulldesc);
lm_setup_sensors(sc, lm78_sensors);
sc->refresh_sensor_data = lm_refresh_sensor_data;
return 1;
}
int
wb_match(struct lm_softc *sc)
{
int banksel, vendid, devid;
const char *cdesc;
char desc[64];
char fulldesc[64];
banksel = sc->lm_readreg(sc, WB_BANKSEL);
sc->lm_writereg(sc, WB_BANKSEL, WB_BANKSEL_HBAC);
vendid = sc->lm_readreg(sc, WB_VENDID) << 8;
sc->lm_writereg(sc, WB_BANKSEL, 0);
vendid |= sc->lm_readreg(sc, WB_VENDID);
sc->lm_writereg(sc, WB_BANKSEL, banksel);
DPRINTF((" winbond vend id 0x%x\n", vendid));
if (vendid != WB_VENDID_WINBOND && vendid != WB_VENDID_ASUS)
return 0;
sc->lm_writereg(sc, WB_BANKSEL, WB_BANKSEL_B0);
devid = sc->lm_readreg(sc, LM_CHIPID);
sc->chipid = sc->lm_readreg(sc, WB_BANK0_CHIPID);
sc->lm_writereg(sc, WB_BANKSEL, banksel);
DPRINTF((" winbond chip id 0x%x\n", sc->chipid));
switch(sc->chipid) {
case WB_CHIPID_W83627HF:
cdesc = "W83627HF";
lm_setup_sensors(sc, w83627hf_sensors);
break;
case WB_CHIPID_W83627THF:
cdesc = "W83627THF";
lm_setup_sensors(sc, w83637hf_sensors);
break;
case WB_CHIPID_W83627EHF_A:
cdesc = "W83627EHF-A";
lm_setup_sensors(sc, w83627ehf_sensors);
break;
case WB_CHIPID_W83627EHF:
cdesc = "W83627EHF";
lm_setup_sensors(sc, w83627ehf_sensors);
break;
case WB_CHIPID_W83627DHG:
if (sc->sioid == WBSIO_ID_NCT6776F) {
cdesc = "NCT6776F";
lm_setup_sensors(sc, nct6776f_sensors);
} else {
cdesc = "W83627DHG";
lm_setup_sensors(sc, w83627dhg_sensors);
}
break;
case WB_CHIPID_W83637HF:
cdesc = "W83637HF";
sc->lm_writereg(sc, WB_BANKSEL, WB_BANKSEL_B0);
if (sc->lm_readreg(sc, WB_BANK0_CONFIG) & WB_CONFIG_VMR9)
sc->vrm9 = 1;
sc->lm_writereg(sc, WB_BANKSEL, banksel);
lm_setup_sensors(sc, w83637hf_sensors);
break;
case WB_CHIPID_W83697HF:
cdesc = "W83697HF";
lm_setup_sensors(sc, w83697hf_sensors);
break;
case WB_CHIPID_W83781D:
case WB_CHIPID_W83781D_2:
cdesc = "W83781D";
lm_setup_sensors(sc, w83781d_sensors);
break;
case WB_CHIPID_W83782D:
cdesc = "W83782D";
lm_setup_sensors(sc, w83782d_sensors);
break;
case WB_CHIPID_W83783S:
cdesc = "W83783S";
lm_setup_sensors(sc, w83783s_sensors);
break;
case WB_CHIPID_W83791D:
cdesc = "W83791D";
lm_setup_sensors(sc, w83791d_sensors);
break;
case WB_CHIPID_W83791SD:
cdesc = "W83791SD";
break;
case WB_CHIPID_W83792D:
if (devid >= 0x10 && devid <= 0x29)
ksnprintf(desc, sizeof(desc),
"W83792D rev %c", 'A' + devid - 0x10);
else
ksnprintf(desc, sizeof(desc),
"W83792D rev 0x%x", devid);
cdesc = desc;
lm_setup_sensors(sc, w83792d_sensors);
break;
case WB_CHIPID_AS99127F:
if (vendid == WB_VENDID_ASUS) {
cdesc = "AS99127F";
lm_setup_sensors(sc, w83781d_sensors);
} else {
cdesc = "AS99127F rev 2";
lm_setup_sensors(sc, as99127f_sensors);
}
break;
default:
ksnprintf(fulldesc, sizeof(fulldesc),
"unknown Winbond Hardware Monitor (Chip ID 0x%x)",
sc->chipid);
device_set_desc_copy(sc->sc_dev, fulldesc);
lm_setup_sensors(sc, lm78_sensors);
sc->refresh_sensor_data = lm_refresh_sensor_data;
return 1;
}
if (cdesc[0] == 'W')
ksnprintf(fulldesc, sizeof(fulldesc),
"Winbond %s Hardware Monitor", cdesc);
else
ksnprintf(fulldesc, sizeof(fulldesc),
"ASUS %s Hardware Monitor", cdesc);
device_set_desc_copy(sc->sc_dev, fulldesc);
sc->refresh_sensor_data = wb_refresh_sensor_data;
return 1;
}
void
lm_setup_sensors(struct lm_softc *sc, struct lm_sensor *sensors)
{
int i;
for (i = 0; sensors[i].desc; i++) {
sc->sensors[i].type = sensors[i].type;
strlcpy(sc->sensors[i].desc, sensors[i].desc,
sizeof(sc->sensors[i].desc));
sc->numsensors++;
}
sc->lm_sensors = sensors;
}
void
lm_refresh(void *arg)
{
struct lm_softc *sc = arg;
sc->refresh_sensor_data(sc);
}
void
lm_refresh_sensor_data(struct lm_softc *sc)
{
int i;
for (i = 0; i < sc->numsensors; i++)
sc->lm_sensors[i].refresh(sc, i);
}
void
lm_refresh_volt(struct lm_softc *sc, int n)
{
struct ksensor *sensor = &sc->sensors[n];
int data;
data = sc->lm_readreg(sc, sc->lm_sensors[n].reg);
sensor->value = (data << 4);
sensor->value *= sc->lm_sensors[n].rfact;
sensor->value /= 10;
}
void
lm_refresh_temp(struct lm_softc *sc, int n)
{
struct ksensor *sensor = &sc->sensors[n];
int sdata;
sdata = sc->lm_readreg(sc, sc->lm_sensors[n].reg);
if (sdata > 0x7d && sdata < 0xc9) {
sensor->flags |= SENSOR_FINVALID;
sensor->value = 0;
} else {
if (sdata & 0x80)
sdata -= 0x100;
sensor->flags &= ~SENSOR_FINVALID;
sensor->value = sdata * 1000000 + 273150000;
}
}
void
lm_refresh_fanrpm(struct lm_softc *sc, int n)
{
struct ksensor *sensor = &sc->sensors[n];
int data, divisor = 1;
if (sc->lm_sensors[n].reg == LM_FAN1 ||
sc->lm_sensors[n].reg == LM_FAN2) {
data = sc->lm_readreg(sc, LM_VIDFAN);
if (sc->lm_sensors[n].reg == LM_FAN1)
divisor = (data >> 4) & 0x03;
else
divisor = (data >> 6) & 0x03;
}
data = sc->lm_readreg(sc, sc->lm_sensors[n].reg);
if (data == 0xff || data == 0x00) {
sensor->flags |= SENSOR_FINVALID;
sensor->value = 0;
} else {
sensor->flags &= ~SENSOR_FINVALID;
sensor->value = 1350000 / (data << divisor);
}
}
void
wb_refresh_sensor_data(struct lm_softc *sc)
{
int banksel, bank, i;
banksel = bank = sc->lm_readreg(sc, WB_BANKSEL);
for (i = 0; i < sc->numsensors; i++) {
if (bank != sc->lm_sensors[i].bank) {
bank = sc->lm_sensors[i].bank;
sc->lm_writereg(sc, WB_BANKSEL, bank);
}
sc->lm_sensors[i].refresh(sc, i);
}
sc->lm_writereg(sc, WB_BANKSEL, banksel);
}
void
wb_w83637hf_refresh_vcore(struct lm_softc *sc, int n)
{
struct ksensor *sensor = &sc->sensors[n];
int data;
data = sc->lm_readreg(sc, sc->lm_sensors[n].reg);
if (sc->vrm9)
sensor->value = (data * 4880) + 700000;
else
sensor->value = (data * 16000);
}
void
wb_refresh_nvolt(struct lm_softc *sc, int n)
{
struct ksensor *sensor = &sc->sensors[n];
int data;
data = sc->lm_readreg(sc, sc->lm_sensors[n].reg);
sensor->value = ((data << 4) - WB_VREF);
sensor->value *= sc->lm_sensors[n].rfact;
sensor->value /= 10;
sensor->value += WB_VREF * 1000;
}
void
wb_w83627ehf_refresh_nvolt(struct lm_softc *sc, int n)
{
struct ksensor *sensor = &sc->sensors[n];
int data;
data = sc->lm_readreg(sc, sc->lm_sensors[n].reg);
sensor->value = ((data << 3) - WB_W83627EHF_VREF);
sensor->value *= RFACT(232, 10);
sensor->value /= 10;
sensor->value += WB_W83627EHF_VREF * 1000;
}
void
wb_refresh_temp(struct lm_softc *sc, int n)
{
struct ksensor *sensor = &sc->sensors[n];
int sdata;
sdata = sc->lm_readreg(sc, sc->lm_sensors[n].reg) << 1;
sdata += sc->lm_readreg(sc, sc->lm_sensors[n].reg + 1) >> 7;
if (sdata > 0x0fa && sdata < 0x1a6) {
sensor->flags |= SENSOR_FINVALID;
sensor->value = 0;
} else {
if (sdata & 0x100)
sdata -= 0x200;
sensor->flags &= ~SENSOR_FINVALID;
sensor->value = sdata * 500000 + 273150000;
}
}
void
wb_refresh_fanrpm(struct lm_softc *sc, int n)
{
struct ksensor *sensor = &sc->sensors[n];
int fan, data, divisor = 0;
if (sc->lm_sensors[n].reg == LM_FAN1 ||
sc->lm_sensors[n].reg == LM_FAN2 ||
sc->lm_sensors[n].reg == LM_FAN3) {
data = sc->lm_readreg(sc, WB_BANK0_VBAT);
fan = (sc->lm_sensors[n].reg - LM_FAN1);
if ((data >> 5) & (1 << fan))
divisor |= 0x04;
}
if (sc->lm_sensors[n].reg == LM_FAN1 ||
sc->lm_sensors[n].reg == LM_FAN2) {
data = sc->lm_readreg(sc, LM_VIDFAN);
if (sc->lm_sensors[n].reg == LM_FAN1)
divisor |= (data >> 4) & 0x03;
else
divisor |= (data >> 6) & 0x03;
} else if (sc->lm_sensors[n].reg == LM_FAN3) {
data = sc->lm_readreg(sc, WB_PIN);
divisor |= (data >> 6) & 0x03;
} else if (sc->lm_sensors[n].reg == WB_BANK0_FAN4 ||
sc->lm_sensors[n].reg == WB_BANK0_FAN5) {
data = sc->lm_readreg(sc, WB_BANK0_FAN45);
if (sc->lm_sensors[n].reg == WB_BANK0_FAN4)
divisor |= (data >> 0) & 0x07;
else
divisor |= (data >> 4) & 0x07;
}
data = sc->lm_readreg(sc, sc->lm_sensors[n].reg);
if (data == 0xff || data == 0x00) {
sensor->flags |= SENSOR_FINVALID;
sensor->value = 0;
} else {
sensor->flags &= ~SENSOR_FINVALID;
sensor->value = 1350000 / (data << divisor);
}
}
void
wb_w83792d_refresh_fanrpm(struct lm_softc *sc, int n)
{
struct ksensor *sensor = &sc->sensors[n];
int reg, shift, data, divisor = 1;
switch (sc->lm_sensors[n].reg) {
case 0x28:
reg = 0x47; shift = 0;
break;
case 0x29:
reg = 0x47; shift = 4;
break;
case 0x2a:
reg = 0x5b; shift = 0;
break;
case 0xb8:
reg = 0x5b; shift = 4;
break;
case 0xb9:
reg = 0x5c; shift = 0;
break;
case 0xba:
reg = 0x5c; shift = 4;
break;
case 0xbe:
reg = 0x9e; shift = 0;
break;
default:
reg = 0; shift = 0;
break;
}
data = sc->lm_readreg(sc, sc->lm_sensors[n].reg);
if (data == 0xff || data == 0x00) {
sensor->flags |= SENSOR_FINVALID;
sensor->value = 0;
} else {
if (reg != 0)
divisor = (sc->lm_readreg(sc, reg) >> shift) & 0x7;
sensor->flags &= ~SENSOR_FINVALID;
sensor->value = 1350000 / (data << divisor);
}
}
void
wb_nct6776f_refresh_fanrpm(struct lm_softc *sc, int n)
{
struct ksensor *sensor = &sc->sensors[n];
int datah, datal;
datah = sc->lm_readreg(sc, sc->lm_sensors[n].reg);
datal = sc->lm_readreg(sc, sc->lm_sensors[n].reg + 1);
if (datah == 0xff) {
sensor->flags |= SENSOR_FINVALID;
sensor->value = 0;
} else {
sensor->flags &= ~SENSOR_FINVALID;
sensor->value = (datah << 8) | datal;
}
}
void
as_refresh_temp(struct lm_softc *sc, int n)
{
struct ksensor *sensor = &sc->sensors[n];
int sdata;
sdata = sc->lm_readreg(sc, sc->lm_sensors[n].reg) << 1;
sdata += sc->lm_readreg(sc, sc->lm_sensors[n].reg + 1) >> 7;
if (sdata == 0x1ff) {
sensor->flags |= SENSOR_FINVALID;
sensor->value = 0;
} else {
if (sdata & 0x100)
sdata -= 0x200;
sensor->flags &= ~SENSOR_FINVALID;
sensor->value = sdata * 500000 + 273150000;
}
}