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