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