Source-Changes-HG archive
[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index][Old Index]
[src/trunk]: src/sys/arch/macppc add driver for the ambient light sensor / ke...
details: https://anonhg.NetBSD.org/src/rev/5166c3f99b49
branches: trunk
changeset: 467026:5166c3f99b49
user: macallan <macallan%NetBSD.org@localhost>
date: Fri Jan 10 06:24:17 2020 +0000
description:
add driver for the ambient light sensor / keyboard light controller found in
PowerBook5,6 and probably others
diffstat:
sys/arch/macppc/conf/files.macppc | 6 +-
sys/arch/macppc/dev/lmu.c | 199 ++++++++++++++++++++++++++++++++++++++
2 files changed, 204 insertions(+), 1 deletions(-)
diffs (220 lines):
diff -r bf1a24e6052a -r 5166c3f99b49 sys/arch/macppc/conf/files.macppc
--- a/sys/arch/macppc/conf/files.macppc Thu Jan 09 20:07:46 2020 +0000
+++ b/sys/arch/macppc/conf/files.macppc Fri Jan 10 06:24:17 2020 +0000
@@ -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 @@
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
diff -r bf1a24e6052a -r 5166c3f99b49 sys/arch/macppc/dev/lmu.c
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/sys/arch/macppc/dev/lmu.c Fri Jan 10 06:24:17 2020 +0000
@@ -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);
+}
Home |
Main Index |
Thread Index |
Old Index