133 lines
3.9 KiB
C
133 lines
3.9 KiB
C
|
/* $NetBSD: axp22x.c,v 1.1 2014/10/12 23:58:42 jmcneill Exp $ */
|
||
|
|
||
|
/*-
|
||
|
* Copyright (c) 2014 Jared D. McNeill <jmcneill@invisible.ca>
|
||
|
* All rights reserved.
|
||
|
*
|
||
|
* Redistribution and use in source and binary forms, with or without
|
||
|
* modification, are permitted provided that the following conditions
|
||
|
* are met:
|
||
|
* 1. Redistributions of source code must retain the above copyright
|
||
|
* notice, this list of conditions and the following disclaimer.
|
||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||
|
* notice, this list of conditions and the following disclaimer in the
|
||
|
* documentation and/or other materials provided with the distribution.
|
||
|
*
|
||
|
* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
|
||
|
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
|
||
|
* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
|
||
|
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
|
||
|
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
||
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
||
|
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
||
|
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
||
|
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||
|
* POSSIBILITY OF SUCH DAMAGE.
|
||
|
*/
|
||
|
|
||
|
#include <sys/cdefs.h>
|
||
|
__KERNEL_RCSID(0, "$NetBSD: axp22x.c,v 1.1 2014/10/12 23:58:42 jmcneill Exp $");
|
||
|
|
||
|
#include <sys/param.h>
|
||
|
#include <sys/systm.h>
|
||
|
#include <sys/device.h>
|
||
|
#include <sys/conf.h>
|
||
|
#include <sys/bus.h>
|
||
|
#include <sys/kmem.h>
|
||
|
|
||
|
#include <dev/i2c/i2cvar.h>
|
||
|
|
||
|
#include <dev/sysmon/sysmonvar.h>
|
||
|
|
||
|
#define AXP_TEMP_MON_REG 0x56 /* 2 bytes */
|
||
|
|
||
|
struct axp22x_softc {
|
||
|
device_t sc_dev;
|
||
|
i2c_tag_t sc_i2c;
|
||
|
i2c_addr_t sc_addr;
|
||
|
|
||
|
struct sysmon_envsys *sc_sme;
|
||
|
envsys_data_t sc_sensor_temp;
|
||
|
};
|
||
|
|
||
|
static int axp22x_match(device_t, cfdata_t, void *);
|
||
|
static void axp22x_attach(device_t, device_t, void *);
|
||
|
|
||
|
static void axp22x_sensors_refresh(struct sysmon_envsys *, envsys_data_t *);
|
||
|
static int axp22x_read(struct axp22x_softc *, uint8_t, uint8_t *, size_t);
|
||
|
|
||
|
CFATTACH_DECL_NEW(axp22x, sizeof(struct axp22x_softc),
|
||
|
axp22x_match, axp22x_attach, NULL, NULL);
|
||
|
|
||
|
static int
|
||
|
axp22x_match(device_t parent, cfdata_t match, void *aux)
|
||
|
{
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
axp22x_attach(device_t parent, device_t self, void *aux)
|
||
|
{
|
||
|
struct axp22x_softc *sc = device_private(self);
|
||
|
struct i2c_attach_args *ia = aux;
|
||
|
|
||
|
sc->sc_dev = self;
|
||
|
sc->sc_i2c = ia->ia_tag;
|
||
|
sc->sc_addr = ia->ia_addr;
|
||
|
|
||
|
aprint_naive("\n");
|
||
|
aprint_normal("\n");
|
||
|
|
||
|
sc->sc_sme = sysmon_envsys_create();
|
||
|
sc->sc_sme->sme_name = device_xname(self);
|
||
|
sc->sc_sme->sme_cookie = sc;
|
||
|
sc->sc_sme->sme_refresh = axp22x_sensors_refresh;
|
||
|
|
||
|
sc->sc_sensor_temp.units = ENVSYS_STEMP;
|
||
|
sc->sc_sensor_temp.state = ENVSYS_SINVALID;
|
||
|
sc->sc_sensor_temp.flags = ENVSYS_FHAS_ENTROPY;
|
||
|
snprintf(sc->sc_sensor_temp.desc, sizeof(sc->sc_sensor_temp.desc),
|
||
|
"internal temperature");
|
||
|
sysmon_envsys_sensor_attach(sc->sc_sme, &sc->sc_sensor_temp);
|
||
|
|
||
|
sysmon_envsys_register(sc->sc_sme);
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
axp22x_sensors_refresh(struct sysmon_envsys *sme, envsys_data_t *edata)
|
||
|
{
|
||
|
struct axp22x_softc *sc = sme->sme_cookie;
|
||
|
uint8_t buf[2];
|
||
|
int error;
|
||
|
|
||
|
iic_acquire_bus(sc->sc_i2c, 0);
|
||
|
error = axp22x_read(sc, AXP_TEMP_MON_REG, buf, sizeof(buf));
|
||
|
iic_release_bus(sc->sc_i2c, 0);
|
||
|
|
||
|
if (error) {
|
||
|
edata->state = ENVSYS_SINVALID;
|
||
|
} else {
|
||
|
/* between -267.7C and 165.8C, step +0.1C */
|
||
|
edata->value_cur = (((buf[0] << 4) | (buf[1] & 0xf)) - 2677)
|
||
|
* 100000 + 273150000;
|
||
|
edata->state = ENVSYS_SVALID;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
axp22x_read(struct axp22x_softc *sc, uint8_t reg, uint8_t *val, size_t len)
|
||
|
{
|
||
|
size_t i;
|
||
|
int error;
|
||
|
|
||
|
for (i = 0; i < len; i++) {
|
||
|
error = iic_smbus_read_byte(sc->sc_i2c, sc->sc_addr,
|
||
|
reg + i, &val[i], 0);
|
||
|
if (error)
|
||
|
return error;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|