Home | History | Annotate | Line # | Download | only in dev
      1  1.11   thorpej /* $NetBSD: lmu.c,v 1.11 2025/09/17 14:15:16 thorpej Exp $ */
      2   1.1  macallan 
      3   1.1  macallan /*-
      4   1.1  macallan  * Copyright (c) 2020 Michael Lorenz
      5   1.1  macallan  * All rights reserved.
      6   1.1  macallan  *
      7   1.1  macallan  * Redistribution and use in source and binary forms, with or without
      8   1.1  macallan  * modification, are permitted provided that the following conditions
      9   1.1  macallan  * are met:
     10   1.1  macallan  * 1. Redistributions of source code must retain the above copyright
     11   1.1  macallan  *    notice, this list of conditions and the following disclaimer.
     12   1.1  macallan  * 2. Redistributions in binary form must reproduce the above copyright
     13   1.1  macallan  *    notice, this list of conditions and the following disclaimer in the
     14   1.1  macallan  *    documentation and/or other materials provided with the distribution.
     15   1.1  macallan  *
     16   1.1  macallan  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     17   1.1  macallan  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     18   1.1  macallan  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     19   1.1  macallan  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     20   1.1  macallan  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     21   1.1  macallan  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     22   1.1  macallan  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     23   1.1  macallan  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     24   1.1  macallan  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     25   1.1  macallan  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     26   1.1  macallan  * POSSIBILITY OF SUCH DAMAGE.
     27   1.1  macallan  */
     28   1.1  macallan 
     29   1.1  macallan /*
     30   1.1  macallan  * ambient light controller found in PowerBook5,6
     31   1.1  macallan  */
     32   1.1  macallan 
     33   1.1  macallan #include <sys/cdefs.h>
     34  1.11   thorpej __KERNEL_RCSID(0, "$NetBSD: lmu.c,v 1.11 2025/09/17 14:15:16 thorpej Exp $");
     35   1.1  macallan 
     36   1.1  macallan #include <sys/param.h>
     37   1.1  macallan #include <sys/systm.h>
     38   1.1  macallan #include <sys/device.h>
     39   1.1  macallan #include <sys/conf.h>
     40   1.1  macallan #include <sys/bus.h>
     41   1.1  macallan #include <sys/time.h>
     42  1.10  macallan #include <sys/kthread.h>
     43   1.4  macallan #include <sys/sysctl.h>
     44   1.1  macallan 
     45   1.1  macallan #include <dev/i2c/i2cvar.h>
     46   1.1  macallan 
     47   1.1  macallan #include <dev/sysmon/sysmonvar.h>
     48   1.9  macallan #include "opt_lmu.h"
     49   1.1  macallan 
     50   1.4  macallan #ifdef LMU_DEBUG
     51   1.4  macallan #define DPRINTF printf
     52   1.4  macallan #else
     53   1.4  macallan #define DPRINTF if (0) printf
     54   1.4  macallan #endif
     55   1.4  macallan 
     56   1.1  macallan struct lmu_softc {
     57   1.1  macallan 	device_t	sc_dev;
     58   1.1  macallan 	i2c_tag_t	sc_i2c;
     59   1.1  macallan 	i2c_addr_t	sc_addr;
     60   1.1  macallan 
     61   1.1  macallan 	struct sysmon_envsys *sc_sme;
     62   1.1  macallan 	envsys_data_t	sc_sensors[2];
     63  1.10  macallan 	lwp_t		*sc_adjust;
     64  1.10  macallan 	kcondvar_t	sc_event;
     65  1.10  macallan 	kmutex_t	sc_evmtx;
     66   1.4  macallan 	int		sc_thresh, sc_hyst, sc_level, sc_target, sc_current;
     67   1.4  macallan 	int		sc_lux[2];
     68   1.4  macallan 	time_t		sc_last;
     69   1.2  macallan 	int		sc_lid_state, sc_video_state;
     70   1.1  macallan };
     71   1.1  macallan 
     72   1.1  macallan static int	lmu_match(device_t, cfdata_t, void *);
     73   1.1  macallan static void	lmu_attach(device_t, device_t, void *);
     74   1.1  macallan 
     75   1.1  macallan static void	lmu_sensors_refresh(struct sysmon_envsys *, envsys_data_t *);
     76   1.1  macallan static void	lmu_set_brightness(struct lmu_softc *, int);
     77   1.1  macallan static int	lmu_get_brightness(struct lmu_softc *, int);
     78   1.1  macallan static void	lmu_adjust(void *);
     79   1.4  macallan static int 	lmu_sysctl(SYSCTLFN_ARGS);
     80   1.4  macallan static int 	lmu_sysctl_thresh(SYSCTLFN_ARGS);
     81   1.1  macallan 
     82   1.1  macallan CFATTACH_DECL_NEW(lmu, sizeof(struct lmu_softc),
     83   1.1  macallan     lmu_match, lmu_attach, NULL, NULL);
     84   1.1  macallan 
     85   1.1  macallan static const struct device_compatible_entry compat_data[] = {
     86   1.6   thorpej 	{ .compat = "lmu-micro" },
     87   1.6   thorpej 	{ .compat = "lmu-controller" },
     88   1.8   thorpej 	DEVICE_COMPAT_EOL
     89   1.1  macallan };
     90   1.1  macallan 
     91   1.4  macallan /* time between polling the light sensors */
     92  1.10  macallan #define LMU_POLL	(hz)
     93   1.4  macallan /* time between updates to keyboard brightness */
     94   1.4  macallan #define LMU_FADE	(hz / 16)
     95   1.4  macallan 
     96   1.2  macallan static void
     97   1.2  macallan lmu_lid_open(device_t dev)
     98   1.2  macallan {
     99   1.2  macallan 	struct lmu_softc * const sc = device_private(dev);
    100   1.2  macallan 
    101   1.2  macallan 	sc->sc_lid_state = true;
    102   1.2  macallan }
    103   1.2  macallan 
    104   1.2  macallan static void
    105   1.2  macallan lmu_lid_close(device_t dev)
    106   1.2  macallan {
    107   1.2  macallan 	struct lmu_softc * const sc = device_private(dev);
    108   1.2  macallan 
    109   1.2  macallan 	sc->sc_lid_state = false;
    110   1.2  macallan }
    111   1.2  macallan 
    112   1.2  macallan static void
    113   1.2  macallan lmu_video_on(device_t dev)
    114   1.2  macallan {
    115   1.2  macallan 	struct lmu_softc * const sc = device_private(dev);
    116   1.2  macallan 
    117   1.2  macallan 	sc->sc_video_state = true;
    118   1.2  macallan }
    119   1.2  macallan 
    120   1.2  macallan static void
    121   1.2  macallan lmu_video_off(device_t dev)
    122   1.2  macallan {
    123   1.2  macallan 	struct lmu_softc * const sc = device_private(dev);
    124   1.2  macallan 
    125   1.2  macallan 	sc->sc_video_state = false;
    126   1.2  macallan }
    127   1.2  macallan 
    128   1.5  macallan static void
    129   1.5  macallan lmu_kbd_brightness_up(device_t dev)
    130   1.5  macallan {
    131   1.5  macallan 	struct lmu_softc * const sc = device_private(dev);
    132   1.5  macallan 
    133   1.5  macallan 	sc->sc_level = __MIN(16, sc->sc_level + 2);
    134   1.5  macallan 	sc->sc_target = sc->sc_level;
    135  1.10  macallan 	cv_signal(&sc->sc_event);
    136   1.5  macallan }
    137   1.5  macallan 
    138   1.5  macallan static void
    139   1.5  macallan lmu_kbd_brightness_down(device_t dev)
    140   1.5  macallan {
    141   1.5  macallan 	struct lmu_softc * const sc = device_private(dev);
    142   1.5  macallan 
    143   1.5  macallan 	sc->sc_level = __MAX(0, sc->sc_level - 2);
    144   1.5  macallan 	sc->sc_target = sc->sc_level;
    145  1.10  macallan 	cv_signal(&sc->sc_event);
    146   1.5  macallan }
    147   1.5  macallan 
    148   1.1  macallan static int
    149   1.1  macallan lmu_match(device_t parent, cfdata_t match, void *aux)
    150   1.1  macallan {
    151   1.1  macallan 	struct i2c_attach_args *ia = aux;
    152   1.1  macallan 	int match_result;
    153   1.1  macallan 
    154   1.1  macallan 	if (iic_use_direct_match(ia, match, compat_data, &match_result))
    155   1.1  macallan 		return match_result;
    156   1.1  macallan 
    157   1.1  macallan 	return 0;
    158   1.1  macallan }
    159   1.1  macallan 
    160   1.1  macallan static void
    161   1.1  macallan lmu_attach(device_t parent, device_t self, void *aux)
    162   1.1  macallan {
    163   1.1  macallan 	struct lmu_softc *sc = device_private(self);
    164   1.1  macallan 	struct i2c_attach_args *ia = aux;
    165   1.1  macallan 	envsys_data_t *s;
    166   1.4  macallan 	const struct sysctlnode *me;
    167   1.1  macallan 
    168   1.1  macallan 	sc->sc_dev = self;
    169   1.1  macallan 	sc->sc_i2c = ia->ia_tag;
    170   1.1  macallan 	sc->sc_addr = ia->ia_addr;
    171   1.4  macallan 	sc->sc_last = 0;
    172   1.1  macallan 
    173   1.1  macallan 	aprint_naive("\n");
    174   1.1  macallan 	aprint_normal(": ambient light sensor\n");
    175   1.1  macallan 
    176   1.2  macallan 	sc->sc_lid_state = true;
    177   1.2  macallan 	pmf_event_register(sc->sc_dev, PMFE_CHASSIS_LID_OPEN,
    178   1.2  macallan 	    lmu_lid_open, true);
    179   1.2  macallan 	pmf_event_register(sc->sc_dev, PMFE_CHASSIS_LID_CLOSE,
    180   1.2  macallan 	    lmu_lid_close, true);
    181   1.2  macallan 	sc->sc_video_state = true;
    182   1.2  macallan 	pmf_event_register(sc->sc_dev, PMFE_DISPLAY_ON,
    183   1.2  macallan 	    lmu_video_on, true);
    184   1.2  macallan 	pmf_event_register(sc->sc_dev, PMFE_DISPLAY_OFF,
    185   1.2  macallan 	    lmu_video_off, true);
    186   1.5  macallan 	pmf_event_register(sc->sc_dev, PMFE_KEYBOARD_BRIGHTNESS_UP,
    187   1.5  macallan 	    lmu_kbd_brightness_up, true);
    188   1.5  macallan 	pmf_event_register(sc->sc_dev, PMFE_KEYBOARD_BRIGHTNESS_DOWN,
    189   1.5  macallan 	    lmu_kbd_brightness_down, true);
    190   1.2  macallan 
    191   1.1  macallan 	sc->sc_sme = sysmon_envsys_create();
    192   1.1  macallan 	sc->sc_sme->sme_name = device_xname(self);
    193   1.1  macallan 	sc->sc_sme->sme_cookie = sc;
    194   1.1  macallan 	sc->sc_sme->sme_refresh = lmu_sensors_refresh;
    195  1.10  macallan 	sc->sc_sme->sme_class = 0;
    196  1.10  macallan 	sc->sc_sme->sme_flags = SME_INIT_REFRESH;;
    197  1.10  macallan 
    198   1.1  macallan 
    199   1.1  macallan 	s = &sc->sc_sensors[0];
    200   1.1  macallan 	s->state = ENVSYS_SINVALID;
    201   1.1  macallan 	s->units = ENVSYS_LUX;
    202  1.10  macallan 	s->flags = ENVSYS_FHAS_ENTROPY;
    203   1.1  macallan 	strcpy(s->desc, "right");
    204   1.1  macallan 	s->private = 0;
    205   1.1  macallan 	sysmon_envsys_sensor_attach(sc->sc_sme, s);
    206   1.1  macallan 
    207   1.1  macallan 	s = &sc->sc_sensors[1];
    208   1.1  macallan 	s->state = ENVSYS_SINVALID;
    209   1.1  macallan 	s->units = ENVSYS_LUX;
    210  1.10  macallan 	s->flags = ENVSYS_FHAS_ENTROPY;
    211   1.1  macallan 	strcpy(s->desc, "left");
    212   1.4  macallan 	s->private = 1;
    213   1.1  macallan 	sysmon_envsys_sensor_attach(sc->sc_sme, s);
    214   1.1  macallan 
    215   1.1  macallan 	sysmon_envsys_register(sc->sc_sme);
    216   1.1  macallan 
    217   1.1  macallan 	sc->sc_thresh = 300;
    218   1.1  macallan 	sc->sc_hyst = 30;
    219   1.4  macallan 	sc->sc_level = 16;
    220   1.4  macallan 	sc->sc_target = 0;
    221   1.4  macallan 	sc->sc_current = 0;
    222   1.4  macallan 
    223   1.4  macallan 	sysctl_createv(NULL, 0, NULL, &me,
    224   1.4  macallan 		CTLFLAG_READWRITE,
    225   1.4  macallan 		CTLTYPE_NODE, "lmu",
    226   1.4  macallan 		SYSCTL_DESCR("LMU driver"),
    227   1.4  macallan 		NULL, 0, NULL, 0,
    228   1.4  macallan 		CTL_HW, CTL_CREATE, CTL_EOL);
    229   1.4  macallan 
    230   1.4  macallan 	sysctl_createv(NULL, 0, NULL, NULL,
    231   1.4  macallan 		CTLFLAG_READWRITE,
    232   1.4  macallan 		CTLTYPE_INT, "level",
    233   1.4  macallan 		SYSCTL_DESCR("keyboard brightness"),
    234   1.4  macallan 		lmu_sysctl, 0, (void *)sc, 0,
    235   1.4  macallan 		CTL_HW, me->sysctl_num, CTL_CREATE, CTL_EOL);
    236   1.4  macallan 
    237   1.4  macallan 	sysctl_createv(NULL, 0, NULL, NULL,
    238   1.4  macallan 		CTLFLAG_READWRITE,
    239   1.4  macallan 		CTLTYPE_INT, "threshold",
    240   1.4  macallan 		SYSCTL_DESCR("environmental light threshold"),
    241   1.4  macallan 		lmu_sysctl_thresh, 1, (void *)sc, 0,
    242   1.4  macallan 		CTL_HW, me->sysctl_num, CTL_CREATE, CTL_EOL);
    243   1.1  macallan 
    244  1.10  macallan 	cv_init(&sc->sc_event, "lmu_event");
    245  1.10  macallan 	mutex_init(&sc->sc_evmtx, MUTEX_DEFAULT, IPL_NONE);
    246  1.10  macallan 
    247  1.10  macallan 	if (kthread_create(PRI_NONE, 0, NULL, lmu_adjust, sc, &sc->sc_adjust,
    248  1.10  macallan 	    "%s", "lmu") != 0) {
    249  1.10  macallan 		aprint_error_dev(self, "unable to create event kthread\n");
    250  1.10  macallan 	}
    251   1.1  macallan }
    252   1.1  macallan 
    253   1.1  macallan static void
    254   1.1  macallan lmu_sensors_refresh(struct sysmon_envsys *sme, envsys_data_t *edata)
    255   1.1  macallan {
    256   1.1  macallan 	struct lmu_softc *sc = sme->sme_cookie;
    257   1.1  macallan 	int ret;
    258   1.1  macallan 
    259  1.10  macallan 	edata->state = ENVSYS_SINVALID;
    260   1.1  macallan 	if ( edata->private < 3) {
    261   1.1  macallan 		ret = lmu_get_brightness(sc, edata->private);
    262   1.1  macallan 		if (ret == -1) return;
    263   1.1  macallan 		edata->value_cur = ret;
    264   1.1  macallan 	}
    265   1.1  macallan 	edata->state = ENVSYS_SVALID;
    266   1.1  macallan }
    267   1.1  macallan 
    268   1.1  macallan static int
    269   1.1  macallan lmu_get_brightness(struct lmu_softc *sc, int reg)
    270   1.1  macallan {
    271   1.4  macallan 	int error, i;
    272   1.4  macallan 	uint16_t buf[2];
    273   1.4  macallan 	uint8_t cmd = 0;
    274   1.4  macallan 
    275   1.4  macallan 	if (reg > 1) return -1;
    276   1.4  macallan 	if (time_second == sc->sc_last)
    277   1.4  macallan 		return sc->sc_lux[reg];
    278   1.1  macallan 
    279   1.1  macallan 	iic_acquire_bus(sc->sc_i2c, 0);
    280   1.1  macallan 	error = iic_exec(sc->sc_i2c, I2C_OP_READ_WITH_STOP,
    281   1.4  macallan 		sc->sc_addr, &cmd, 1, buf, 4, 0);
    282   1.1  macallan 	iic_release_bus(sc->sc_i2c, 0);
    283  1.10  macallan 
    284   1.1  macallan 	if (error) return -1;
    285   1.4  macallan 	sc->sc_last = time_second;
    286   1.4  macallan 
    287   1.4  macallan 	for (i = 0; i < 2; i++)
    288   1.4  macallan 		sc->sc_lux[i] = be16toh(buf[i]);
    289   1.4  macallan 
    290   1.4  macallan 	DPRINTF("<%d %04x %04x>", reg, buf[0], buf[1]);
    291   1.4  macallan 
    292   1.4  macallan 	return (sc->sc_lux[reg]);
    293   1.1  macallan }
    294   1.1  macallan 
    295   1.1  macallan static void
    296   1.1  macallan lmu_set_brightness(struct lmu_softc *sc, int b)
    297   1.1  macallan {
    298   1.1  macallan 	uint8_t cmd[3];
    299   1.1  macallan 
    300   1.1  macallan 	cmd[0] = 1;
    301   1.4  macallan 
    302   1.4  macallan 	cmd[1] = (b & 0xff);
    303   1.4  macallan 	cmd[2] = (b & 0xff) >> 8;
    304   1.1  macallan 
    305   1.1  macallan 	iic_acquire_bus(sc->sc_i2c, 0);
    306   1.1  macallan 	iic_exec(sc->sc_i2c, I2C_OP_READ_WITH_STOP,
    307   1.1  macallan 		sc->sc_addr, &cmd, 3, NULL, 0, 0);
    308   1.1  macallan 	iic_release_bus(sc->sc_i2c, 0);
    309   1.1  macallan }
    310   1.1  macallan 
    311   1.1  macallan static void
    312   1.1  macallan lmu_adjust(void *cookie)
    313   1.1  macallan {
    314   1.1  macallan 	struct lmu_softc *sc = cookie;
    315  1.10  macallan 	int left, right, b, offset, ticks;
    316  1.10  macallan 
    317  1.10  macallan 	while (1) {
    318  1.10  macallan 		ticks = LMU_POLL;
    319  1.10  macallan 		left = lmu_get_brightness(sc, 1);
    320  1.10  macallan 		right = lmu_get_brightness(sc, 0);
    321  1.10  macallan 		b = left > right ? left : right;
    322  1.10  macallan 
    323  1.10  macallan 		if ((b > (sc->sc_thresh + sc->sc_hyst)) ||
    324  1.10  macallan 		   !(sc->sc_lid_state && sc->sc_video_state)) {
    325  1.10  macallan 			sc->sc_target = 0;
    326  1.10  macallan 		} else if (b < sc->sc_thresh) {
    327  1.10  macallan 			sc->sc_target = sc->sc_level;
    328  1.10  macallan 		}
    329   1.1  macallan 
    330  1.10  macallan 		if (sc->sc_target != sc->sc_current) {
    331  1.10  macallan 			offset = ((sc->sc_target - sc->sc_current) > 0) ? 2 : -2;
    332  1.10  macallan 			sc->sc_current += offset;
    333  1.10  macallan 			if (sc->sc_current > sc->sc_level) sc->sc_current = sc->sc_level;
    334  1.10  macallan 			if (sc->sc_current < 0) sc->sc_current = 0;
    335   1.4  macallan 
    336  1.10  macallan 			DPRINTF("[%d]", sc->sc_current);
    337  1.10  macallan 			lmu_set_brightness(sc, sc->sc_current);
    338   1.4  macallan 
    339  1.10  macallan 			if (sc->sc_target != sc->sc_current) ticks = LMU_FADE;
    340  1.10  macallan 		}
    341  1.10  macallan 
    342  1.10  macallan 		mutex_enter(&sc->sc_evmtx);
    343  1.10  macallan 		cv_timedwait(&sc->sc_event, &sc->sc_evmtx, ticks);
    344  1.10  macallan 		mutex_exit(&sc->sc_evmtx);
    345  1.10  macallan 	}
    346   1.4  macallan }
    347   1.4  macallan 
    348   1.4  macallan static int
    349   1.4  macallan lmu_sysctl(SYSCTLFN_ARGS)
    350   1.4  macallan {
    351   1.4  macallan 	struct sysctlnode node = *rnode;
    352   1.4  macallan 	struct lmu_softc *sc = node.sysctl_data;
    353   1.4  macallan 	int target;
    354   1.4  macallan 
    355   1.4  macallan 	target = sc->sc_level;
    356   1.4  macallan 	node.sysctl_data = &target;
    357   1.4  macallan 	if (sysctl_lookup(SYSCTLFN_CALL(&node)) == 0) {
    358   1.4  macallan 		int new_reg;
    359   1.4  macallan 
    360   1.4  macallan 		new_reg = *(int *)node.sysctl_data;
    361   1.4  macallan 		if (new_reg != sc->sc_target) {
    362   1.4  macallan 			sc->sc_level = target;
    363   1.4  macallan 			sc->sc_target = target;
    364   1.4  macallan 
    365   1.4  macallan 		}
    366   1.4  macallan 		return 0;
    367   1.1  macallan 	}
    368   1.4  macallan 	return EINVAL;
    369   1.4  macallan }
    370   1.1  macallan 
    371   1.4  macallan static int
    372   1.4  macallan lmu_sysctl_thresh(SYSCTLFN_ARGS)
    373   1.4  macallan {
    374   1.4  macallan 	struct sysctlnode node = *rnode;
    375   1.4  macallan 	struct lmu_softc *sc = node.sysctl_data;
    376   1.4  macallan 	int thresh;
    377   1.4  macallan 
    378   1.4  macallan 	thresh = sc->sc_thresh;
    379   1.4  macallan 	node.sysctl_data = &thresh;
    380   1.4  macallan 	if (sysctl_lookup(SYSCTLFN_CALL(&node)) == 0) {
    381   1.4  macallan 		int new_reg;
    382   1.4  macallan 
    383   1.4  macallan 		new_reg = *(int *)node.sysctl_data;
    384   1.4  macallan 		if (new_reg != sc->sc_thresh && new_reg > 0) {
    385   1.4  macallan 			sc->sc_thresh = new_reg;
    386   1.4  macallan 		}
    387   1.4  macallan 		return 0;
    388   1.4  macallan 	}
    389   1.4  macallan 	return EINVAL;
    390   1.1  macallan }
    391