On Thu, Nov 30, 2017 at 02:29:58AM +0100, Mark Kettenis wrote:
> Driver name is bgw(4). Found on a Lenovo 2-in-1 laptop.
>
> ok?
>
Man page? Otherwise ok mlarkin.
-ml
> Index: dev/i2c/bmc150.c
> ===================================================================
> RCS file: dev/i2c/bmc150.c
> diff -N dev/i2c/bmc150.c
> --- /dev/null 1 Jan 1970 00:00:00 -0000
> +++ dev/i2c/bmc150.c 30 Nov 2017 01:21:36 -0000
> @@ -0,0 +1,193 @@
> +/* $OpenBSD$ */
> +
> +/*
> + * 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 <sys/param.h>
> +#include <sys/systm.h>
> +#include <sys/device.h>
> +#include <sys/sensors.h>
> +
> +#include <dev/i2c/i2cvar.h>
> +
> +#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, 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 << 8) | lsb;
> + 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 << 8) | lsb;
> + 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 << 8) | lsb;
> + 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;
> +}
> Index: dev/i2c/files.i2c
> ===================================================================
> RCS file: /cvs/src/sys/dev/i2c/files.i2c,v
> retrieving revision 1.58
> diff -u -p -r1.58 files.i2c
> --- dev/i2c/files.i2c 24 Jul 2017 20:25:29 -0000 1.58
> +++ dev/i2c/files.i2c 30 Nov 2017 00:57:46 -0000
> @@ -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
>
