1 /*-
2 * Copyright (c) 2002-2003 Taku YAMAMOTO <taku@cent.saitama-u.ac.jp>
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24 * SUCH DAMAGE.
25 *
26 * $Id: acpi_vid.c,v 1.4 2003/10/13 10:07:36 taku Exp $
27 */
28
29 #include <sys/cdefs.h>
30 __FBSDID("$FreeBSD$");
31
32 #include <sys/param.h>
33 #include <sys/kernel.h>
34 #include <sys/malloc.h>
35 #include <sys/module.h>
36 #include <sys/bus.h>
37 #include <sys/power.h>
38 #include <sys/queue.h>
39 #include <sys/sysctl.h>
40
41 #include <contrib/dev/acpica/acpi.h>
42 #include <dev/acpica/acpivar.h>
43
44 /* ACPI video extension driver. */
45 struct acpi_video_output {
46 ACPI_HANDLE handle;
47 UINT32 adr;
48 STAILQ_ENTRY(acpi_video_output) vo_next;
49 struct {
50 int num;
51 STAILQ_ENTRY(acpi_video_output) next;
52 } vo_unit;
53 int vo_brightness;
54 int vo_fullpower;
55 int vo_economy;
56 int vo_numlevels;
57 int *vo_levels;
58 struct sysctl_ctx_list vo_sysctl_ctx;
59 struct sysctl_oid *vo_sysctl_tree;
60 };
61
62 STAILQ_HEAD(acpi_video_output_queue, acpi_video_output);
63
64 struct acpi_video_softc {
65 device_t device;
66 ACPI_HANDLE handle;
67 struct acpi_video_output_queue vid_outputs;
68 eventhandler_tag vid_pwr_evh;
69 };
70
71 /* interfaces */
72 static int acpi_video_modevent(struct module*, int, void *);
73 static void acpi_video_identify(driver_t *driver, device_t parent);
74 static int acpi_video_probe(device_t);
75 static int acpi_video_attach(device_t);
76 static int acpi_video_detach(device_t);
77 static int acpi_video_shutdown(device_t);
78 static void acpi_video_notify_handler(ACPI_HANDLE, UINT32, void *);
79 static void acpi_video_power_profile(void *);
80 static void acpi_video_bind_outputs(struct acpi_video_softc *);
81 static struct acpi_video_output *acpi_video_vo_init(UINT32);
82 static void acpi_video_vo_bind(struct acpi_video_output *, ACPI_HANDLE);
83 static void acpi_video_vo_destroy(struct acpi_video_output *);
84 static int acpi_video_vo_check_level(struct acpi_video_output *, int);
85 static int acpi_video_vo_active_sysctl(SYSCTL_HANDLER_ARGS);
86 static int acpi_video_vo_bright_sysctl(SYSCTL_HANDLER_ARGS);
87 static int acpi_video_vo_presets_sysctl(SYSCTL_HANDLER_ARGS);
88 static int acpi_video_vo_levels_sysctl(SYSCTL_HANDLER_ARGS);
89
90 /* operations */
91 static void vid_set_switch_policy(ACPI_HANDLE, UINT32);
92 static int vid_enum_outputs(ACPI_HANDLE,
93 void(*)(ACPI_HANDLE, UINT32, void *), void *);
94 static int vo_get_brightness_levels(ACPI_HANDLE, int **);
95 static void vo_set_brightness(ACPI_HANDLE, int);
96 static UINT32 vo_get_device_status(ACPI_HANDLE);
97 static UINT32 vo_get_graphics_state(ACPI_HANDLE);
98 static void vo_set_device_state(ACPI_HANDLE, UINT32);
99
100 /* events */
101 #define VID_NOTIFY_SWITCHED 0x80
102 #define VID_NOTIFY_REPROBE 0x81
103
104 /* _DOS (Enable/Disable Output Switching) argument bits */
105 #define DOS_SWITCH_MASK 3
106 #define DOS_SWITCH_BY_OSPM 0
107 #define DOS_SWITCH_BY_BIOS 1
108 #define DOS_SWITCH_LOCKED 2
109 #define DOS_BRIGHTNESS_BY_BIOS (1 << 2)
110
111 /* _DOD and subdev's _ADR */
112 #define DOD_DEVID_MASK 0x0f00
113 #define DOD_DEVID_MASK_FULL 0xffff
114 #define DOD_DEVID_MASK_DISPIDX 0x000f
115 #define DOD_DEVID_MASK_DISPPORT 0x00f0
116 #define DOD_DEVID_MONITOR 0x0100
117 #define DOD_DEVID_LCD 0x0110
118 #define DOD_DEVID_TV 0x0200
119 #define DOD_DEVID_EXT 0x0300
120 #define DOD_DEVID_INTDFP 0x0400
121 #define DOD_BIOS (1 << 16)
122 #define DOD_NONVGA (1 << 17)
123 #define DOD_HEAD_ID_SHIFT 18
124 #define DOD_HEAD_ID_BITS 3
125 #define DOD_HEAD_ID_MASK \
126 (((1 << DOD_HEAD_ID_BITS) - 1) << DOD_HEAD_ID_SHIFT)
127 #define DOD_DEVID_SCHEME_STD (1 << 31)
128
129 /* _BCL related constants */
130 #define BCL_FULLPOWER 0
131 #define BCL_ECONOMY 1
132
133 /* _DCS (Device Currrent Status) value bits and masks. */
134 #define DCS_EXISTS (1 << 0)
135 #define DCS_ACTIVE (1 << 1)
136 #define DCS_READY (1 << 2)
137 #define DCS_FUNCTIONAL (1 << 3)
138 #define DCS_ATTACHED (1 << 4)
139
140 /* _DSS (Device Set Status) argument bits and masks. */
141 #define DSS_INACTIVE 0
142 #define DSS_ACTIVE (1 << 0)
143 #define DSS_SETNEXT (1 << 30)
144 #define DSS_COMMIT (1 << 31)
145
146 static device_method_t acpi_video_methods[] = {
147 DEVMETHOD(device_identify, acpi_video_identify),
148 DEVMETHOD(device_probe, acpi_video_probe),
149 DEVMETHOD(device_attach, acpi_video_attach),
150 DEVMETHOD(device_detach, acpi_video_detach),
151 DEVMETHOD(device_shutdown, acpi_video_shutdown),
152 { 0, 0 }
153 };
154
155 static driver_t acpi_video_driver = {
156 "acpi_video",
157 acpi_video_methods,
158 sizeof(struct acpi_video_softc),
159 };
160
161 static devclass_t acpi_video_devclass;
162
163 DRIVER_MODULE(acpi_video, vgapci, acpi_video_driver, acpi_video_devclass,
164 acpi_video_modevent, NULL);
165 MODULE_DEPEND(acpi_video, acpi, 1, 1, 1);
166
167 static struct sysctl_ctx_list acpi_video_sysctl_ctx;
168 static struct sysctl_oid *acpi_video_sysctl_tree;
169 static struct acpi_video_output_queue crt_units, tv_units,
170 ext_units, lcd_units, other_units;
171
172 ACPI_SERIAL_DECL(video, "ACPI video");
173 MALLOC_DEFINE(M_ACPIVIDEO, "acpivideo", "ACPI video extension");
174
175 static int
176 acpi_video_modevent(struct module *mod __unused, int evt, void *cookie __unused)
177 {
178 int err;
179
180 err = 0;
181 switch (evt) {
182 case MOD_LOAD:
183 sysctl_ctx_init(&acpi_video_sysctl_ctx);
184 STAILQ_INIT(&crt_units);
185 STAILQ_INIT(&tv_units);
186 STAILQ_INIT(&ext_units);
187 STAILQ_INIT(&lcd_units);
188 STAILQ_INIT(&other_units);
189 break;
190 case MOD_UNLOAD:
191 sysctl_ctx_free(&acpi_video_sysctl_ctx);
192 acpi_video_sysctl_tree = NULL;
193 break;
194 default:
195 err = EINVAL;
196 }
197
198 return (err);
199 }
200
201 static void
202 acpi_video_identify(driver_t *driver, device_t parent)
203 {
204
205 if (device_find_child(parent, "acpi_video", -1) == NULL)
206 device_add_child(parent, "acpi_video", -1);
207 }
208
209 static int
210 acpi_video_probe(device_t dev)
211 {
212 ACPI_HANDLE devh, h;
213 ACPI_OBJECT_TYPE t_dos;
214
215 devh = acpi_get_handle(dev);
216 if (acpi_disabled("video") ||
217 ACPI_FAILURE(AcpiGetHandle(devh, "_DOD", &h)) ||
218 ACPI_FAILURE(AcpiGetHandle(devh, "_DOS", &h)) ||
219 ACPI_FAILURE(AcpiGetType(h, &t_dos)) ||
220 t_dos != ACPI_TYPE_METHOD)
221 return (ENXIO);
222
223 device_set_desc(dev, "ACPI video extension");
224 return (0);
225 }
226
227 static int
228 acpi_video_attach(device_t dev)
229 {
230 struct acpi_softc *acpi_sc;
231 struct acpi_video_softc *sc;
232
233 sc = device_get_softc(dev);
234
235 acpi_sc = devclass_get_softc(devclass_find("acpi"), 0);
236 if (acpi_sc == NULL)
237 return (ENXIO);
238 if (acpi_video_sysctl_tree == NULL) {
239 acpi_video_sysctl_tree = SYSCTL_ADD_NODE(&acpi_video_sysctl_ctx,
240 SYSCTL_CHILDREN(acpi_sc->acpi_sysctl_tree),
241 OID_AUTO, "video", CTLFLAG_RD, 0,
242 "video extension control");
243 }
244
245 sc->device = dev;
246 sc->handle = acpi_get_handle(dev);
247 STAILQ_INIT(&sc->vid_outputs);
248
249 AcpiInstallNotifyHandler(sc->handle, ACPI_DEVICE_NOTIFY,
250 acpi_video_notify_handler, sc);
251 sc->vid_pwr_evh = EVENTHANDLER_REGISTER(power_profile_change,
252 acpi_video_power_profile, sc, 0);
253
254 ACPI_SERIAL_BEGIN(video);
255 acpi_video_bind_outputs(sc);
256 ACPI_SERIAL_END(video);
257
258 /*
259 * Notify the BIOS that we want to switch both active outputs and
260 * brightness levels.
261 */
262 vid_set_switch_policy(sc->handle, DOS_SWITCH_BY_OSPM |
263 DOS_BRIGHTNESS_BY_BIOS);
264
265 acpi_video_power_profile(sc);
266
267 return (0);
268 }
269
270 static int
271 acpi_video_detach(device_t dev)
272 {
273 struct acpi_video_softc *sc;
274 struct acpi_video_output *vo, *vn;
275
276 sc = device_get_softc(dev);
277
278 vid_set_switch_policy(sc->handle, DOS_SWITCH_BY_BIOS);
279 EVENTHANDLER_DEREGISTER(power_profile_change, sc->vid_pwr_evh);
280 AcpiRemoveNotifyHandler(sc->handle, ACPI_DEVICE_NOTIFY,
281 acpi_video_notify_handler);
282
283 ACPI_SERIAL_BEGIN(video);
284 for (vo = STAILQ_FIRST(&sc->vid_outputs); vo != NULL; vo = vn) {
285 vn = STAILQ_NEXT(vo, vo_next);
286 acpi_video_vo_destroy(vo);
287 }
288 ACPI_SERIAL_END(video);
289
290 return (0);
291 }
292
293 static int
294 acpi_video_shutdown(device_t dev)
295 {
296 struct acpi_video_softc *sc;
297
298 sc = device_get_softc(dev);
299 vid_set_switch_policy(sc->handle, DOS_SWITCH_BY_BIOS);
300
301 return (0);
302 }
303
304 static void
305 acpi_video_notify_handler(ACPI_HANDLE handle, UINT32 notify, void *context)
306 {
307 struct acpi_video_softc *sc;
308 struct acpi_video_output *vo, *vo_tmp;
309 ACPI_HANDLE lasthand;
310 UINT32 dcs, dss, dss_p;
311
312 sc = (struct acpi_video_softc *)context;
313
314 switch (notify) {
315 case VID_NOTIFY_SWITCHED:
316 dss_p = 0;
317 lasthand = NULL;
318 ACPI_SERIAL_BEGIN(video);
319 STAILQ_FOREACH(vo, &sc->vid_outputs, vo_next) {
320 dss = vo_get_graphics_state(vo->handle);
321 dcs = vo_get_device_status(vo->handle);
322 if (!(dcs & DCS_READY))
323 dss = DSS_INACTIVE;
324 if (((dcs & DCS_ACTIVE) && dss == DSS_INACTIVE) ||
325 (!(dcs & DCS_ACTIVE) && dss == DSS_ACTIVE)) {
326 if (lasthand != NULL)
327 vo_set_device_state(lasthand, dss_p);
328 dss_p = dss;
329 lasthand = vo->handle;
330 }
331 }
332 if (lasthand != NULL)
333 vo_set_device_state(lasthand, dss_p|DSS_COMMIT);
334 ACPI_SERIAL_END(video);
335 break;
336 case VID_NOTIFY_REPROBE:
337 ACPI_SERIAL_BEGIN(video);
338 STAILQ_FOREACH(vo, &sc->vid_outputs, vo_next)
339 vo->handle = NULL;
340 acpi_video_bind_outputs(sc);
341 STAILQ_FOREACH_SAFE(vo, &sc->vid_outputs, vo_next, vo_tmp) {
342 if (vo->handle == NULL) {
343 STAILQ_REMOVE(&sc->vid_outputs, vo,
344 acpi_video_output, vo_next);
345 acpi_video_vo_destroy(vo);
346 }
347 }
348 ACPI_SERIAL_END(video);
349 break;
350 default:
351 device_printf(sc->device, "unknown notify event 0x%x\n",
352 notify);
353 }
354 }
355
356 static void
357 acpi_video_power_profile(void *context)
358 {
359 int state;
360 struct acpi_video_softc *sc;
361 struct acpi_video_output *vo;
362
363 sc = context;
364 state = power_profile_get_state();
365 if (state != POWER_PROFILE_PERFORMANCE &&
366 state != POWER_PROFILE_ECONOMY)
367 return;
368
369 ACPI_SERIAL_BEGIN(video);
370 STAILQ_FOREACH(vo, &sc->vid_outputs, vo_next) {
371 if (vo->vo_levels != NULL && vo->vo_brightness == -1)
372 vo_set_brightness(vo->handle,
373 state == POWER_PROFILE_ECONOMY ?
374 vo->vo_economy : vo->vo_fullpower);
375 }
376 ACPI_SERIAL_END(video);
377 }
378
379 static void
380 acpi_video_bind_outputs_subr(ACPI_HANDLE handle, UINT32 adr, void *context)
381 {
382 struct acpi_video_softc *sc;
383 struct acpi_video_output *vo;
384
385 ACPI_SERIAL_ASSERT(video);
386 sc = context;
387
388 STAILQ_FOREACH(vo, &sc->vid_outputs, vo_next) {
389 if (vo->adr == adr) {
390 acpi_video_vo_bind(vo, handle);
391 return;
392 }
393 }
394 vo = acpi_video_vo_init(adr);
395 if (vo != NULL) {
396 acpi_video_vo_bind(vo, handle);
397 STAILQ_INSERT_TAIL(&sc->vid_outputs, vo, vo_next);
398 }
399 }
400
401 static void
402 acpi_video_bind_outputs(struct acpi_video_softc *sc)
403 {
404
405 ACPI_SERIAL_ASSERT(video);
406 vid_enum_outputs(sc->handle, acpi_video_bind_outputs_subr, sc);
407 }
408
409 static struct acpi_video_output *
410 acpi_video_vo_init(UINT32 adr)
411 {
412 struct acpi_video_output *vn, *vo, *vp;
413 int n, x;
414 int display_index;
415 int display_port;
416 char name[8], env[32];
417 const char *type, *desc;
418 struct acpi_video_output_queue *voqh;
419
420 ACPI_SERIAL_ASSERT(video);
421 display_index = adr & DOD_DEVID_MASK_DISPIDX;
422 display_port = (adr & DOD_DEVID_MASK_DISPPORT) >> 4;
423
424 switch (adr & DOD_DEVID_MASK) {
425 case DOD_DEVID_MONITOR:
426 if ((adr & DOD_DEVID_MASK_FULL) == DOD_DEVID_LCD) {
427 /* DOD_DEVID_LCD is a common, backward compatible ID */
428 desc = "Internal/Integrated Digital Flat Panel";
429 type = "lcd";
430 voqh = &lcd_units;
431 } else {
432 desc = "VGA CRT or VESA Compatible Analog Monitor";
433 type = "crt";
434 voqh = &crt_units;
435 }
436 break;
437 case DOD_DEVID_TV:
438 desc = "TV/HDTV or Analog-Video Monitor";
439 type = "tv";
440 voqh = &tv_units;
441 break;
442 case DOD_DEVID_EXT:
443 desc = "External Digital Monitor";
444 type = "ext";
445 voqh = &ext_units;
446 break;
447 case DOD_DEVID_INTDFP:
448 desc = "Internal/Integrated Digital Flat Panel";
449 type = "lcd";
450 voqh = &lcd_units;
451 break;
452 default:
453 desc = "unknown output";
454 type = "out";
455 voqh = &other_units;
456 }
457
458 n = 0;
459 vn = vp = NULL;
460 STAILQ_FOREACH(vn, voqh, vo_unit.next) {
461 if (vn->vo_unit.num != n)
462 break;
463 vp = vn;
464 n++;
465 }
466
467 snprintf(name, sizeof(name), "%s%d", type, n);
468
469 vo = malloc(sizeof(*vo), M_ACPIVIDEO, M_NOWAIT);
470 if (vo != NULL) {
471 vo->handle = NULL;
472 vo->adr = adr;
473 vo->vo_unit.num = n;
474 vo->vo_brightness = -1;
475 vo->vo_fullpower = -1; /* TODO: override with tunables */
476 vo->vo_economy = -1;
477 vo->vo_numlevels = 0;
478 vo->vo_levels = NULL;
479 snprintf(env, sizeof(env), "hw.acpi.video.%s.fullpower", name);
480 if (getenv_int(env, &x))
481 vo->vo_fullpower = x;
482 snprintf(env, sizeof(env), "hw.acpi.video.%s.economy", name);
483 if (getenv_int(env, &x))
484 vo->vo_economy = x;
485
486 sysctl_ctx_init(&vo->vo_sysctl_ctx);
487 if (vp != NULL)
488 STAILQ_INSERT_AFTER(voqh, vp, vo, vo_unit.next);
489 else
490 STAILQ_INSERT_TAIL(voqh, vo, vo_unit.next);
491 if (acpi_video_sysctl_tree != NULL)
492 vo->vo_sysctl_tree =
493 SYSCTL_ADD_NODE(&vo->vo_sysctl_ctx,
494 SYSCTL_CHILDREN(acpi_video_sysctl_tree),
495 OID_AUTO, name, CTLFLAG_RD, 0, desc);
496 if (vo->vo_sysctl_tree != NULL) {
497 SYSCTL_ADD_PROC(&vo->vo_sysctl_ctx,
498 SYSCTL_CHILDREN(vo->vo_sysctl_tree),
499 OID_AUTO, "active",
500 CTLTYPE_INT|CTLFLAG_RW, vo, 0,
501 acpi_video_vo_active_sysctl, "I",
502 "current activity of this device");
503 SYSCTL_ADD_PROC(&vo->vo_sysctl_ctx,
504 SYSCTL_CHILDREN(vo->vo_sysctl_tree),
505 OID_AUTO, "brightness",
506 CTLTYPE_INT|CTLFLAG_RW, vo, 0,
507 acpi_video_vo_bright_sysctl, "I",
508 "current brightness level");
509 SYSCTL_ADD_PROC(&vo->vo_sysctl_ctx,
510 SYSCTL_CHILDREN(vo->vo_sysctl_tree),
511 OID_AUTO, "fullpower",
512 CTLTYPE_INT|CTLFLAG_RW, vo,
513 POWER_PROFILE_PERFORMANCE,
514 acpi_video_vo_presets_sysctl, "I",
515 "preset level for full power mode");
516 SYSCTL_ADD_PROC(&vo->vo_sysctl_ctx,
517 SYSCTL_CHILDREN(vo->vo_sysctl_tree),
518 OID_AUTO, "economy",
519 CTLTYPE_INT|CTLFLAG_RW, vo,
520 POWER_PROFILE_ECONOMY,
521 acpi_video_vo_presets_sysctl, "I",
522 "preset level for economy mode");
523 SYSCTL_ADD_PROC(&vo->vo_sysctl_ctx,
524 SYSCTL_CHILDREN(vo->vo_sysctl_tree),
525 OID_AUTO, "levels",
526 CTLTYPE_OPAQUE|CTLFLAG_RD, vo, 0,
527 acpi_video_vo_levels_sysctl, "I",
528 "supported brightness levels");
529 } else
530 printf("%s: sysctl node creation failed\n", type);
531 } else
532 printf("%s: softc allocation failed\n", type);
533
534 if (bootverbose) {
535 printf("found %s(%x)", desc, adr & DOD_DEVID_MASK_FULL);
536 printf(", idx#%x", adr & DOD_DEVID_MASK_DISPIDX);
537 printf(", port#%x", (adr & DOD_DEVID_MASK_DISPPORT) >> 4);
538 if (adr & DOD_BIOS)
539 printf(", detectable by BIOS");
540 if (adr & DOD_NONVGA)
541 printf(" (Non-VGA output device whose power "
542 "is related to the VGA device)");
543 printf(", head #%d\n",
544 (adr & DOD_HEAD_ID_MASK) >> DOD_HEAD_ID_SHIFT);
545 }
546 return (vo);
547 }
548
549 static void
550 acpi_video_vo_bind(struct acpi_video_output *vo, ACPI_HANDLE handle)
551 {
552
553 ACPI_SERIAL_ASSERT(video);
554 if (vo->vo_levels != NULL)
555 AcpiOsFree(vo->vo_levels);
556 vo->handle = handle;
557 vo->vo_numlevels = vo_get_brightness_levels(handle, &vo->vo_levels);
558 if (vo->vo_numlevels >= 2) {
559 if (vo->vo_fullpower == -1
560 || acpi_video_vo_check_level(vo, vo->vo_fullpower) != 0)
561 /* XXX - can't deal with rebinding... */
562 vo->vo_fullpower = vo->vo_levels[BCL_FULLPOWER];
563 if (vo->vo_economy == -1
564 || acpi_video_vo_check_level(vo, vo->vo_economy) != 0)
565 /* XXX - see above. */
566 vo->vo_economy = vo->vo_levels[BCL_ECONOMY];
567 }
568 }
569
570 static void
571 acpi_video_vo_destroy(struct acpi_video_output *vo)
572 {
573 struct acpi_video_output_queue *voqh;
574
575 ACPI_SERIAL_ASSERT(video);
576 if (vo->vo_sysctl_tree != NULL) {
577 vo->vo_sysctl_tree = NULL;
578 sysctl_ctx_free(&vo->vo_sysctl_ctx);
579 }
580 if (vo->vo_levels != NULL)
581 AcpiOsFree(vo->vo_levels);
582
583 switch (vo->adr & DOD_DEVID_MASK) {
584 case DOD_DEVID_MONITOR:
585 voqh = &crt_units;
586 break;
587 case DOD_DEVID_TV:
588 voqh = &tv_units;
589 break;
590 case DOD_DEVID_EXT:
591 voqh = &ext_units;
592 break;
593 case DOD_DEVID_INTDFP:
594 voqh = &lcd_units;
595 break;
596 default:
597 voqh = &other_units;
598 }
599 STAILQ_REMOVE(voqh, vo, acpi_video_output, vo_unit.next);
600 free(vo, M_ACPIVIDEO);
601 }
602
603 static int
604 acpi_video_vo_check_level(struct acpi_video_output *vo, int level)
605 {
606 int i;
607
608 ACPI_SERIAL_ASSERT(video);
609 if (vo->vo_levels == NULL)
610 return (ENODEV);
611 for (i = 0; i < vo->vo_numlevels; i++)
612 if (vo->vo_levels[i] == level)
613 return (0);
614 return (EINVAL);
615 }
616
617 /* ARGSUSED */
618 static int
619 acpi_video_vo_active_sysctl(SYSCTL_HANDLER_ARGS)
620 {
621 struct acpi_video_output *vo;
622 int state, err;
623
624 vo = (struct acpi_video_output *)arg1;
625 if (vo->handle == NULL)
626 return (ENXIO);
627 ACPI_SERIAL_BEGIN(video);
628 state = (vo_get_device_status(vo->handle) & DCS_ACTIVE) ? 1 : 0;
629 err = sysctl_handle_int(oidp, &state, 0, req);
630 if (err != 0 || req->newptr == NULL)
631 goto out;
632 vo_set_device_state(vo->handle,
633 DSS_COMMIT | (state ? DSS_ACTIVE : DSS_INACTIVE));
634 out:
635 ACPI_SERIAL_END(video);
636 return (err);
637 }
638
639 /* ARGSUSED */
640 static int
641 acpi_video_vo_bright_sysctl(SYSCTL_HANDLER_ARGS)
642 {
643 struct acpi_video_output *vo;
644 int level, preset, err;
645
646 vo = (struct acpi_video_output *)arg1;
647 ACPI_SERIAL_BEGIN(video);
648 if (vo->handle == NULL) {
649 err = ENXIO;
650 goto out;
651 }
652 if (vo->vo_levels == NULL) {
653 err = ENODEV;
654 goto out;
655 }
656
657 preset = (power_profile_get_state() == POWER_PROFILE_ECONOMY) ?
658 vo->vo_economy : vo->vo_fullpower;
659 level = vo->vo_brightness;
660 if (level == -1)
661 level = preset;
662
663 err = sysctl_handle_int(oidp, &level, 0, req);
664 if (err != 0 || req->newptr == NULL)
665 goto out;
666 if (level < -1 || level > 100) {
667 err = EINVAL;
668 goto out;
669 }
670
671 if (level != -1 && (err = acpi_video_vo_check_level(vo, level)))
672 goto out;
673 vo->vo_brightness = level;
674 vo_set_brightness(vo->handle, (level == -1) ? preset : level);
675
676 out:
677 ACPI_SERIAL_END(video);
678 return (err);
679 }
680
681 static int
682 acpi_video_vo_presets_sysctl(SYSCTL_HANDLER_ARGS)
683 {
684 struct acpi_video_output *vo;
685 int i, level, *preset, err;
686
687 err = 0;
688 vo = (struct acpi_video_output *)arg1;
689 ACPI_SERIAL_BEGIN(video);
690 if (vo->handle == NULL) {
691 err = ENXIO;
692 goto out;
693 }
694 if (vo->vo_levels == NULL) {
695 err = ENODEV;
696 goto out;
697 }
698 preset = (arg2 == POWER_PROFILE_ECONOMY) ?
699 &vo->vo_economy : &vo->vo_fullpower;
700 level = *preset;
701 err = sysctl_handle_int(oidp, &level, 0, req);
702 if (err != 0 || req->newptr == NULL)
703 goto out;
704 if (level < -1 || level > 100) {
705 err = EINVAL;
706 goto out;
707 }
708 if (level == -1) {
709 i = (arg2 == POWER_PROFILE_ECONOMY) ?
710 BCL_ECONOMY : BCL_FULLPOWER;
711 level = vo->vo_levels[i];
712 } else if ((err = acpi_video_vo_check_level(vo, level)) != 0)
713 goto out;
714
715 if (vo->vo_brightness == -1 && (power_profile_get_state() == arg2))
716 vo_set_brightness(vo->handle, level);
717 *preset = level;
718
719 out:
720 ACPI_SERIAL_END(video);
721 return (err);
722 }
723
724 /* ARGSUSED */
725 static int
726 acpi_video_vo_levels_sysctl(SYSCTL_HANDLER_ARGS)
727 {
728 struct acpi_video_output *vo;
729 int err;
730
731 vo = (struct acpi_video_output *)arg1;
732 ACPI_SERIAL_BEGIN(video);
733 if (vo->vo_levels == NULL) {
734 err = ENODEV;
735 goto out;
736 }
737 if (req->newptr != NULL) {
738 err = EPERM;
739 goto out;
740 }
741 err = sysctl_handle_opaque(oidp, vo->vo_levels,
742 vo->vo_numlevels * sizeof(*vo->vo_levels), req);
743
744 out:
745 ACPI_SERIAL_END(video);
746 return (err);
747 }
748
749 static void
750 vid_set_switch_policy(ACPI_HANDLE handle, UINT32 policy)
751 {
752 ACPI_STATUS status;
753
754 status = acpi_SetInteger(handle, "_DOS", policy);
755 if (ACPI_FAILURE(status))
756 printf("can't evaluate %s._DOS - %s\n",
757 acpi_name(handle), AcpiFormatException(status));
758 }
759
760 struct enum_callback_arg {
761 void (*callback)(ACPI_HANDLE, UINT32, void *);
762 void *context;
763 ACPI_OBJECT *dod_pkg;
764 int count;
765 };
766
767 static ACPI_STATUS
768 vid_enum_outputs_subr(ACPI_HANDLE handle, UINT32 level __unused,
769 void *context, void **retp __unused)
770 {
771 ACPI_STATUS status;
772 UINT32 adr, val;
773 struct enum_callback_arg *argset;
774 size_t i;
775
776 ACPI_SERIAL_ASSERT(video);
777 argset = context;
778 status = acpi_GetInteger(handle, "_ADR", &adr);
779 if (ACPI_FAILURE(status))
780 return (AE_OK);
781
782 for (i = 0; i < argset->dod_pkg->Package.Count; i++) {
783 if (acpi_PkgInt32(argset->dod_pkg, i, &val) == 0 &&
784 (val & DOD_DEVID_MASK_FULL) == adr) {
785 argset->callback(handle, val, argset->context);
786 argset->count++;
787 }
788 }
789
790 return (AE_OK);
791 }
792
793 static int
794 vid_enum_outputs(ACPI_HANDLE handle,
795 void (*callback)(ACPI_HANDLE, UINT32, void *), void *context)
796 {
797 ACPI_STATUS status;
798 ACPI_BUFFER dod_buf;
799 ACPI_OBJECT *res;
800 struct enum_callback_arg argset;
801
802 ACPI_SERIAL_ASSERT(video);
803 dod_buf.Length = ACPI_ALLOCATE_BUFFER;
804 dod_buf.Pointer = NULL;
805 status = AcpiEvaluateObject(handle, "_DOD", NULL, &dod_buf);
806 if (ACPI_FAILURE(status)) {
807 if (status != AE_NOT_FOUND)
808 printf("can't evaluate %s._DOD - %s\n",
809 acpi_name(handle), AcpiFormatException(status));
810 argset.count = -1;
811 goto out;
812 }
813 res = (ACPI_OBJECT *)dod_buf.Pointer;
814 if (!ACPI_PKG_VALID(res, 1)) {
815 printf("evaluation of %s._DOD makes no sense\n",
816 acpi_name(handle));
817 argset.count = -1;
818 goto out;
819 }
820 if (callback == NULL) {
821 argset.count = res->Package.Count;
822 goto out;
823 }
824 argset.callback = callback;
825 argset.context = context;
826 argset.dod_pkg = res;
827 argset.count = 0;
828 status = AcpiWalkNamespace(ACPI_TYPE_DEVICE, handle, 1,
829 vid_enum_outputs_subr, &argset, NULL);
830 if (ACPI_FAILURE(status))
831 printf("failed walking down %s - %s\n",
832 acpi_name(handle), AcpiFormatException(status));
833 out:
834 if (dod_buf.Pointer != NULL)
835 AcpiOsFree(dod_buf.Pointer);
836 return (argset.count);
837 }
838
839 static int
840 vo_get_brightness_levels(ACPI_HANDLE handle, int **levelp)
841 {
842 ACPI_STATUS status;
843 ACPI_BUFFER bcl_buf;
844 ACPI_OBJECT *res;
845 int num, i, n, *levels;
846
847 num = 0;
848 bcl_buf.Length = ACPI_ALLOCATE_BUFFER;
849 bcl_buf.Pointer = NULL;
850 status = AcpiEvaluateObject(handle, "_BCL", NULL, &bcl_buf);
851 if (ACPI_FAILURE(status)) {
852 if (status != AE_NOT_FOUND)
853 printf("can't evaluate %s._BCL - %s\n",
854 acpi_name(handle), AcpiFormatException(status));
855 num = -1;
856 goto out;
857 }
858 res = (ACPI_OBJECT *)bcl_buf.Pointer;
859 if (!ACPI_PKG_VALID(res, 2)) {
860 printf("evaluation of %s._BCL makes no sense\n",
861 acpi_name(handle));
862 num = -1;
863 goto out;
864 }
865 num = res->Package.Count;
866 if (levelp == NULL)
867 goto out;
868 levels = AcpiOsAllocate(num * sizeof(*levels));
869 if (levels == NULL) {
870 num = -1;
871 goto out;
872 }
873 for (i = 0, n = 0; i < num; i++)
874 if (acpi_PkgInt32(res, i, &levels[n]) == 0)
875 n++;
876 if (n < 2) {
877 num = -1;
878 AcpiOsFree(levels);
879 } else {
880 num = n;
881 *levelp = levels;
882 }
883 out:
884 if (bcl_buf.Pointer != NULL)
885 AcpiOsFree(bcl_buf.Pointer);
886
887 return (num);
888 }
889
890 static void
891 vo_set_brightness(ACPI_HANDLE handle, int level)
892 {
893 ACPI_STATUS status;
894
895 status = acpi_SetInteger(handle, "_BCM", level);
896 if (ACPI_FAILURE(status))
897 printf("can't evaluate %s._BCM - %s\n",
898 acpi_name(handle), AcpiFormatException(status));
899 }
900
901 static UINT32
902 vo_get_device_status(ACPI_HANDLE handle)
903 {
904 UINT32 dcs;
905 ACPI_STATUS status;
906
907 dcs = 0;
908 status = acpi_GetInteger(handle, "_DCS", &dcs);
909 if (ACPI_FAILURE(status))
910 printf("can't evaluate %s._DCS - %s\n",
911 acpi_name(handle), AcpiFormatException(status));
912
913 return (dcs);
914 }
915
916 static UINT32
917 vo_get_graphics_state(ACPI_HANDLE handle)
918 {
919 UINT32 dgs;
920 ACPI_STATUS status;
921
922 dgs = 0;
923 status = acpi_GetInteger(handle, "_DGS", &dgs);
924 if (ACPI_FAILURE(status))
925 printf("can't evaluate %s._DGS - %s\n",
926 acpi_name(handle), AcpiFormatException(status));
927
928 return (dgs);
929 }
930
931 static void
932 vo_set_device_state(ACPI_HANDLE handle, UINT32 state)
933 {
934 ACPI_STATUS status;
935
936 status = acpi_SetInteger(handle, "_DSS", state);
937 if (ACPI_FAILURE(status))
938 printf("can't evaluate %s._DSS - %s\n",
939 acpi_name(handle), AcpiFormatException(status));
940 }
Cache object: 53f77a825207ce85cb353d2523a47f07
|