new driver for TI tmhc50 / adm1022 / adm1028; checked by kettenis

2 files changed, 157 insertions, 1 deletions

diff --git a/sys/dev/i2c/files.i2c b/sys/dev/i2c/files.i2c
index 9c2e8f2c335..29a5689566c 100644
--- a/sys/dev/i2c/files.i2c
+++ b/sys/dev/i2c/files.i2c
@@ -1,4 +1,4 @@
-# $OpenBSD: files.i2c,v 1.38 2007/09/07 19:17:26 kettenis Exp $
+# $OpenBSD: files.i2c,v 1.39 2007/09/09 00:20:30 deraadt Exp $
 #	$NetBSD: files.i2c,v 1.3 2003/10/20 16:24:10 briggs Exp $
 
 define	i2c {[addr = -1], [size = -1]}
@@ -132,3 +132,8 @@ file	dev/i2c/pca9532.c			pcaled
 device	adl
 attach	adl at i2c
 file	dev/i2c/asc7621.c			adl
+
+# TI TMHC50 / Analog ADM1022
+device	tmhc
+attach	tmhc at i2c
+file	dev/i2c/tmhc50.c			tmhc
diff --git a/sys/dev/i2c/tmhc50.c b/sys/dev/i2c/tmhc50.c
new file mode 100644
index 00000000000..c23811a3419
--- /dev/null
+++ b/sys/dev/i2c/tmhc50.c
@@ -0,0 +1,151 @@
+/*	$OpenBSD: tmhc50.c,v 1.1 2007/09/09 00:20:30 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>
+
+/* ADM 1022 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;
+
+	/* 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);
+}