Start of a driver for the "Active Protection System" accelerometer

found in recentish ThinkPads.

Sensors are reported via hw.sensors in sysctl but sensor numbers
and presence is likely to change.  Units and use of all of the
sensors is not yet known as IBM has not released any documentation.

Driver is based on information reverse engineered from the windows
driver by Anurag Sharma and Mark Smith.

"commit the code" deraadt@

1 files changed, 329 insertions, 0 deletions

diff --git a/sys/dev/isa/aps.c b/sys/dev/isa/aps.c
new file mode 100644
index 00000000000..bca5f2279c9
--- /dev/null
+++ b/sys/dev/isa/aps.c
@@ -0,0 +1,329 @@
+/*	$OpenBSD: aps.c,v 1.1 2005/08/05 03:52:32 jsg Exp $	*/
+/*
+ * Copyright (c) 2005 Jonathan Gray <jsg@openbsd.org>
+ *
+ * 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.
+ */
+
+/*
+ * A driver for the ThinkPad Active Protection System based on notes from
+ * http://www.almaden.ibm.com/cs/people/marksmith/aps.html
+ */
+
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/device.h>
+#include <sys/kernel.h>
+#include <sys/sensors.h>
+#include <sys/timeout.h>
+#include <machine/bus.h>
+
+#include <dev/isa/isareg.h>
+#include <dev/isa/isavar.h>
+
+#include <dev/isa/apsreg.h>
+#include <dev/isa/apsvar.h>
+
+#if defined(APSDEBUG)
+#define DPRINTF(x)		do { printf x; } while (0)
+#else
+#define DPRINTF(x)
+#endif
+
+int aps_match(struct device *, void *, void *);
+void aps_attach(struct device *, struct device *, void *);
+
+u_int8_t aps_mem_read_1(bus_space_tag_t, bus_space_handle_t, int, u_int8_t);
+int aps_read_data(struct aps_softc *);
+void aps_refresh_sensor_data(struct aps_softc *sc);
+void aps_refresh(void *);
+
+struct cfattach aps_ca = {
+	sizeof(struct aps_softc),
+	aps_match,
+	aps_attach
+};
+
+struct cfdriver aps_cd = {
+	NULL, "aps", DV_DULL
+};
+
+struct timeout aps_timeout;
+
+int
+aps_match(struct device *parent, void *match, void *aux)
+{
+	bus_space_tag_t iot;
+	bus_space_handle_t ioh;
+	struct isa_attach_args *ia = aux;
+	int iobase, i;
+	u_int8_t cr;
+
+	iot = ia->ia_iot;
+	iobase = ia->ipa_io[0].base;
+
+	if (bus_space_map(iot, iobase, APS_ADDR_SIZE, 0, &ioh)) {
+		DPRINTF(("aps: can't map i/o space\n"));
+		return (0);
+	}
+
+	/* See if this machine has APS */
+	bus_space_write_1(iot, ioh, APS_INIT, 0x13);
+	bus_space_write_1(iot, ioh, APS_CMD, 0x01);
+	if (!aps_mem_read_1(iot, ioh, APS_CMD, 0x00)) {
+		bus_space_unmap(iot, ioh, APS_ADDR_SIZE);
+		return (0);
+	}
+
+	/*
+	 * Observed values from Linux driver:
+	 * 0x01: T42
+	 * 0x02: chip already initialised
+	 * 0x03: T41
+	 */
+	for (i = 0; i < 10; i++) {
+		cr = bus_space_read_1(iot, ioh, APS_STATE);
+		if (cr > 0 && cr < 4)
+			break;
+		delay(5 * 1000);
+	}
+	
+	bus_space_unmap(iot, ioh, APS_ADDR_SIZE);
+	DPRINTF(("aps: state register 0x%x\n", cr));
+	if (cr < 1 || cr > 3) {
+		DPRINTF(("aps0: unsupported state %d\n", cr));
+		return (0);
+	}
+
+	ia->ipa_nio = 1;
+	ia->ipa_io[0].length = APS_ADDR_SIZE;
+	ia->ipa_nmem = 0;
+	ia->ipa_nirq = 0;
+	ia->ipa_ndrq = 0;
+
+	return (1);
+}
+
+void
+aps_attach(struct device *parent, struct device *self, void *aux)
+{
+	struct aps_softc *sc = (void *)self;
+	int iobase, i;
+	bus_space_tag_t iot;
+	bus_space_handle_t ioh;
+	struct isa_attach_args *ia = aux;
+
+	iobase = ia->ipa_io[0].base;
+	iot = sc->aps_iot = ia->ia_iot;
+
+	if (bus_space_map(iot, iobase, APS_ADDR_SIZE, 0, &sc->aps_ioh)) {
+		printf(": can't map i/o space\n");
+		return;
+	}
+
+	ioh = sc->aps_ioh;
+
+	printf("\n");
+
+	bus_space_write_1(iot, ioh, APS_INIT, 0x17);
+	bus_space_write_1(iot, ioh, APS_STATE, 0x81);
+	bus_space_write_1(iot, ioh, APS_CMD, 0x01);
+	if (!aps_mem_read_1(iot, ioh, APS_CMD, 0x00))
+		goto out;
+	if (!aps_mem_read_1(iot, ioh, APS_STATE, 0x00))
+		goto out;
+	if (!aps_mem_read_1(iot, ioh, APS_XACCEL, 0x60))
+		goto out;
+	if (!aps_mem_read_1(iot, ioh, APS_XACCEL + 1, 0x00))
+		goto out;
+	bus_space_write_1(iot, ioh, APS_INIT, 0x14);
+	bus_space_write_1(iot, ioh, APS_STATE, 0x01);
+	bus_space_write_1(iot, ioh, APS_CMD, 0x01);
+	if (!aps_mem_read_1(iot, ioh, APS_CMD, 0x00))
+		goto out;
+	bus_space_write_1(iot, ioh, APS_INIT, 0x10);
+	bus_space_write_1(iot, ioh, APS_STATE, 0xc8);
+	bus_space_write_1(iot, ioh, APS_XACCEL, 0x00);
+	bus_space_write_1(iot, ioh, APS_XACCEL + 1, 0x02);
+	bus_space_write_1(iot, ioh, APS_CMD, 0x01);
+	if (!aps_mem_read_1(iot, ioh, APS_CMD, 0x00))
+		goto out;
+	/* refresh data */
+	bus_space_write_1(iot, ioh, APS_INIT, 0x11);
+	bus_space_write_1(iot, ioh, APS_CMD, 0x01);
+	if (!aps_mem_read_1(iot, ioh, APS_ACCEL_STATE, 0x50))
+		goto out;
+	if (!aps_mem_read_1(iot, ioh, APS_STATE, 0x00))
+		goto out;
+
+	sc->numsensors = APS_NUM_SENSORS;
+
+	sc->sensors[APS_SENSOR_XACCEL].type = SENSOR_INTEGER;
+	snprintf(sc->sensors[APS_SENSOR_XACCEL].desc,
+	    sizeof(sc->sensors[APS_SENSOR_XACCEL].desc), "X_ACCEL");
+	sc->sensors[APS_SENSOR_XACCEL].rfact = 1;
+
+	sc->sensors[APS_SENSOR_YACCEL].type = SENSOR_INTEGER;
+	snprintf(sc->sensors[APS_SENSOR_YACCEL].desc,
+	    sizeof(sc->sensors[APS_SENSOR_YACCEL].desc), "Y_ACCEL");
+	sc->sensors[APS_SENSOR_YACCEL].rfact = 1;
+
+	sc->sensors[APS_SENSOR_TEMP1].type = SENSOR_TEMP;
+	snprintf(sc->sensors[APS_SENSOR_TEMP1].desc,
+	    sizeof(sc->sensors[APS_SENSOR_TEMP1].desc), "Temp1");
+
+	sc->sensors[APS_SENSOR_TEMP2].type = SENSOR_TEMP;
+	snprintf(sc->sensors[APS_SENSOR_TEMP2].desc,
+	    sizeof(sc->sensors[APS_SENSOR_TEMP2].desc), "Temp2");
+
+	sc->sensors[APS_SENSOR_XVAR].type = SENSOR_INTEGER;
+	snprintf(sc->sensors[APS_SENSOR_XVAR].desc,
+	    sizeof(sc->sensors[APS_SENSOR_XVAR].desc), "X_VAR");
+	sc->sensors[APS_SENSOR_XVAR].rfact = 1;
+
+	sc->sensors[APS_SENSOR_YVAR].type = SENSOR_INTEGER;
+	snprintf(sc->sensors[APS_SENSOR_YVAR].desc,
+	    sizeof(sc->sensors[APS_SENSOR_YVAR].desc), "Y_VAR");
+	sc->sensors[APS_SENSOR_YVAR].rfact = 1;
+
+	sc->sensors[APS_SENSOR_UNK].type = SENSOR_INTEGER;
+	snprintf(sc->sensors[APS_SENSOR_UNK].desc,
+	    sizeof(sc->sensors[APS_SENSOR_UNK].desc), "unknown");
+	sc->sensors[APS_SENSOR_YVAR].rfact = 1;
+
+	sc->sensors[APS_SENSOR_KBACT].type = SENSOR_INTEGER;
+	snprintf(sc->sensors[APS_SENSOR_KBACT].desc,
+	    sizeof(sc->sensors[APS_SENSOR_KBACT].desc), "KBD_ACT");
+	sc->sensors[APS_SENSOR_KBACT].rfact = 1;
+
+	sc->sensors[APS_SENSOR_MSACT].type = SENSOR_INTEGER;
+	snprintf(sc->sensors[APS_SENSOR_MSACT].desc,
+	    sizeof(sc->sensors[APS_SENSOR_MSACT].desc), "MS_ACT");
+	sc->sensors[APS_SENSOR_MSACT].rfact = 1;
+
+	sc->sensors[APS_SENSOR_LIDOPEN].type = SENSOR_INTEGER;
+	snprintf(sc->sensors[APS_SENSOR_LIDOPEN].desc,
+	    sizeof(sc->sensors[APS_SENSOR_LIDOPEN].desc), "LID_OPEN");
+	sc->sensors[APS_SENSOR_LIDOPEN].rfact = 1;
+
+	/* stop hiding and report to the authorities */
+	for (i = 0; i < sc->numsensors; i++) {
+		strlcpy(sc->sensors[i].device, sc->sc_dev.dv_xname,
+		    sizeof(sc->sensors[i].device));
+		SENSOR_ADD(&sc->sensors[i]);
+	}
+
+	/* Refresh sensor data every 0.5 seconds */
+	timeout_set(&aps_timeout, aps_refresh, sc);
+	timeout_add(&aps_timeout, (5 * hz) / 10);
+	return;
+out:
+	printf("%s: failed to initialise\n", sc->sc_dev.dv_xname);
+	return;
+}
+
+u_int8_t
+aps_mem_read_1(bus_space_tag_t iot, bus_space_handle_t ioh, int reg,
+    u_int8_t val)
+{
+	int i;
+	u_int8_t cr;
+	/* should take no longer than 50 microseconds */
+	for (i = 0; i < 10; i++) {
+		cr = bus_space_read_1(iot, ioh, reg);
+		if (cr == val)
+			return (1);
+		delay(5 * 1000);
+	}
+	DPRINTF(("aps: reg 0x%x not val 0x%x!\n", reg, val));
+	return (0);
+}
+
+int
+aps_read_data(struct aps_softc *sc)
+{
+	bus_space_tag_t iot = sc->aps_iot;
+	bus_space_handle_t ioh = sc->aps_ioh;
+
+	sc->aps_data.state = bus_space_read_1(iot, ioh, APS_STATE);
+	sc->aps_data.x_accel = bus_space_read_2(iot, ioh, APS_XACCEL);
+	sc->aps_data.y_accel = bus_space_read_2(iot, ioh, APS_YACCEL);
+	sc->aps_data.temp1 = bus_space_read_1(iot, ioh, APS_TEMP);
+	sc->aps_data.x_var = bus_space_read_2(iot, ioh, APS_XVAR);
+	sc->aps_data.y_var = bus_space_read_2(iot, ioh, APS_YVAR);
+	sc->aps_data.temp2 = bus_space_read_1(iot, ioh, APS_TEMP2);
+	sc->aps_data.unk = bus_space_read_1(iot, ioh, APS_UNKNOWN);
+	sc->aps_data.input = bus_space_read_1(iot, ioh, APS_INPUT);
+
+	return (1);
+}
+
+void
+aps_refresh_sensor_data(struct aps_softc *sc)
+{
+	bus_space_tag_t iot = sc->aps_iot;
+	bus_space_handle_t ioh = sc->aps_ioh;
+	int64_t temp;
+	int i;
+
+	/* ask for new data */
+	bus_space_write_1(iot, ioh, APS_INIT, 0x11);
+	bus_space_write_1(iot, ioh, APS_CMD, 0x01);
+	if (!aps_mem_read_1(iot, ioh, APS_ACCEL_STATE, 0x50))
+		return;
+	aps_read_data(sc);
+	bus_space_write_1(iot, ioh, APS_INIT, 0x11);
+	bus_space_write_1(iot, ioh, APS_CMD, 0x01);
+
+	/* tell accelerometer we're done reading from it */
+	bus_space_read_1(iot, ioh, APS_CMD);
+	bus_space_read_1(iot, ioh, APS_ACCEL_STATE);
+
+	for (i = 0; i < APS_NUM_SENSORS; i++) {
+		sc->sensors[i].flags &= ~SENSOR_FINVALID;
+	}
+
+	sc->sensors[APS_SENSOR_XACCEL].value = sc->aps_data.x_accel;
+	sc->sensors[APS_SENSOR_YACCEL].value = sc->aps_data.y_accel;
+
+	/* convert to micro (mu) degrees */
+	temp = sc->aps_data.temp1 * 1000000;	
+	/* convert to kelvin */
+	temp += 273150000; 
+	sc->sensors[APS_SENSOR_TEMP1].value = temp;
+
+	/* convert to micro (mu) degrees */
+	temp = sc->aps_data.temp2 * 1000000;	
+	/* convert to kelvin */
+	temp += 273150000; 
+	sc->sensors[APS_SENSOR_TEMP2].value = temp;
+
+	sc->sensors[APS_SENSOR_XVAR].value = sc->aps_data.x_var;
+	sc->sensors[APS_SENSOR_YVAR].value = sc->aps_data.y_var;
+	sc->sensors[APS_SENSOR_UNK].value = sc->aps_data.unk;
+	sc->sensors[APS_SENSOR_KBACT].value =
+	    (sc->aps_data.input &  APS_INPUT_KB) ? 1 : 0;
+	sc->sensors[APS_SENSOR_MSACT].value =
+	    (sc->aps_data.input & APS_INPUT_MS) ? 1 : 0;
+	sc->sensors[APS_SENSOR_LIDOPEN].value =
+	    (sc->aps_data.input & APS_INPUT_LIDOPEN) ? 1 : 0;
+}
+
+void
+aps_refresh(void *arg)
+{
+	struct aps_softc *sc = (struct aps_softc *)arg;
+
+	aps_refresh_sensor_data(sc);
+	timeout_add(&aps_timeout, (5 * hz) / 10);
+}