Module Name: src Committed By: macallan Date: Fri Jan 10 06:24:17 UTC 2020
Modified Files: src/sys/arch/macppc/conf: files.macppc Added Files: src/sys/arch/macppc/dev: lmu.c Log Message: add driver for the ambient light sensor / keyboard light controller found in PowerBook5,6 and probably others To generate a diff of this commit: cvs rdiff -u -r1.113 -r1.114 src/sys/arch/macppc/conf/files.macppc cvs rdiff -u -r0 -r1.1 src/sys/arch/macppc/dev/lmu.c Please note that diffs are not public domain; they are subject to the copyright notices on the relevant files.
Modified files: Index: src/sys/arch/macppc/conf/files.macppc diff -u src/sys/arch/macppc/conf/files.macppc:1.113 src/sys/arch/macppc/conf/files.macppc:1.114 --- src/sys/arch/macppc/conf/files.macppc:1.113 Thu Jan 9 18:49:06 2020 +++ src/sys/arch/macppc/conf/files.macppc Fri Jan 10 06:24:17 2020 @@ -1,4 +1,4 @@ -# $NetBSD: files.macppc,v 1.113 2020/01/09 18:49:06 macallan Exp $ +# $NetBSD: files.macppc,v 1.114 2020/01/10 06:24:17 macallan Exp $ # # macppc-specific configuration info @@ -319,3 +319,7 @@ device psoc: sysmon_envsys attach psoc at iic file arch/macppc/dev/psoc.c psoc +# 'lmu-micro' found in late PowerBooks +device lmu: sysmon_envsys +attach lmu at iic +file arch/macppc/dev/lmu.c lmu Added files: Index: src/sys/arch/macppc/dev/lmu.c diff -u /dev/null src/sys/arch/macppc/dev/lmu.c:1.1 --- /dev/null Fri Jan 10 06:24:17 2020 +++ src/sys/arch/macppc/dev/lmu.c Fri Jan 10 06:24:17 2020 @@ -0,0 +1,199 @@ + /* $NetBSD: lmu.c,v 1.1 2020/01/10 06:24:17 macallan Exp $ */ + +/*- + * Copyright (c) 2020 Michael Lorenz + * 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. + */ + +/* + * ambient light controller found in PowerBook5,6 + */ + +#include <sys/cdefs.h> +__KERNEL_RCSID(0, "$NetBSD: lmu.c,v 1.1 2020/01/10 06:24:17 macallan Exp $"); + +#include <sys/param.h> +#include <sys/systm.h> +#include <sys/device.h> +#include <sys/conf.h> +#include <sys/bus.h> +#include <sys/time.h> +#include <sys/callout.h> + +#include <dev/ofw/openfirm.h> + +#include <dev/i2c/i2cvar.h> + +#include <dev/sysmon/sysmonvar.h> + +struct lmu_softc { + device_t sc_dev; + i2c_tag_t sc_i2c; + i2c_addr_t sc_addr; + int sc_node; + + struct sysmon_envsys *sc_sme; + envsys_data_t sc_sensors[2]; + callout_t sc_adjust; + int sc_thresh, sc_hyst; +}; + +static int lmu_match(device_t, cfdata_t, void *); +static void lmu_attach(device_t, device_t, void *); + +static void lmu_sensors_refresh(struct sysmon_envsys *, envsys_data_t *); +static void lmu_set_brightness(struct lmu_softc *, int); +static int lmu_get_brightness(struct lmu_softc *, int); +static void lmu_adjust(void *); + +CFATTACH_DECL_NEW(lmu, sizeof(struct lmu_softc), + lmu_match, lmu_attach, NULL, NULL); + +static const struct device_compatible_entry compat_data[] = { + { "lmu-micro", 0 }, + { "lmu-controller", 0 }, + { NULL, 0 } +}; + +static int +lmu_match(device_t parent, cfdata_t match, void *aux) +{ + struct i2c_attach_args *ia = aux; + int match_result; + + if (iic_use_direct_match(ia, match, compat_data, &match_result)) + return match_result; + + return 0; +} + +static void +lmu_attach(device_t parent, device_t self, void *aux) +{ + struct lmu_softc *sc = device_private(self); + struct i2c_attach_args *ia = aux; + envsys_data_t *s; + + sc->sc_dev = self; + sc->sc_i2c = ia->ia_tag; + sc->sc_addr = ia->ia_addr; + sc->sc_node = ia->ia_cookie; + + aprint_naive("\n"); + aprint_normal(": ambient light sensor\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 = lmu_sensors_refresh; + + s = &sc->sc_sensors[0]; + s->state = ENVSYS_SINVALID; + s->units = ENVSYS_LUX; + strcpy(s->desc, "right"); + s->private = 0; + sysmon_envsys_sensor_attach(sc->sc_sme, s); + + s = &sc->sc_sensors[1]; + s->state = ENVSYS_SINVALID; + s->units = ENVSYS_LUX; + strcpy(s->desc, "left"); + s->private = 2; + sysmon_envsys_sensor_attach(sc->sc_sme, s); + + sysmon_envsys_register(sc->sc_sme); + + /* TODO: make this adjustable via sysctl */ + sc->sc_thresh = 300; + sc->sc_hyst = 30; + + callout_init(&sc->sc_adjust, 0); + callout_setfunc(&sc->sc_adjust, lmu_adjust, sc); + callout_schedule(&sc->sc_adjust, 0); +} + +static void +lmu_sensors_refresh(struct sysmon_envsys *sme, envsys_data_t *edata) +{ + struct lmu_softc *sc = sme->sme_cookie; + int ret; + + if ( edata->private < 3) { + ret = lmu_get_brightness(sc, edata->private); + if (ret == -1) return; + edata->value_cur = ret; + } + edata->state = ENVSYS_SVALID; +} + +static int +lmu_get_brightness(struct lmu_softc *sc, int reg) +{ + int error; + uint16_t buf; + uint8_t cmd = reg; + + iic_acquire_bus(sc->sc_i2c, 0); + error = iic_exec(sc->sc_i2c, I2C_OP_READ_WITH_STOP, + sc->sc_addr, &cmd, 1, &buf, 2, 0); + iic_release_bus(sc->sc_i2c, 0); + if (error) return -1; + return be16toh(buf); +} + +static void +lmu_set_brightness(struct lmu_softc *sc, int b) +{ + int bb; + uint8_t cmd[3]; + + cmd[0] = 1; + bb = b * 255; + cmd[1] = (bb & 0xff00) >> 8; + cmd[2] = bb & 0xff; + + iic_acquire_bus(sc->sc_i2c, 0); + iic_exec(sc->sc_i2c, I2C_OP_READ_WITH_STOP, + sc->sc_addr, &cmd, 3, NULL, 0, 0); + iic_release_bus(sc->sc_i2c, 0); +} + +static void +lmu_adjust(void *cookie) +{ + struct lmu_softc *sc = cookie; + int left, right, b; + + left = lmu_get_brightness(sc, 2); + right = lmu_get_brightness(sc, 0); + b = left > right ? left : right; + + if (b > (sc->sc_thresh + sc->sc_hyst)) { + lmu_set_brightness(sc, 0); + } else if (b < sc->sc_thresh) { + lmu_set_brightness(sc, 100); + } + + callout_schedule(&sc->sc_adjust, hz * 2); +}