#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/sensors.h>
#include <dev/pci/pcireg.h>
#include <dev/pci/pcivar.h>
#include <dev/pci/pcidevs.h>
#define K_THERMTRIP_STAT_R 0xe4
#define K_NORTHBRIDGE_CAP_R 0xe8
#define K_CPUID_FAMILY_MODEL_R 0xfc
#define K_THERM_SENSE_SEL (1 << 6)
#define K_THERM_SENSE_CORE_SEL (1 << 2)
#define K_T_SEL_C0(v) (v |= K_THERM_SENSE_CORE_SEL)
#define K_T_SEL_C1(v) (v &= ~(K_THERM_SENSE_CORE_SEL))
#define K_T_SEL_S0(v) (v &= ~(K_THERM_SENSE_SEL))
#define K_T_SEL_S1(v) (v |= K_THERM_SENSE_SEL)
static const struct {
const char rev[5];
const pcireg_t cpuid[5];
} kate_proc[] = {
{ "BH-F", { 0x00040FB0, 0x00040F80, 0, 0, 0 } },
{ "DH-F", { 0x00040FF0, 0x00050FF0, 0x00040FC0, 0, 0 } },
{ "JH-F", { 0x00040F10, 0x00040F30, 0x000C0F10, 0, 0 } },
{ "BH-G", { 0x00060FB0, 0x00060F80, 0, 0, 0 } },
{ "DH-G", { 0x00070FF0, 0x00060FF0,
0x00060FC0, 0x00070FC0, 0 } }
};
struct kate_softc {
struct device sc_dev;
pci_chipset_tag_t sc_pc;
pcitag_t sc_pcitag;
struct ksensor sc_sensors[4];
struct ksensordev sc_sensordev;
char sc_rev;
int8_t sc_numsensors;
};
int kate_match(struct device *, void *, void *);
void kate_attach(struct device *, struct device *, void *);
void kate_refresh(void *);
const struct cfattach kate_ca = {
sizeof(struct kate_softc), kate_match, kate_attach
};
struct cfdriver kate_cd = {
NULL, "kate", DV_DULL
};
int
kate_match(struct device *parent, void *match, void *aux)
{
struct pci_attach_args *pa = aux;
#ifndef KATE_STRICT
struct kate_softc ks;
struct kate_softc *sc = &ks;
#endif
pcireg_t c;
int i, j;
if (PCI_VENDOR(pa->pa_id) != PCI_VENDOR_AMD ||
PCI_PRODUCT(pa->pa_id) != PCI_PRODUCT_AMD_0F_MISC)
return 0;
c = pci_conf_read(pa->pa_pc, pa->pa_tag, K_CPUID_FAMILY_MODEL_R);
for (i = 0; i < sizeof(kate_proc) / sizeof(kate_proc[0]); i++)
for (j = 0; kate_proc[i].cpuid[j] != 0; j++)
if ((c & ~0xf) == kate_proc[i].cpuid[j])
return 2;
#ifndef KATE_STRICT
sc->sc_numsensors = 4;
sc->sc_pc = pa->pa_pc;
sc->sc_pcitag = pa->pa_tag;
kate_refresh(sc);
for (i = 0; i < sc->sc_numsensors; i++)
if (!(sc->sc_sensors[i].flags & SENSOR_FINVALID))
return 2;
#endif
return 0;
}
void
kate_attach(struct device *parent, struct device *self, void *aux)
{
struct kate_softc *sc = (struct kate_softc *)self;
struct pci_attach_args *pa = aux;
pcireg_t c, d;
int i, j, cmpcap;
c = pci_conf_read(pa->pa_pc, pa->pa_tag, K_CPUID_FAMILY_MODEL_R);
for (i = 0; i < sizeof(kate_proc) / sizeof(kate_proc[0]) &&
sc->sc_rev == '\0'; i++)
for (j = 0; kate_proc[i].cpuid[j] != 0; j++)
if ((c & ~0xf) == kate_proc[i].cpuid[j]) {
sc->sc_rev = kate_proc[i].rev[3];
printf(": core rev %.4s%.1x",
kate_proc[i].rev, c & 0xf);
}
if (c != 0x0 && sc->sc_rev == '\0') {
sc->sc_rev = 'G';
printf(": cpuid 0x%x", c);
}
d = pci_conf_read(pa->pa_pc, pa->pa_tag, K_NORTHBRIDGE_CAP_R);
cmpcap = (d >> 12) & 0x3;
sc->sc_pc = pa->pa_pc;
sc->sc_pcitag = pa->pa_tag;
#ifndef KATE_STRICT
sc->sc_numsensors = 4;
kate_refresh(sc);
if (cmpcap == 0 &&
(sc->sc_sensors[2].flags & SENSOR_FINVALID) &&
(sc->sc_sensors[3].flags & SENSOR_FINVALID))
sc->sc_numsensors = 2;
#else
sc->sc_numsensors = cmpcap ? 4 : 2;
#endif
strlcpy(sc->sc_sensordev.xname, sc->sc_dev.dv_xname,
sizeof(sc->sc_sensordev.xname));
for (i = 0; i < sc->sc_numsensors; i++) {
sc->sc_sensors[i].type = SENSOR_TEMP;
sensor_attach(&sc->sc_sensordev, &sc->sc_sensors[i]);
}
if (sensor_task_register(sc, kate_refresh, 5) == NULL) {
printf(": unable to register update task\n");
return;
}
sensordev_install(&sc->sc_sensordev);
printf("\n");
}
void
kate_refresh(void *arg)
{
struct kate_softc *sc = arg;
struct ksensor *s = sc->sc_sensors;
int8_t n = sc->sc_numsensors;
pcireg_t t, m;
int i, v;
t = pci_conf_read(sc->sc_pc, sc->sc_pcitag, K_THERMTRIP_STAT_R);
for (i = 0; i < n; i++) {
switch(i) {
case 0:
K_T_SEL_C0(t);
K_T_SEL_S0(t);
break;
case 1:
K_T_SEL_C0(t);
K_T_SEL_S1(t);
break;
case 2:
K_T_SEL_C1(t);
K_T_SEL_S0(t);
break;
case 3:
K_T_SEL_C1(t);
K_T_SEL_S1(t);
break;
}
m = t & (K_THERM_SENSE_CORE_SEL | K_THERM_SENSE_SEL);
pci_conf_write(sc->sc_pc, sc->sc_pcitag, K_THERMTRIP_STAT_R, t);
t = pci_conf_read(sc->sc_pc, sc->sc_pcitag, K_THERMTRIP_STAT_R);
v = 0x3ff & (t >> 14);
#ifdef KATE_STRICT
if (sc->sc_rev != 'G')
v &= ~0x3;
#endif
if ((t & (K_THERM_SENSE_CORE_SEL | K_THERM_SENSE_SEL)) == m &&
(v & ~0x3) != 0)
s[i].flags &= ~SENSOR_FINVALID;
else
s[i].flags |= SENSOR_FINVALID;
s[i].value = (v * 250000 - 49000000) + 273150000;
}
}