diff options
Diffstat (limited to 'sys/dev')
| -rw-r--r-- | sys/dev/i2c/fcu.c | 184 | ||||
| -rw-r--r-- | sys/dev/i2c/files.i2c | 7 |
2 files changed, 190 insertions, 1 deletions
diff --git a/sys/dev/i2c/fcu.c b/sys/dev/i2c/fcu.c new file mode 100644 index 00000000000..d38c686d35b --- /dev/null +++ b/sys/dev/i2c/fcu.c @@ -0,0 +1,184 @@ +/* $OpenBSD: fcu.c,v 1.1 2005/11/16 18:51:45 deraadt Exp $ */ + +/* + * Copyright (c) 2005 Mark Kettenis + * + * 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> + +/* FCU registers */ +#define FCU_FAN_FAIL 0x0b /* fans states in bits 0<1-6>7 */ +#define FCU_FAN_ACTIVE 0x0d +#define FCU_FANREAD(x) 0x11 + (x)*2 +#define FCU_FANSET(x) 0x10 + (x)*2 +#define FCU_PWM_FAIL 0x2b +#define FCU_PWM_ACTIVE 0x2d +#define FCU_PWMREAD(x) 0x30 + (x)*2 + +/* Sensors */ +#define FCU_RPM1 0 +#define FCU_RPM2 1 +#define FCU_RPM3 2 +#define FCU_RPM4 3 +#define FCU_RPM5 4 +#define FCU_RPM6 5 +#define FCU_FANS 6 +#define FCU_PWM1 6 +#define FCU_PWM2 7 +#define FCU_PWMS 2 +#define FCU_NUM_SENSORS 8 + +struct fcu_softc { + struct device sc_dev; + i2c_tag_t sc_tag; + i2c_addr_t sc_addr; + + struct sensor sc_sensor[FCU_NUM_SENSORS]; +}; + +int fcu_match(struct device *, void *, void *); +void fcu_attach(struct device *, struct device *, void *); + +void fcu_refresh(void *); + +struct cfattach fcu_ca = { + sizeof(struct fcu_softc), fcu_match, fcu_attach +}; + +struct cfdriver fcu_cd = { + NULL, "fcu", DV_DULL +}; + +int +fcu_match(struct device *parent, void *match, void *aux) +{ + struct i2c_attach_args *ia = aux; + + if (ia->ia_compat) { + if (strcmp(ia->ia_compat, "fcu") == 0) + return (1); + return (0); + } + return (0); /* Apple-only */ +} + +void +fcu_attach(struct device *parent, struct device *self, void *aux) +{ + struct fcu_softc *sc = (struct fcu_softc *)self; + struct i2c_attach_args *ia = aux; + int i; + + sc->sc_tag = ia->ia_tag; + sc->sc_addr = ia->ia_addr; + + /* Initialize sensor data. */ + for (i = 0; i < FCU_FANS; i++) { + strlcpy(sc->sc_sensor[i].device, sc->sc_dev.dv_xname, + sizeof(sc->sc_sensor[i].device)); + sc->sc_sensor[i].type = SENSOR_FANRPM; + snprintf(sc->sc_sensor[i].desc, + sizeof(sc->sc_sensor[i].desc), "FAN%d", i); + } + for (i = 0; i < FCU_PWMS; i++) { + strlcpy(sc->sc_sensor[FCU_PWM1 + i].device, sc->sc_dev.dv_xname, + sizeof(sc->sc_sensor[FCU_PWM1 + i].device)); + sc->sc_sensor[FCU_PWM1 + i].type = SENSOR_FANRPM; + snprintf(sc->sc_sensor[FCU_PWM1 + i].desc, + sizeof(sc->sc_sensor[FCU_PWM1 + i].desc), "PWM%d", i); + } + + if (sensor_task_register(sc, fcu_refresh, 5)) { + printf(", unable to register update task\n"); + return; + } + + for (i = 0; i < FCU_NUM_SENSORS; i++) + SENSOR_ADD(&sc->sc_sensor[i]); + + printf("\n"); +} + +void +fcu_refresh(void *arg) +{ + struct fcu_softc *sc = arg; + u_int8_t cmd, fail, fan[2], active; + int i; + + iic_acquire_bus(sc->sc_tag, 0); + + cmd = FCU_FAN_FAIL; + if (iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP, + sc->sc_addr, &cmd, sizeof cmd, &fail, sizeof fail, 0)) + goto abort; + cmd = FCU_FAN_ACTIVE; + if (iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP, + sc->sc_addr, &cmd, sizeof cmd, &active, sizeof active, 0)) + goto abort; + fail &= active; + + for (i = 0; i < FCU_FANS; i++) { + if (fail & (1 << (i + 1))) + sc->sc_sensor[i].flags |= SENSOR_FINVALID; + else + sc->sc_sensor[i].flags &= ~SENSOR_FINVALID; + } + + cmd = FCU_PWM_FAIL; + if (iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP, + sc->sc_addr, &cmd, sizeof cmd, &fail, sizeof fail, 0)) + goto abort; + cmd = FCU_PWM_ACTIVE; + if (iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP, + sc->sc_addr, &cmd, sizeof cmd, &active, sizeof active, 0)) + goto abort; + fail &= active; + + for (i = 0; i < FCU_PWMS; i++) { + if (fail & (1 << (i + 1))) + sc->sc_sensor[FCU_PWMS + i].flags |= SENSOR_FINVALID; + else + sc->sc_sensor[FCU_PWMS + i].flags &= ~SENSOR_FINVALID; + } + + for (i = 0; i < FCU_FANS; i++) { + cmd = FCU_FANREAD(i + 1); + if (iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP, + sc->sc_addr, &cmd, sizeof cmd, &fan, sizeof fan, 0)) { + sc->sc_sensor[FCU_RPM1 + i].flags |= SENSOR_FINVALID; + continue; + } + sc->sc_sensor[FCU_RPM1 + i].value = (fan[0] << 5) | (fan[1] >> 3); + } + + for (i = 0; i < FCU_PWMS; i++) { + cmd = FCU_PWMREAD(i + 1); + if (iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP, + sc->sc_addr, &cmd, sizeof cmd, &fan, sizeof fan, 0)) { + sc->sc_sensor[FCU_PWM1 + i].flags |= SENSOR_FINVALID; + continue; + } + sc->sc_sensor[FCU_PWM1 + i].value = (fan[0] * 1000) / 2559; + } + +abort: + iic_release_bus(sc->sc_tag, 0); +} diff --git a/sys/dev/i2c/files.i2c b/sys/dev/i2c/files.i2c index c39404762f3..84ba3ced648 100644 --- a/sys/dev/i2c/files.i2c +++ b/sys/dev/i2c/files.i2c @@ -1,4 +1,4 @@ -# $OpenBSD: files.i2c,v 1.13 2005/11/16 06:26:14 deraadt Exp $ +# $OpenBSD: files.i2c,v 1.14 2005/11/16 18:51:45 deraadt Exp $ # $NetBSD: files.i2c,v 1.3 2003/10/20 16:24:10 briggs Exp $ define i2c {[addr = -1], [size = -1]} @@ -53,3 +53,8 @@ file dev/i2c/pca9554.c pcagpio device maxds: gpiobus attach maxds at i2c file dev/i2c/ds1631.c maxds + +# Apple FCU +device fcu: gpiobus +attach fcu at i2c +file dev/i2c/fcu.c fcu |