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 = ⌖ 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