/* $OpenBSD: thmc50.c,v 1.4 2007/10/17 17:14:54 deraadt Exp $ */ /* * Copyright (c) 2007 Theo de Raadt * * Permission to use, copy, modify, and distribute this software for any * purpose with or without fee is hereby granted, provided that the above * copyright notice and this permission notice appear in all copies. * * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. */ #include <sys/param.h> #include <sys/systm.h> #include <sys/device.h> #include <sys/sensors.h> #include <dev/i2c/i2cvar.h> /* THMC50 registers */ #define THMC50_TEMP0 0x27 #define THMC50_TEMP1 0x26 #define THMC50_TEMP2 0x20 /* Sensors */ #define THMC_TEMP0 0 #define THMC_TEMP1 1 #define THMC_TEMP2 2 #define THMC_NUM_SENSORS 3 struct thmc_softc { struct device sc_dev; i2c_tag_t sc_tag; i2c_addr_t sc_addr; struct ksensor sc_sensor[THMC_NUM_SENSORS]; struct ksensordev sc_sensordev; }; int thmc_match(struct device *, void *, void *); void thmc_attach(struct device *, struct device *, void *); void thmc_refresh(void *); struct cfattach thmc_ca = { sizeof(struct thmc_softc), thmc_match, thmc_attach }; struct cfdriver thmc_cd = { NULL, "thmc", DV_DULL }; int thmc_match(struct device *parent, void *match, void *aux) { struct i2c_attach_args *ia = aux; if (strcmp(ia->ia_name, "thmc50") == 0 || strcmp(ia->ia_name, "adm1022") == 0 || strcmp(ia->ia_name, "adm1028") == 0) return (1); return (0); } void thmc_attach(struct device *parent, struct device *self, void *aux) { struct thmc_softc *sc = (struct thmc_softc *)self; struct i2c_attach_args *ia = aux; int numsensors = THMC_NUM_SENSORS; int i; sc->sc_tag = ia->ia_tag; sc->sc_addr = ia->ia_addr; printf(": %s", ia->ia_name); /* Initialize sensor data. */ strlcpy(sc->sc_sensordev.xname, sc->sc_dev.dv_xname, sizeof(sc->sc_sensordev.xname)); sc->sc_sensor[THMC_TEMP0].type = SENSOR_TEMP; strlcpy(sc->sc_sensor[THMC_TEMP0].desc, "Internal", sizeof(sc->sc_sensor[THMC_TEMP0].desc)); sc->sc_sensor[THMC_TEMP1].type = SENSOR_TEMP; strlcpy(sc->sc_sensor[THMC_TEMP1].desc, "External", sizeof(sc->sc_sensor[THMC_TEMP1].desc)); if (strcmp(ia->ia_name, "adm1022") == 0) { /* Only the adm1022 has a THMC50_TEMP2 sensor */ sc->sc_sensor[THMC_TEMP2].type = SENSOR_TEMP; strlcpy(sc->sc_sensor[THMC_TEMP2].desc, "External", sizeof(sc->sc_sensor[THMC_TEMP2].desc)); } else { sc->sc_sensor[THMC_TEMP2].type = -1; numsensors--; } if (sensor_task_register(sc, thmc_refresh, 5) == NULL) { printf(", unable to register update task\n"); return; } for (i = 0; i < numsensors; i++) sensor_attach(&sc->sc_sensordev, &sc->sc_sensor[i]); sensordev_install(&sc->sc_sensordev); printf("\n"); } void thmc_refresh(void *arg) { struct thmc_softc *sc = arg; u_int8_t cmd; int8_t sdata; iic_acquire_bus(sc->sc_tag, 0); cmd = THMC50_TEMP0; if (iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP, sc->sc_addr, &cmd, sizeof cmd, &sdata, sizeof sdata, 0) == 0) { sc->sc_sensor[THMC_TEMP0].value = 273150000 + 1000000 * sdata; sc->sc_sensor[THMC_TEMP0].flags &= ~SENSOR_FINVALID; } else sc->sc_sensor[THMC_TEMP0].flags |= SENSOR_FINVALID; cmd = THMC50_TEMP1; if (iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP, sc->sc_addr, &cmd, sizeof cmd, &sdata, sizeof sdata, 0) == 0) { sc->sc_sensor[THMC_TEMP1].value = 273150000 + 1000000 * sdata; sc->sc_sensor[THMC_TEMP1].flags &= ~SENSOR_FINVALID; } else sc->sc_sensor[THMC_TEMP1].flags |= SENSOR_FINVALID; if (sc->sc_sensor[THMC_TEMP2].type > 0) { cmd = THMC50_TEMP2; if (iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP, sc->sc_addr, &cmd, sizeof cmd, &sdata, sizeof sdata, 0) == 0) { sc->sc_sensor[THMC_TEMP2].value = 273150000 + 1000000 * sdata; sc->sc_sensor[THMC_TEMP2].flags &= ~SENSOR_FINVALID; } else sc->sc_sensor[THMC_TEMP2].flags |= SENSOR_FINVALID; } iic_release_bus(sc->sc_tag, 0); }