From: kettenis Date: Thu, 30 Nov 2017 14:53:21 +0000 (+0000) Subject: Add bgw(4), a driver for a family of Bosch acceleration sensors. X-Git-Url: http://artulab.com/gitweb/?a=commitdiff_plain;h=36e9a67f9c1c15208d3a4d5e1bb32e03c3b62e1f;p=openbsd Add bgw(4), a driver for a family of Bosch acceleration sensors. ok deraadt@, mlarkin@ --- diff --git a/sys/dev/i2c/bmc150.c b/sys/dev/i2c/bmc150.c new file mode 100644 index 00000000000..732691594e6 --- /dev/null +++ b/sys/dev/i2c/bmc150.c @@ -0,0 +1,194 @@ +/* $OpenBSD: bmc150.c,v 1.1 2017/11/30 14:53:21 kettenis Exp $ */ + +/* + * Copyright (c) 2017 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 +#include +#include +#include + +#include + +#define BGW_CHIPID 0x00 +#define BGW_CHIPID_BMA222E 0xf8 +#define BGW_CHIPID_BMA250E 0xf9 +#define BGW_CHIPID_BMC150 0xfa +#define BGW_CHIPID_BMI055 0xfa +#define BGW_CHIPID_BMA255 0xfa +#define BGW_CHIPID_BMA280 0xfb +#define ACCD_X_LSB 0x02 +#define ACCD_X_MSB 0x03 +#define ACCD_Y_LSB 0x04 +#define ACCD_Y_MSB 0x05 +#define ACCD_Z_LSB 0x06 +#define ACCD_Z_MSB 0x07 +#define ACCD_TEMP 0x08 + +#define BGW_NUM_SENSORS 4 + +#define BGW_SENSOR_XACCEL 0 +#define BGW_SENSOR_YACCEL 1 +#define BGW_SENSOR_ZACCEL 2 +#define BGW_SENSOR_TEMP 3 + +struct bgw_softc { + struct device sc_dev; + i2c_tag_t sc_tag; + i2c_addr_t sc_addr; + + uint8_t sc_temp0; + + struct ksensor sc_sensor[BGW_NUM_SENSORS]; + struct ksensordev sc_sensordev; +}; + +int bgw_match(struct device *, void *, void *); +void bgw_attach(struct device *, struct device *, void *); + +struct cfattach bgw_ca = { + sizeof(struct bgw_softc), bgw_match, bgw_attach +}; + +struct cfdriver bgw_cd = { + NULL, "bgw", DV_DULL +}; + +void bgw_refresh(void *); + +int +bgw_match(struct device *parent, void *match, void *aux) +{ + struct i2c_attach_args *ia = aux; + + if (strcmp(ia->ia_name, "BSBA0150") == 0 || + strcmp(ia->ia_name, "BMC150A") == 0 || + strcmp(ia->ia_name, "BMI055A") == 0 || + strcmp(ia->ia_name, "BMA0255") == 0 || + strcmp(ia->ia_name, "BMA250E") == 0 || + strcmp(ia->ia_name, "BMA222E") == 0 || + strcmp(ia->ia_name, "BMA0280") == 0 || + strcmp(ia->ia_name, "BOSC0200") == 0) + return 1; + return 0; +} + +void +bgw_attach(struct device *parent, struct device *self, void *aux) +{ + struct bgw_softc *sc = (struct bgw_softc *)self; + struct i2c_attach_args *ia = aux; + uint8_t cmd, data; + int i; + + sc->sc_tag = ia->ia_tag; + sc->sc_addr = ia->ia_addr; + + iic_acquire_bus(sc->sc_tag, 0); + cmd = BGW_CHIPID; + if (iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP, + sc->sc_addr, &cmd, sizeof cmd, &data, sizeof data, 0)) { + iic_release_bus(sc->sc_tag, 0); + printf(": can't read chip ID\n"); + return; + } + iic_release_bus(sc->sc_tag, 0); + + switch (data) { + case BGW_CHIPID_BMA222E: + sc->sc_temp0 = 23; + printf(": BMA222E"); + break; + case BGW_CHIPID_BMA250E: + sc->sc_temp0 = 23; + printf(": BMA250E"); + break; + case BGW_CHIPID_BMC150: + sc->sc_temp0 = 24; + printf(": BMC150"); + break; + case BGW_CHIPID_BMA280: + sc->sc_temp0 = 23; + printf(": BMA280"); + break; + } + + sc->sc_sensor[BGW_SENSOR_XACCEL].type = SENSOR_INTEGER; + strlcpy(sc->sc_sensor[BGW_SENSOR_XACCEL].desc, "X_ACCEL", + sizeof(sc->sc_sensor[BGW_SENSOR_XACCEL].desc)); + sc->sc_sensor[BGW_SENSOR_YACCEL].type = SENSOR_INTEGER; + strlcpy(sc->sc_sensor[BGW_SENSOR_YACCEL].desc, "Y_ACCEL", + sizeof(sc->sc_sensor[BGW_SENSOR_YACCEL].desc)); + sc->sc_sensor[BGW_SENSOR_ZACCEL].type = SENSOR_INTEGER; + strlcpy(sc->sc_sensor[BGW_SENSOR_ZACCEL].desc, "Z_ACCEL", + sizeof(sc->sc_sensor[BGW_SENSOR_ZACCEL].desc)); + sc->sc_sensor[BGW_SENSOR_TEMP].type = SENSOR_TEMP; + + strlcpy(sc->sc_sensordev.xname, sc->sc_dev.dv_xname, + sizeof(sc->sc_sensordev.xname)); + for (i = 0; i < BGW_NUM_SENSORS; i++) + sensor_attach(&sc->sc_sensordev, &sc->sc_sensor[i]); + sensordev_install(&sc->sc_sensordev); + + if (sensor_task_register(sc, bgw_refresh, 5) == NULL) { + printf(", unable to register update task\n"); + return; + } + + printf("\n"); +} + +void +bgw_refresh(void *arg) +{ + struct bgw_softc *sc = arg; + uint8_t cmd, data[7]; + uint8_t lsb; + int8_t msb; + int8_t temp; + int i; + + iic_acquire_bus(sc->sc_tag, 0); + cmd = ACCD_X_LSB; + if (iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP, + sc->sc_addr, &cmd, sizeof cmd, &data, sizeof data, 0)) { + iic_release_bus(sc->sc_tag, 0); + for (i = 0; i < BGW_NUM_SENSORS; i++) + sc->sc_sensor[i].flags |= SENSOR_FINVALID; + return; + } + iic_release_bus(sc->sc_tag, 0); + + lsb = data[ACCD_X_LSB - ACCD_X_LSB]; + msb = data[ACCD_X_MSB - ACCD_X_LSB]; + sc->sc_sensor[BGW_SENSOR_XACCEL].value = (msb << 4) | (lsb >> 4); + sc->sc_sensor[BGW_SENSOR_XACCEL].flags &= ~SENSOR_FINVALID; + + lsb = data[ACCD_Y_LSB - ACCD_X_LSB]; + msb = data[ACCD_Y_MSB - ACCD_X_LSB]; + sc->sc_sensor[BGW_SENSOR_YACCEL].value = (msb << 4) | (lsb >> 4); + sc->sc_sensor[BGW_SENSOR_YACCEL].flags &= ~SENSOR_FINVALID; + + lsb = data[ACCD_Z_LSB - ACCD_X_LSB]; + msb = data[ACCD_Z_MSB - ACCD_X_LSB]; + sc->sc_sensor[BGW_SENSOR_ZACCEL].value = (msb << 4) | (lsb >> 4); + sc->sc_sensor[BGW_SENSOR_ZACCEL].flags &= ~SENSOR_FINVALID; + + temp = data[ACCD_TEMP - ACCD_X_LSB]; + sc->sc_sensor[BGW_SENSOR_TEMP].value = + 273150000 + (sc->sc_temp0 + temp) * 1000000; + sc->sc_sensor[BGW_SENSOR_TEMP].flags &= ~SENSOR_FINVALID; +} diff --git a/sys/dev/i2c/files.i2c b/sys/dev/i2c/files.i2c index 5e0a6ebdbc2..1e6708a2f55 100644 --- a/sys/dev/i2c/files.i2c +++ b/sys/dev/i2c/files.i2c @@ -1,4 +1,4 @@ -# $OpenBSD: files.i2c,v 1.58 2017/07/24 20:25:29 kettenis Exp $ +# $OpenBSD: files.i2c,v 1.59 2017/11/30 14:53:21 kettenis Exp $ # $NetBSD: files.i2c,v 1.3 2003/10/20 16:24:10 briggs Exp $ define i2c {[addr = -1], [size = -1]} @@ -214,3 +214,8 @@ file dev/i2c/imt.c imt device iatp: wsmousedev attach iatp at i2c file dev/i2c/iatp.c iatp + +# Bosch BMC150 6-axis eCompass +device bgw +attach bgw at i2c +file dev/i2c/bmc150.c bgw