lmu.c revision 1.11 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