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