LibertyBSD_kernel/dev/i2c/thmc50.c

/*	$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);
}