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