1 /*- 2 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 3 * 4 * Copyright (c) 2007, 2008 Rui Paulo <rpaulo@FreeBSD.org> 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer. 12 * 2. Redistributions in binary form must reproduce the above copyright 13 * notice, this list of conditions and the following disclaimer in the 14 * documentation and/or other materials provided with the distribution. 15 * 16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 17 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 18 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE 19 * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, 20 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 21 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR 22 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, 24 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN 25 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 26 * POSSIBILITY OF SUCH DAMAGE. 27 * 28 */ 29 30 /* 31 * Driver for Apple's System Management Console (SMC). 32 * SMC can be found on the MacBook, MacBook Pro and Mac Mini. 33 * 34 * Inspired by the Linux applesmc driver. 35 */ 36 37 #include <sys/cdefs.h> 38 __FBSDID("$FreeBSD$"); 39 40 #include <sys/param.h> 41 #include <sys/bus.h> 42 #include <sys/conf.h> 43 #include <sys/kernel.h> 44 #include <sys/lock.h> 45 #include <sys/malloc.h> 46 #include <sys/module.h> 47 #include <sys/mutex.h> 48 #include <sys/sysctl.h> 49 #include <sys/systm.h> 50 #include <sys/taskqueue.h> 51 #include <sys/rman.h> 52 53 #include <machine/resource.h> 54 55 #include <contrib/dev/acpica/include/acpi.h> 56 57 #include <dev/acpica/acpivar.h> 58 #include <dev/asmc/asmcvar.h> 59 60 /* 61 * Device interface. 62 */ 63 static int asmc_probe(device_t dev); 64 static int asmc_attach(device_t dev); 65 static int asmc_detach(device_t dev); 66 static int asmc_resume(device_t dev); 67 68 /* 69 * SMC functions. 70 */ 71 static int asmc_init(device_t dev); 72 static int asmc_command(device_t dev, uint8_t command); 73 static int asmc_wait(device_t dev, uint8_t val); 74 static int asmc_wait_ack(device_t dev, uint8_t val, int amount); 75 static int asmc_key_write(device_t dev, const char *key, uint8_t *buf, 76 uint8_t len); 77 static int asmc_key_read(device_t dev, const char *key, uint8_t *buf, 78 uint8_t); 79 static int asmc_fan_count(device_t dev); 80 static int asmc_fan_getvalue(device_t dev, const char *key, int fan); 81 static int asmc_fan_setvalue(device_t dev, const char *key, int fan, int speed); 82 static int asmc_temp_getvalue(device_t dev, const char *key); 83 static int asmc_sms_read(device_t, const char *key, int16_t *val); 84 static void asmc_sms_calibrate(device_t dev); 85 static int asmc_sms_intrfast(void *arg); 86 static void asmc_sms_printintr(device_t dev, uint8_t); 87 static void asmc_sms_task(void *arg, int pending); 88 #ifdef DEBUG 89 void asmc_dumpall(device_t); 90 static int asmc_key_dump(device_t, int); 91 #endif 92 93 /* 94 * Model functions. 95 */ 96 static int asmc_mb_sysctl_fanid(SYSCTL_HANDLER_ARGS); 97 static int asmc_mb_sysctl_fanspeed(SYSCTL_HANDLER_ARGS); 98 static int asmc_mb_sysctl_fansafespeed(SYSCTL_HANDLER_ARGS); 99 static int asmc_mb_sysctl_fanminspeed(SYSCTL_HANDLER_ARGS); 100 static int asmc_mb_sysctl_fanmaxspeed(SYSCTL_HANDLER_ARGS); 101 static int asmc_mb_sysctl_fantargetspeed(SYSCTL_HANDLER_ARGS); 102 static int asmc_temp_sysctl(SYSCTL_HANDLER_ARGS); 103 static int asmc_mb_sysctl_sms_x(SYSCTL_HANDLER_ARGS); 104 static int asmc_mb_sysctl_sms_y(SYSCTL_HANDLER_ARGS); 105 static int asmc_mb_sysctl_sms_z(SYSCTL_HANDLER_ARGS); 106 static int asmc_mbp_sysctl_light_left(SYSCTL_HANDLER_ARGS); 107 static int asmc_mbp_sysctl_light_right(SYSCTL_HANDLER_ARGS); 108 static int asmc_mbp_sysctl_light_control(SYSCTL_HANDLER_ARGS); 109 110 struct asmc_model { 111 const char *smc_model; /* smbios.system.product env var. */ 112 const char *smc_desc; /* driver description */ 113 114 /* Helper functions */ 115 int (*smc_sms_x)(SYSCTL_HANDLER_ARGS); 116 int (*smc_sms_y)(SYSCTL_HANDLER_ARGS); 117 int (*smc_sms_z)(SYSCTL_HANDLER_ARGS); 118 int (*smc_fan_id)(SYSCTL_HANDLER_ARGS); 119 int (*smc_fan_speed)(SYSCTL_HANDLER_ARGS); 120 int (*smc_fan_safespeed)(SYSCTL_HANDLER_ARGS); 121 int (*smc_fan_minspeed)(SYSCTL_HANDLER_ARGS); 122 int (*smc_fan_maxspeed)(SYSCTL_HANDLER_ARGS); 123 int (*smc_fan_targetspeed)(SYSCTL_HANDLER_ARGS); 124 int (*smc_light_left)(SYSCTL_HANDLER_ARGS); 125 int (*smc_light_right)(SYSCTL_HANDLER_ARGS); 126 int (*smc_light_control)(SYSCTL_HANDLER_ARGS); 127 128 const char *smc_temps[ASMC_TEMP_MAX]; 129 const char *smc_tempnames[ASMC_TEMP_MAX]; 130 const char *smc_tempdescs[ASMC_TEMP_MAX]; 131 }; 132 133 static struct asmc_model *asmc_match(device_t dev); 134 135 #define ASMC_SMS_FUNCS asmc_mb_sysctl_sms_x, asmc_mb_sysctl_sms_y, \ 136 asmc_mb_sysctl_sms_z 137 138 #define ASMC_SMS_FUNCS_DISABLED NULL,NULL,NULL 139 140 #define ASMC_FAN_FUNCS asmc_mb_sysctl_fanid, asmc_mb_sysctl_fanspeed, asmc_mb_sysctl_fansafespeed, \ 141 asmc_mb_sysctl_fanminspeed, \ 142 asmc_mb_sysctl_fanmaxspeed, \ 143 asmc_mb_sysctl_fantargetspeed 144 145 #define ASMC_FAN_FUNCS2 asmc_mb_sysctl_fanid, asmc_mb_sysctl_fanspeed, NULL, \ 146 asmc_mb_sysctl_fanminspeed, \ 147 asmc_mb_sysctl_fanmaxspeed, \ 148 asmc_mb_sysctl_fantargetspeed 149 150 #define ASMC_LIGHT_FUNCS asmc_mbp_sysctl_light_left, \ 151 asmc_mbp_sysctl_light_right, \ 152 asmc_mbp_sysctl_light_control 153 154 struct asmc_model asmc_models[] = { 155 { 156 "MacBook1,1", "Apple SMC MacBook Core Duo", 157 ASMC_SMS_FUNCS, ASMC_FAN_FUNCS, NULL, NULL, NULL, 158 ASMC_MB_TEMPS, ASMC_MB_TEMPNAMES, ASMC_MB_TEMPDESCS 159 }, 160 161 { 162 "MacBook2,1", "Apple SMC MacBook Core 2 Duo", 163 ASMC_SMS_FUNCS, ASMC_FAN_FUNCS, NULL, NULL, NULL, 164 ASMC_MB_TEMPS, ASMC_MB_TEMPNAMES, ASMC_MB_TEMPDESCS 165 }, 166 167 { 168 "MacBook3,1", "Apple SMC MacBook Core 2 Duo", 169 ASMC_SMS_FUNCS, ASMC_FAN_FUNCS, NULL, NULL, NULL, 170 ASMC_MB31_TEMPS, ASMC_MB31_TEMPNAMES, ASMC_MB31_TEMPDESCS 171 }, 172 173 { 174 "MacBookPro1,1", "Apple SMC MacBook Pro Core Duo (15-inch)", 175 ASMC_SMS_FUNCS, ASMC_FAN_FUNCS, ASMC_LIGHT_FUNCS, 176 ASMC_MBP_TEMPS, ASMC_MBP_TEMPNAMES, ASMC_MBP_TEMPDESCS 177 }, 178 179 { 180 "MacBookPro1,2", "Apple SMC MacBook Pro Core Duo (17-inch)", 181 ASMC_SMS_FUNCS, ASMC_FAN_FUNCS, ASMC_LIGHT_FUNCS, 182 ASMC_MBP_TEMPS, ASMC_MBP_TEMPNAMES, ASMC_MBP_TEMPDESCS 183 }, 184 185 { 186 "MacBookPro2,1", "Apple SMC MacBook Pro Core 2 Duo (17-inch)", 187 ASMC_SMS_FUNCS, ASMC_FAN_FUNCS, ASMC_LIGHT_FUNCS, 188 ASMC_MBP_TEMPS, ASMC_MBP_TEMPNAMES, ASMC_MBP_TEMPDESCS 189 }, 190 191 { 192 "MacBookPro2,2", "Apple SMC MacBook Pro Core 2 Duo (15-inch)", 193 ASMC_SMS_FUNCS, ASMC_FAN_FUNCS, ASMC_LIGHT_FUNCS, 194 ASMC_MBP_TEMPS, ASMC_MBP_TEMPNAMES, ASMC_MBP_TEMPDESCS 195 }, 196 197 { 198 "MacBookPro3,1", "Apple SMC MacBook Pro Core 2 Duo (15-inch LED)", 199 ASMC_SMS_FUNCS, ASMC_FAN_FUNCS, ASMC_LIGHT_FUNCS, 200 ASMC_MBP_TEMPS, ASMC_MBP_TEMPNAMES, ASMC_MBP_TEMPDESCS 201 }, 202 203 { 204 "MacBookPro3,2", "Apple SMC MacBook Pro Core 2 Duo (17-inch HD)", 205 ASMC_SMS_FUNCS, ASMC_FAN_FUNCS, ASMC_LIGHT_FUNCS, 206 ASMC_MBP_TEMPS, ASMC_MBP_TEMPNAMES, ASMC_MBP_TEMPDESCS 207 }, 208 209 { 210 "MacBookPro4,1", "Apple SMC MacBook Pro Core 2 Duo (Penryn)", 211 ASMC_SMS_FUNCS, ASMC_FAN_FUNCS, ASMC_LIGHT_FUNCS, 212 ASMC_MBP4_TEMPS, ASMC_MBP4_TEMPNAMES, ASMC_MBP4_TEMPDESCS 213 }, 214 215 { 216 "MacBookPro5,1", "Apple SMC MacBook Pro Core 2 Duo (2008/2009)", 217 ASMC_SMS_FUNCS, ASMC_FAN_FUNCS, ASMC_LIGHT_FUNCS, 218 ASMC_MBP5_TEMPS, ASMC_MBP5_TEMPNAMES, ASMC_MBP5_TEMPDESCS 219 }, 220 221 { 222 "MacBookPro8,1", "Apple SMC MacBook Pro (early 2011, 13-inch)", 223 ASMC_SMS_FUNCS_DISABLED, ASMC_FAN_FUNCS2, ASMC_LIGHT_FUNCS, 224 ASMC_MBP81_TEMPS, ASMC_MBP81_TEMPNAMES, ASMC_MBP81_TEMPDESCS 225 }, 226 227 { 228 "MacBookPro8,2", "Apple SMC MacBook Pro (early 2011)", 229 ASMC_SMS_FUNCS, ASMC_FAN_FUNCS, ASMC_LIGHT_FUNCS, 230 ASMC_MBP82_TEMPS, ASMC_MBP82_TEMPNAMES, ASMC_MBP82_TEMPDESCS 231 }, 232 233 { 234 "MacBookPro11,2", "Apple SMC MacBook Pro Retina Core i7 (2013/2014)", 235 ASMC_SMS_FUNCS_DISABLED, ASMC_FAN_FUNCS2, ASMC_LIGHT_FUNCS, 236 ASMC_MBP112_TEMPS, ASMC_MBP112_TEMPNAMES, ASMC_MBP112_TEMPDESCS 237 }, 238 239 { 240 "MacBookPro11,3", "Apple SMC MacBook Pro Retina Core i7 (2013/2014)", 241 ASMC_SMS_FUNCS, ASMC_FAN_FUNCS, ASMC_LIGHT_FUNCS, 242 ASMC_MBP113_TEMPS, ASMC_MBP113_TEMPNAMES, ASMC_MBP113_TEMPDESCS 243 }, 244 245 /* The Mac Mini has no SMS */ 246 { 247 "Macmini1,1", "Apple SMC Mac Mini", 248 NULL, NULL, NULL, 249 ASMC_FAN_FUNCS, 250 NULL, NULL, NULL, 251 ASMC_MM_TEMPS, ASMC_MM_TEMPNAMES, ASMC_MM_TEMPDESCS 252 }, 253 254 /* The Mac Mini 3,1 has no SMS */ 255 { 256 "Macmini3,1", "Apple SMC Mac Mini 3,1", 257 NULL, NULL, NULL, 258 ASMC_FAN_FUNCS, 259 NULL, NULL, NULL, 260 ASMC_MM31_TEMPS, ASMC_MM31_TEMPNAMES, ASMC_MM31_TEMPDESCS 261 }, 262 263 /* The Mac Mini 5,2 has no SMS */ 264 { 265 "Macmini5,2", "Apple SMC Mac Mini 5,2", 266 NULL, NULL, NULL, 267 ASMC_FAN_FUNCS2, 268 NULL, NULL, NULL, 269 ASMC_MM52_TEMPS, ASMC_MM52_TEMPNAMES, ASMC_MM52_TEMPDESCS 270 }, 271 272 /* Idem for the MacPro */ 273 { 274 "MacPro2", "Apple SMC Mac Pro (8-core)", 275 NULL, NULL, NULL, 276 ASMC_FAN_FUNCS, 277 NULL, NULL, NULL, 278 ASMC_MP_TEMPS, ASMC_MP_TEMPNAMES, ASMC_MP_TEMPDESCS 279 }, 280 281 /* Idem for the MacPro 2010*/ 282 { 283 "MacPro5,1", "Apple SMC MacPro (2010)", 284 NULL, NULL, NULL, 285 ASMC_FAN_FUNCS, 286 NULL, NULL, NULL, 287 ASMC_MP5_TEMPS, ASMC_MP5_TEMPNAMES, ASMC_MP5_TEMPDESCS 288 }, 289 290 { 291 "MacBookAir1,1", "Apple SMC MacBook Air", 292 ASMC_SMS_FUNCS, ASMC_FAN_FUNCS, NULL, NULL, NULL, 293 ASMC_MBA_TEMPS, ASMC_MBA_TEMPNAMES, ASMC_MBA_TEMPDESCS 294 }, 295 296 { 297 "MacBookAir3,1", "Apple SMC MacBook Air Core 2 Duo (Late 2010)", 298 ASMC_SMS_FUNCS, ASMC_FAN_FUNCS, NULL, NULL, NULL, 299 ASMC_MBA3_TEMPS, ASMC_MBA3_TEMPNAMES, ASMC_MBA3_TEMPDESCS 300 }, 301 302 { 303 "MacBookAir5,1", "Apple SMC MacBook Air 11-inch (Mid 2012)", 304 ASMC_SMS_FUNCS_DISABLED, 305 ASMC_FAN_FUNCS2, 306 ASMC_LIGHT_FUNCS, 307 ASMC_MBA5_TEMPS, ASMC_MBA5_TEMPNAMES, ASMC_MBA5_TEMPDESCS 308 }, 309 310 { 311 "MacBookAir5,2", "Apple SMC MacBook Air 13-inch (Mid 2012)", 312 ASMC_SMS_FUNCS_DISABLED, 313 ASMC_FAN_FUNCS2, 314 ASMC_LIGHT_FUNCS, 315 ASMC_MBA5_TEMPS, ASMC_MBA5_TEMPNAMES, ASMC_MBA5_TEMPDESCS 316 }, 317 318 { 319 "MacBookAir7,1", "Apple SMC MacBook Air 11-inch (Early 2015)", 320 ASMC_SMS_FUNCS_DISABLED, 321 ASMC_FAN_FUNCS2, 322 ASMC_LIGHT_FUNCS, 323 ASMC_MBA7_TEMPS, ASMC_MBA7_TEMPNAMES, ASMC_MBA7_TEMPDESCS 324 }, 325 326 { 327 "MacBookAir7,2", "Apple SMC MacBook Air 13-inch (Early 2015)", 328 ASMC_SMS_FUNCS_DISABLED, 329 ASMC_FAN_FUNCS2, 330 ASMC_LIGHT_FUNCS, 331 ASMC_MBA7_TEMPS, ASMC_MBA7_TEMPNAMES, ASMC_MBA7_TEMPDESCS 332 }, 333 334 { NULL, NULL } 335 }; 336 337 #undef ASMC_SMS_FUNCS 338 #undef ASMC_SMS_FUNCS_DISABLED 339 #undef ASMC_FAN_FUNCS 340 #undef ASMC_FAN_FUNCS2 341 #undef ASMC_LIGHT_FUNCS 342 343 /* 344 * Driver methods. 345 */ 346 static device_method_t asmc_methods[] = { 347 DEVMETHOD(device_probe, asmc_probe), 348 DEVMETHOD(device_attach, asmc_attach), 349 DEVMETHOD(device_detach, asmc_detach), 350 DEVMETHOD(device_resume, asmc_resume), 351 352 { 0, 0 } 353 }; 354 355 static driver_t asmc_driver = { 356 "asmc", 357 asmc_methods, 358 sizeof(struct asmc_softc) 359 }; 360 361 /* 362 * Debugging 363 */ 364 #define _COMPONENT ACPI_OEM 365 ACPI_MODULE_NAME("ASMC") 366 #ifdef DEBUG 367 #define ASMC_DPRINTF(str) device_printf(dev, str) 368 #else 369 #define ASMC_DPRINTF(str) 370 #endif 371 372 /* NB: can't be const */ 373 static char *asmc_ids[] = { "APP0001", NULL }; 374 375 static devclass_t asmc_devclass; 376 377 static unsigned int light_control = 0; 378 379 DRIVER_MODULE(asmc, acpi, asmc_driver, asmc_devclass, NULL, NULL); 380 MODULE_DEPEND(asmc, acpi, 1, 1, 1); 381 382 static struct asmc_model * 383 asmc_match(device_t dev) 384 { 385 int i; 386 char *model; 387 388 model = kern_getenv("smbios.system.product"); 389 if (model == NULL) 390 return (NULL); 391 392 for (i = 0; asmc_models[i].smc_model; i++) { 393 if (!strncmp(model, asmc_models[i].smc_model, strlen(model))) { 394 freeenv(model); 395 return (&asmc_models[i]); 396 } 397 } 398 freeenv(model); 399 400 return (NULL); 401 } 402 403 static int 404 asmc_probe(device_t dev) 405 { 406 struct asmc_model *model; 407 int rv; 408 409 if (resource_disabled("asmc", 0)) 410 return (ENXIO); 411 rv = ACPI_ID_PROBE(device_get_parent(dev), dev, asmc_ids, NULL); 412 if (rv > 0) 413 return (rv); 414 415 model = asmc_match(dev); 416 if (!model) { 417 device_printf(dev, "model not recognized\n"); 418 return (ENXIO); 419 } 420 device_set_desc(dev, model->smc_desc); 421 422 return (rv); 423 } 424 425 static int 426 asmc_attach(device_t dev) 427 { 428 int i, j; 429 int ret; 430 char name[2]; 431 struct asmc_softc *sc = device_get_softc(dev); 432 struct sysctl_ctx_list *sysctlctx; 433 struct sysctl_oid *sysctlnode; 434 struct asmc_model *model; 435 436 sc->sc_ioport = bus_alloc_resource_any(dev, SYS_RES_IOPORT, 437 &sc->sc_rid_port, RF_ACTIVE); 438 if (sc->sc_ioport == NULL) { 439 device_printf(dev, "unable to allocate IO port\n"); 440 return (ENOMEM); 441 } 442 443 sysctlctx = device_get_sysctl_ctx(dev); 444 sysctlnode = device_get_sysctl_tree(dev); 445 446 model = asmc_match(dev); 447 448 mtx_init(&sc->sc_mtx, "asmc", NULL, MTX_SPIN); 449 450 sc->sc_model = model; 451 asmc_init(dev); 452 453 /* 454 * dev.asmc.n.fan.* tree. 455 */ 456 sc->sc_fan_tree[0] = SYSCTL_ADD_NODE(sysctlctx, 457 SYSCTL_CHILDREN(sysctlnode), OID_AUTO, "fan", 458 CTLFLAG_RD, 0, "Fan Root Tree"); 459 460 for (i = 1; i <= sc->sc_nfan; i++) { 461 j = i - 1; 462 name[0] = '0' + j; 463 name[1] = 0; 464 sc->sc_fan_tree[i] = SYSCTL_ADD_NODE(sysctlctx, 465 SYSCTL_CHILDREN(sc->sc_fan_tree[0]), 466 OID_AUTO, name, CTLFLAG_RD, 0, 467 "Fan Subtree"); 468 469 SYSCTL_ADD_PROC(sysctlctx, 470 SYSCTL_CHILDREN(sc->sc_fan_tree[i]), 471 OID_AUTO, "id", CTLTYPE_STRING | CTLFLAG_RD, 472 dev, j, model->smc_fan_id, "I", 473 "Fan ID"); 474 475 SYSCTL_ADD_PROC(sysctlctx, 476 SYSCTL_CHILDREN(sc->sc_fan_tree[i]), 477 OID_AUTO, "speed", CTLTYPE_INT | CTLFLAG_RD, 478 dev, j, model->smc_fan_speed, "I", 479 "Fan speed in RPM"); 480 481 SYSCTL_ADD_PROC(sysctlctx, 482 SYSCTL_CHILDREN(sc->sc_fan_tree[i]), 483 OID_AUTO, "safespeed", 484 CTLTYPE_INT | CTLFLAG_RD, 485 dev, j, model->smc_fan_safespeed, "I", 486 "Fan safe speed in RPM"); 487 488 SYSCTL_ADD_PROC(sysctlctx, 489 SYSCTL_CHILDREN(sc->sc_fan_tree[i]), 490 OID_AUTO, "minspeed", 491 CTLTYPE_INT | CTLFLAG_RW, 492 dev, j, model->smc_fan_minspeed, "I", 493 "Fan minimum speed in RPM"); 494 495 SYSCTL_ADD_PROC(sysctlctx, 496 SYSCTL_CHILDREN(sc->sc_fan_tree[i]), 497 OID_AUTO, "maxspeed", 498 CTLTYPE_INT | CTLFLAG_RW, 499 dev, j, model->smc_fan_maxspeed, "I", 500 "Fan maximum speed in RPM"); 501 502 SYSCTL_ADD_PROC(sysctlctx, 503 SYSCTL_CHILDREN(sc->sc_fan_tree[i]), 504 OID_AUTO, "targetspeed", 505 CTLTYPE_INT | CTLFLAG_RW, 506 dev, j, model->smc_fan_targetspeed, "I", 507 "Fan target speed in RPM"); 508 } 509 510 /* 511 * dev.asmc.n.temp tree. 512 */ 513 sc->sc_temp_tree = SYSCTL_ADD_NODE(sysctlctx, 514 SYSCTL_CHILDREN(sysctlnode), OID_AUTO, "temp", 515 CTLFLAG_RD, 0, "Temperature sensors"); 516 517 for (i = 0; model->smc_temps[i]; i++) { 518 SYSCTL_ADD_PROC(sysctlctx, 519 SYSCTL_CHILDREN(sc->sc_temp_tree), 520 OID_AUTO, model->smc_tempnames[i], 521 CTLTYPE_INT | CTLFLAG_RD, 522 dev, i, asmc_temp_sysctl, "I", 523 model->smc_tempdescs[i]); 524 } 525 526 /* 527 * dev.asmc.n.light 528 */ 529 if (model->smc_light_left) { 530 sc->sc_light_tree = SYSCTL_ADD_NODE(sysctlctx, 531 SYSCTL_CHILDREN(sysctlnode), OID_AUTO, "light", 532 CTLFLAG_RD, 0, "Keyboard backlight sensors"); 533 534 SYSCTL_ADD_PROC(sysctlctx, 535 SYSCTL_CHILDREN(sc->sc_light_tree), 536 OID_AUTO, "left", CTLTYPE_INT | CTLFLAG_RD, 537 dev, 0, model->smc_light_left, "I", 538 "Keyboard backlight left sensor"); 539 540 SYSCTL_ADD_PROC(sysctlctx, 541 SYSCTL_CHILDREN(sc->sc_light_tree), 542 OID_AUTO, "right", CTLTYPE_INT | CTLFLAG_RD, 543 dev, 0, model->smc_light_right, "I", 544 "Keyboard backlight right sensor"); 545 546 SYSCTL_ADD_PROC(sysctlctx, 547 SYSCTL_CHILDREN(sc->sc_light_tree), 548 OID_AUTO, "control", 549 CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_ANYBODY, 550 dev, 0, model->smc_light_control, "I", 551 "Keyboard backlight brightness control"); 552 } 553 554 if (model->smc_sms_x == NULL) 555 goto nosms; 556 557 /* 558 * dev.asmc.n.sms tree. 559 */ 560 sc->sc_sms_tree = SYSCTL_ADD_NODE(sysctlctx, 561 SYSCTL_CHILDREN(sysctlnode), OID_AUTO, "sms", 562 CTLFLAG_RD, 0, "Sudden Motion Sensor"); 563 564 SYSCTL_ADD_PROC(sysctlctx, 565 SYSCTL_CHILDREN(sc->sc_sms_tree), 566 OID_AUTO, "x", CTLTYPE_INT | CTLFLAG_RD, 567 dev, 0, model->smc_sms_x, "I", 568 "Sudden Motion Sensor X value"); 569 570 SYSCTL_ADD_PROC(sysctlctx, 571 SYSCTL_CHILDREN(sc->sc_sms_tree), 572 OID_AUTO, "y", CTLTYPE_INT | CTLFLAG_RD, 573 dev, 0, model->smc_sms_y, "I", 574 "Sudden Motion Sensor Y value"); 575 576 SYSCTL_ADD_PROC(sysctlctx, 577 SYSCTL_CHILDREN(sc->sc_sms_tree), 578 OID_AUTO, "z", CTLTYPE_INT | CTLFLAG_RD, 579 dev, 0, model->smc_sms_z, "I", 580 "Sudden Motion Sensor Z value"); 581 582 /* 583 * Need a taskqueue to send devctl_notify() events 584 * when the SMS interrupt us. 585 * 586 * PI_REALTIME is used due to the sensitivity of the 587 * interrupt. An interrupt from the SMS means that the 588 * disk heads should be turned off as quickly as possible. 589 * 590 * We only need to do this for the non INTR_FILTER case. 591 */ 592 sc->sc_sms_tq = NULL; 593 TASK_INIT(&sc->sc_sms_task, 0, asmc_sms_task, sc); 594 sc->sc_sms_tq = taskqueue_create_fast("asmc_taskq", M_WAITOK, 595 taskqueue_thread_enqueue, &sc->sc_sms_tq); 596 taskqueue_start_threads(&sc->sc_sms_tq, 1, PI_REALTIME, "%s sms taskq", 597 device_get_nameunit(dev)); 598 /* 599 * Allocate an IRQ for the SMS. 600 */ 601 sc->sc_rid_irq = 0; 602 sc->sc_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, 603 &sc->sc_rid_irq, RF_ACTIVE); 604 if (sc->sc_irq == NULL) { 605 device_printf(dev, "unable to allocate IRQ resource\n"); 606 ret = ENXIO; 607 goto err2; 608 } 609 610 ret = bus_setup_intr(dev, sc->sc_irq, 611 INTR_TYPE_MISC | INTR_MPSAFE, 612 asmc_sms_intrfast, NULL, 613 dev, &sc->sc_cookie); 614 615 if (ret) { 616 device_printf(dev, "unable to setup SMS IRQ\n"); 617 goto err1; 618 } 619 nosms: 620 return (0); 621 err1: 622 bus_release_resource(dev, SYS_RES_IRQ, sc->sc_rid_irq, sc->sc_irq); 623 err2: 624 bus_release_resource(dev, SYS_RES_IOPORT, sc->sc_rid_port, 625 sc->sc_ioport); 626 mtx_destroy(&sc->sc_mtx); 627 if (sc->sc_sms_tq) 628 taskqueue_free(sc->sc_sms_tq); 629 630 return (ret); 631 } 632 633 static int 634 asmc_detach(device_t dev) 635 { 636 struct asmc_softc *sc = device_get_softc(dev); 637 638 if (sc->sc_sms_tq) { 639 taskqueue_drain(sc->sc_sms_tq, &sc->sc_sms_task); 640 taskqueue_free(sc->sc_sms_tq); 641 } 642 if (sc->sc_cookie) 643 bus_teardown_intr(dev, sc->sc_irq, sc->sc_cookie); 644 if (sc->sc_irq) 645 bus_release_resource(dev, SYS_RES_IRQ, sc->sc_rid_irq, 646 sc->sc_irq); 647 if (sc->sc_ioport) 648 bus_release_resource(dev, SYS_RES_IOPORT, sc->sc_rid_port, 649 sc->sc_ioport); 650 mtx_destroy(&sc->sc_mtx); 651 652 return (0); 653 } 654 655 static int 656 asmc_resume(device_t dev) 657 { 658 uint8_t buf[2]; 659 buf[0] = light_control; 660 buf[1] = 0x00; 661 asmc_key_write(dev, ASMC_KEY_LIGHTVALUE, buf, sizeof buf); 662 return (0); 663 } 664 665 666 #ifdef DEBUG 667 void asmc_dumpall(device_t dev) 668 { 669 int i; 670 671 /* XXX magic number */ 672 for (i=0; i < 0x100; i++) 673 asmc_key_dump(dev, i); 674 } 675 #endif 676 677 static int 678 asmc_init(device_t dev) 679 { 680 struct asmc_softc *sc = device_get_softc(dev); 681 int i, error = 1; 682 uint8_t buf[4]; 683 684 if (sc->sc_model->smc_sms_x == NULL) 685 goto nosms; 686 687 /* 688 * We are ready to receive interrupts from the SMS. 689 */ 690 buf[0] = 0x01; 691 ASMC_DPRINTF(("intok key\n")); 692 asmc_key_write(dev, ASMC_KEY_INTOK, buf, 1); 693 DELAY(50); 694 695 /* 696 * Initiate the polling intervals. 697 */ 698 buf[0] = 20; /* msecs */ 699 ASMC_DPRINTF(("low int key\n")); 700 asmc_key_write(dev, ASMC_KEY_SMS_LOW_INT, buf, 1); 701 DELAY(200); 702 703 buf[0] = 20; /* msecs */ 704 ASMC_DPRINTF(("high int key\n")); 705 asmc_key_write(dev, ASMC_KEY_SMS_HIGH_INT, buf, 1); 706 DELAY(200); 707 708 buf[0] = 0x00; 709 buf[1] = 0x60; 710 ASMC_DPRINTF(("sms low key\n")); 711 asmc_key_write(dev, ASMC_KEY_SMS_LOW, buf, 2); 712 DELAY(200); 713 714 buf[0] = 0x01; 715 buf[1] = 0xc0; 716 ASMC_DPRINTF(("sms high key\n")); 717 asmc_key_write(dev, ASMC_KEY_SMS_HIGH, buf, 2); 718 DELAY(200); 719 720 /* 721 * I'm not sure what this key does, but it seems to be 722 * required. 723 */ 724 buf[0] = 0x01; 725 ASMC_DPRINTF(("sms flag key\n")); 726 asmc_key_write(dev, ASMC_KEY_SMS_FLAG, buf, 1); 727 DELAY(100); 728 729 sc->sc_sms_intr_works = 0; 730 731 /* 732 * Retry SMS initialization 1000 times 733 * (takes approx. 2 seconds in worst case) 734 */ 735 for (i = 0; i < 1000; i++) { 736 if (asmc_key_read(dev, ASMC_KEY_SMS, buf, 2) == 0 && 737 (buf[0] == ASMC_SMS_INIT1 && buf[1] == ASMC_SMS_INIT2)) { 738 error = 0; 739 sc->sc_sms_intr_works = 1; 740 goto out; 741 } 742 buf[0] = ASMC_SMS_INIT1; 743 buf[1] = ASMC_SMS_INIT2; 744 ASMC_DPRINTF(("sms key\n")); 745 asmc_key_write(dev, ASMC_KEY_SMS, buf, 2); 746 DELAY(50); 747 } 748 device_printf(dev, "WARNING: Sudden Motion Sensor not initialized!\n"); 749 750 out: 751 asmc_sms_calibrate(dev); 752 nosms: 753 sc->sc_nfan = asmc_fan_count(dev); 754 if (sc->sc_nfan > ASMC_MAXFANS) { 755 device_printf(dev, "more than %d fans were detected. Please " 756 "report this.\n", ASMC_MAXFANS); 757 sc->sc_nfan = ASMC_MAXFANS; 758 } 759 760 if (bootverbose) { 761 /* 762 * The number of keys is a 32 bit buffer 763 */ 764 asmc_key_read(dev, ASMC_NKEYS, buf, 4); 765 device_printf(dev, "number of keys: %d\n", ntohl(*(uint32_t*)buf)); 766 } 767 768 #ifdef DEBUG 769 asmc_dumpall(dev); 770 #endif 771 772 return (error); 773 } 774 775 /* 776 * We need to make sure that the SMC acks the byte sent. 777 * Just wait up to (amount * 10) ms. 778 */ 779 static int 780 asmc_wait_ack(device_t dev, uint8_t val, int amount) 781 { 782 struct asmc_softc *sc = device_get_softc(dev); 783 u_int i; 784 785 val = val & ASMC_STATUS_MASK; 786 787 for (i = 0; i < amount; i++) { 788 if ((ASMC_CMDPORT_READ(sc) & ASMC_STATUS_MASK) == val) 789 return (0); 790 DELAY(10); 791 } 792 793 return (1); 794 } 795 796 /* 797 * We need to make sure that the SMC acks the byte sent. 798 * Just wait up to 100 ms. 799 */ 800 static int 801 asmc_wait(device_t dev, uint8_t val) 802 { 803 struct asmc_softc *sc; 804 805 if (asmc_wait_ack(dev, val, 1000) == 0) 806 return (0); 807 808 sc = device_get_softc(dev); 809 val = val & ASMC_STATUS_MASK; 810 811 #ifdef DEBUG 812 device_printf(dev, "%s failed: 0x%x, 0x%x\n", __func__, val, 813 ASMC_CMDPORT_READ(sc)); 814 #endif 815 return (1); 816 } 817 818 /* 819 * Send the given command, retrying up to 10 times if 820 * the acknowledgement fails. 821 */ 822 static int 823 asmc_command(device_t dev, uint8_t command) { 824 825 int i; 826 struct asmc_softc *sc = device_get_softc(dev); 827 828 for (i=0; i < 10; i++) { 829 ASMC_CMDPORT_WRITE(sc, command); 830 if (asmc_wait_ack(dev, 0x0c, 100) == 0) { 831 return (0); 832 } 833 } 834 835 #ifdef DEBUG 836 device_printf(dev, "%s failed: 0x%x, 0x%x\n", __func__, command, 837 ASMC_CMDPORT_READ(sc)); 838 #endif 839 return (1); 840 } 841 842 static int 843 asmc_key_read(device_t dev, const char *key, uint8_t *buf, uint8_t len) 844 { 845 int i, error = 1, try = 0; 846 struct asmc_softc *sc = device_get_softc(dev); 847 848 mtx_lock_spin(&sc->sc_mtx); 849 850 begin: 851 if (asmc_command(dev, ASMC_CMDREAD)) 852 goto out; 853 854 for (i = 0; i < 4; i++) { 855 ASMC_DATAPORT_WRITE(sc, key[i]); 856 if (asmc_wait(dev, 0x04)) 857 goto out; 858 } 859 860 ASMC_DATAPORT_WRITE(sc, len); 861 862 for (i = 0; i < len; i++) { 863 if (asmc_wait(dev, 0x05)) 864 goto out; 865 buf[i] = ASMC_DATAPORT_READ(sc); 866 } 867 868 error = 0; 869 out: 870 if (error) { 871 if (++try < 10) goto begin; 872 device_printf(dev,"%s for key %s failed %d times, giving up\n", 873 __func__, key, try); 874 } 875 876 mtx_unlock_spin(&sc->sc_mtx); 877 878 return (error); 879 } 880 881 #ifdef DEBUG 882 static int 883 asmc_key_dump(device_t dev, int number) 884 { 885 struct asmc_softc *sc = device_get_softc(dev); 886 char key[5] = { 0 }; 887 char type[7] = { 0 }; 888 uint8_t index[4]; 889 uint8_t v[32]; 890 uint8_t maxlen; 891 int i, error = 1, try = 0; 892 893 mtx_lock_spin(&sc->sc_mtx); 894 895 index[0] = (number >> 24) & 0xff; 896 index[1] = (number >> 16) & 0xff; 897 index[2] = (number >> 8) & 0xff; 898 index[3] = (number) & 0xff; 899 900 begin: 901 if (asmc_command(dev, 0x12)) 902 goto out; 903 904 for (i = 0; i < 4; i++) { 905 ASMC_DATAPORT_WRITE(sc, index[i]); 906 if (asmc_wait(dev, 0x04)) 907 goto out; 908 } 909 910 ASMC_DATAPORT_WRITE(sc, 4); 911 912 for (i = 0; i < 4; i++) { 913 if (asmc_wait(dev, 0x05)) 914 goto out; 915 key[i] = ASMC_DATAPORT_READ(sc); 916 } 917 918 /* get type */ 919 if (asmc_command(dev, 0x13)) 920 goto out; 921 922 for (i = 0; i < 4; i++) { 923 ASMC_DATAPORT_WRITE(sc, key[i]); 924 if (asmc_wait(dev, 0x04)) 925 goto out; 926 } 927 928 ASMC_DATAPORT_WRITE(sc, 6); 929 930 for (i = 0; i < 6; i++) { 931 if (asmc_wait(dev, 0x05)) 932 goto out; 933 type[i] = ASMC_DATAPORT_READ(sc); 934 } 935 936 error = 0; 937 out: 938 if (error) { 939 if (++try < 10) goto begin; 940 device_printf(dev,"%s for key %s failed %d times, giving up\n", 941 __func__, key, try); 942 mtx_unlock_spin(&sc->sc_mtx); 943 } 944 else { 945 char buf[1024]; 946 char buf2[8]; 947 mtx_unlock_spin(&sc->sc_mtx); 948 maxlen = type[0]; 949 type[0] = ' '; 950 type[5] = 0; 951 if (maxlen > sizeof(v)) { 952 device_printf(dev, 953 "WARNING: cropping maxlen from %d to %zu\n", 954 maxlen, sizeof(v)); 955 maxlen = sizeof(v); 956 } 957 for (i = 0; i < sizeof(v); i++) { 958 v[i] = 0; 959 } 960 asmc_key_read(dev, key, v, maxlen); 961 snprintf(buf, sizeof(buf), "key %d is: %s, type %s " 962 "(len %d), data", number, key, type, maxlen); 963 for (i = 0; i < maxlen; i++) { 964 snprintf(buf2, sizeof(buf2), " %02x", v[i]); 965 strlcat(buf, buf2, sizeof(buf)); 966 } 967 strlcat(buf, " \n", sizeof(buf)); 968 device_printf(dev, "%s", buf); 969 } 970 971 return (error); 972 } 973 #endif 974 975 static int 976 asmc_key_write(device_t dev, const char *key, uint8_t *buf, uint8_t len) 977 { 978 int i, error = -1, try = 0; 979 struct asmc_softc *sc = device_get_softc(dev); 980 981 mtx_lock_spin(&sc->sc_mtx); 982 983 begin: 984 ASMC_DPRINTF(("cmd port: cmd write\n")); 985 if (asmc_command(dev, ASMC_CMDWRITE)) 986 goto out; 987 988 ASMC_DPRINTF(("data port: key\n")); 989 for (i = 0; i < 4; i++) { 990 ASMC_DATAPORT_WRITE(sc, key[i]); 991 if (asmc_wait(dev, 0x04)) 992 goto out; 993 } 994 ASMC_DPRINTF(("data port: length\n")); 995 ASMC_DATAPORT_WRITE(sc, len); 996 997 ASMC_DPRINTF(("data port: buffer\n")); 998 for (i = 0; i < len; i++) { 999 if (asmc_wait(dev, 0x04)) 1000 goto out; 1001 ASMC_DATAPORT_WRITE(sc, buf[i]); 1002 } 1003 1004 error = 0; 1005 out: 1006 if (error) { 1007 if (++try < 10) goto begin; 1008 device_printf(dev,"%s for key %s failed %d times, giving up\n", 1009 __func__, key, try); 1010 } 1011 1012 mtx_unlock_spin(&sc->sc_mtx); 1013 1014 return (error); 1015 1016 } 1017 1018 /* 1019 * Fan control functions. 1020 */ 1021 static int 1022 asmc_fan_count(device_t dev) 1023 { 1024 uint8_t buf[1]; 1025 1026 if (asmc_key_read(dev, ASMC_KEY_FANCOUNT, buf, sizeof buf) < 0) 1027 return (-1); 1028 1029 return (buf[0]); 1030 } 1031 1032 static int 1033 asmc_fan_getvalue(device_t dev, const char *key, int fan) 1034 { 1035 int speed; 1036 uint8_t buf[2]; 1037 char fankey[5]; 1038 1039 snprintf(fankey, sizeof(fankey), key, fan); 1040 if (asmc_key_read(dev, fankey, buf, sizeof buf) < 0) 1041 return (-1); 1042 speed = (buf[0] << 6) | (buf[1] >> 2); 1043 1044 return (speed); 1045 } 1046 1047 static char* 1048 asmc_fan_getstring(device_t dev, const char *key, int fan, uint8_t *buf, uint8_t buflen) 1049 { 1050 char fankey[5]; 1051 char* desc; 1052 1053 snprintf(fankey, sizeof(fankey), key, fan); 1054 if (asmc_key_read(dev, fankey, buf, buflen) < 0) 1055 return (NULL); 1056 desc = buf+4; 1057 1058 return (desc); 1059 } 1060 1061 static int 1062 asmc_fan_setvalue(device_t dev, const char *key, int fan, int speed) 1063 { 1064 uint8_t buf[2]; 1065 char fankey[5]; 1066 1067 speed *= 4; 1068 1069 buf[0] = speed>>8; 1070 buf[1] = speed; 1071 1072 snprintf(fankey, sizeof(fankey), key, fan); 1073 if (asmc_key_write(dev, fankey, buf, sizeof buf) < 0) 1074 return (-1); 1075 1076 return (0); 1077 } 1078 1079 static int 1080 asmc_mb_sysctl_fanspeed(SYSCTL_HANDLER_ARGS) 1081 { 1082 device_t dev = (device_t) arg1; 1083 int fan = arg2; 1084 int error; 1085 int32_t v; 1086 1087 v = asmc_fan_getvalue(dev, ASMC_KEY_FANSPEED, fan); 1088 error = sysctl_handle_int(oidp, &v, 0, req); 1089 1090 return (error); 1091 } 1092 1093 static int 1094 asmc_mb_sysctl_fanid(SYSCTL_HANDLER_ARGS) 1095 { 1096 uint8_t buf[16]; 1097 device_t dev = (device_t) arg1; 1098 int fan = arg2; 1099 int error = true; 1100 char* desc; 1101 1102 desc = asmc_fan_getstring(dev, ASMC_KEY_FANID, fan, buf, sizeof(buf)); 1103 1104 if (desc != NULL) 1105 error = sysctl_handle_string(oidp, desc, 0, req); 1106 1107 return (error); 1108 } 1109 1110 static int 1111 asmc_mb_sysctl_fansafespeed(SYSCTL_HANDLER_ARGS) 1112 { 1113 device_t dev = (device_t) arg1; 1114 int fan = arg2; 1115 int error; 1116 int32_t v; 1117 1118 v = asmc_fan_getvalue(dev, ASMC_KEY_FANSAFESPEED, fan); 1119 error = sysctl_handle_int(oidp, &v, 0, req); 1120 1121 return (error); 1122 } 1123 1124 1125 static int 1126 asmc_mb_sysctl_fanminspeed(SYSCTL_HANDLER_ARGS) 1127 { 1128 device_t dev = (device_t) arg1; 1129 int fan = arg2; 1130 int error; 1131 int32_t v; 1132 1133 v = asmc_fan_getvalue(dev, ASMC_KEY_FANMINSPEED, fan); 1134 error = sysctl_handle_int(oidp, &v, 0, req); 1135 1136 if (error == 0 && req->newptr != NULL) { 1137 unsigned int newspeed = v; 1138 asmc_fan_setvalue(dev, ASMC_KEY_FANMINSPEED, fan, newspeed); 1139 } 1140 1141 return (error); 1142 } 1143 1144 static int 1145 asmc_mb_sysctl_fanmaxspeed(SYSCTL_HANDLER_ARGS) 1146 { 1147 device_t dev = (device_t) arg1; 1148 int fan = arg2; 1149 int error; 1150 int32_t v; 1151 1152 v = asmc_fan_getvalue(dev, ASMC_KEY_FANMAXSPEED, fan); 1153 error = sysctl_handle_int(oidp, &v, 0, req); 1154 1155 if (error == 0 && req->newptr != NULL) { 1156 unsigned int newspeed = v; 1157 asmc_fan_setvalue(dev, ASMC_KEY_FANMAXSPEED, fan, newspeed); 1158 } 1159 1160 return (error); 1161 } 1162 1163 static int 1164 asmc_mb_sysctl_fantargetspeed(SYSCTL_HANDLER_ARGS) 1165 { 1166 device_t dev = (device_t) arg1; 1167 int fan = arg2; 1168 int error; 1169 int32_t v; 1170 1171 v = asmc_fan_getvalue(dev, ASMC_KEY_FANTARGETSPEED, fan); 1172 error = sysctl_handle_int(oidp, &v, 0, req); 1173 1174 if (error == 0 && req->newptr != NULL) { 1175 unsigned int newspeed = v; 1176 asmc_fan_setvalue(dev, ASMC_KEY_FANTARGETSPEED, fan, newspeed); 1177 } 1178 1179 return (error); 1180 } 1181 1182 /* 1183 * Temperature functions. 1184 */ 1185 static int 1186 asmc_temp_getvalue(device_t dev, const char *key) 1187 { 1188 uint8_t buf[2]; 1189 1190 /* 1191 * Check for invalid temperatures. 1192 */ 1193 if (asmc_key_read(dev, key, buf, sizeof buf) < 0) 1194 return (-1); 1195 1196 return (buf[0]); 1197 } 1198 1199 static int 1200 asmc_temp_sysctl(SYSCTL_HANDLER_ARGS) 1201 { 1202 device_t dev = (device_t) arg1; 1203 struct asmc_softc *sc = device_get_softc(dev); 1204 int error, val; 1205 1206 val = asmc_temp_getvalue(dev, sc->sc_model->smc_temps[arg2]); 1207 error = sysctl_handle_int(oidp, &val, 0, req); 1208 1209 return (error); 1210 } 1211 1212 /* 1213 * Sudden Motion Sensor functions. 1214 */ 1215 static int 1216 asmc_sms_read(device_t dev, const char *key, int16_t *val) 1217 { 1218 uint8_t buf[2]; 1219 int error; 1220 1221 /* no need to do locking here as asmc_key_read() already does it */ 1222 switch (key[3]) { 1223 case 'X': 1224 case 'Y': 1225 case 'Z': 1226 error = asmc_key_read(dev, key, buf, sizeof buf); 1227 break; 1228 default: 1229 device_printf(dev, "%s called with invalid argument %s\n", 1230 __func__, key); 1231 error = 1; 1232 goto out; 1233 } 1234 *val = ((int16_t)buf[0] << 8) | buf[1]; 1235 out: 1236 return (error); 1237 } 1238 1239 static void 1240 asmc_sms_calibrate(device_t dev) 1241 { 1242 struct asmc_softc *sc = device_get_softc(dev); 1243 1244 asmc_sms_read(dev, ASMC_KEY_SMS_X, &sc->sms_rest_x); 1245 asmc_sms_read(dev, ASMC_KEY_SMS_Y, &sc->sms_rest_y); 1246 asmc_sms_read(dev, ASMC_KEY_SMS_Z, &sc->sms_rest_z); 1247 } 1248 1249 static int 1250 asmc_sms_intrfast(void *arg) 1251 { 1252 uint8_t type; 1253 device_t dev = (device_t) arg; 1254 struct asmc_softc *sc = device_get_softc(dev); 1255 if (!sc->sc_sms_intr_works) 1256 return (FILTER_HANDLED); 1257 1258 mtx_lock_spin(&sc->sc_mtx); 1259 type = ASMC_INTPORT_READ(sc); 1260 mtx_unlock_spin(&sc->sc_mtx); 1261 1262 sc->sc_sms_intrtype = type; 1263 asmc_sms_printintr(dev, type); 1264 1265 taskqueue_enqueue(sc->sc_sms_tq, &sc->sc_sms_task); 1266 return (FILTER_HANDLED); 1267 } 1268 1269 1270 1271 static void 1272 asmc_sms_printintr(device_t dev, uint8_t type) 1273 { 1274 1275 switch (type) { 1276 case ASMC_SMS_INTFF: 1277 device_printf(dev, "WARNING: possible free fall!\n"); 1278 break; 1279 case ASMC_SMS_INTHA: 1280 device_printf(dev, "WARNING: high acceleration detected!\n"); 1281 break; 1282 case ASMC_SMS_INTSH: 1283 device_printf(dev, "WARNING: possible shock!\n"); 1284 break; 1285 default: 1286 device_printf(dev, "%s unknown interrupt\n", __func__); 1287 } 1288 } 1289 1290 static void 1291 asmc_sms_task(void *arg, int pending) 1292 { 1293 struct asmc_softc *sc = (struct asmc_softc *)arg; 1294 char notify[16]; 1295 int type; 1296 1297 switch (sc->sc_sms_intrtype) { 1298 case ASMC_SMS_INTFF: 1299 type = 2; 1300 break; 1301 case ASMC_SMS_INTHA: 1302 type = 1; 1303 break; 1304 case ASMC_SMS_INTSH: 1305 type = 0; 1306 break; 1307 default: 1308 type = 255; 1309 } 1310 1311 snprintf(notify, sizeof(notify), " notify=0x%x", type); 1312 devctl_notify("ACPI", "asmc", "SMS", notify); 1313 } 1314 1315 static int 1316 asmc_mb_sysctl_sms_x(SYSCTL_HANDLER_ARGS) 1317 { 1318 device_t dev = (device_t) arg1; 1319 int error; 1320 int16_t val; 1321 int32_t v; 1322 1323 asmc_sms_read(dev, ASMC_KEY_SMS_X, &val); 1324 v = (int32_t) val; 1325 error = sysctl_handle_int(oidp, &v, 0, req); 1326 1327 return (error); 1328 } 1329 1330 static int 1331 asmc_mb_sysctl_sms_y(SYSCTL_HANDLER_ARGS) 1332 { 1333 device_t dev = (device_t) arg1; 1334 int error; 1335 int16_t val; 1336 int32_t v; 1337 1338 asmc_sms_read(dev, ASMC_KEY_SMS_Y, &val); 1339 v = (int32_t) val; 1340 error = sysctl_handle_int(oidp, &v, 0, req); 1341 1342 return (error); 1343 } 1344 1345 static int 1346 asmc_mb_sysctl_sms_z(SYSCTL_HANDLER_ARGS) 1347 { 1348 device_t dev = (device_t) arg1; 1349 int error; 1350 int16_t val; 1351 int32_t v; 1352 1353 asmc_sms_read(dev, ASMC_KEY_SMS_Z, &val); 1354 v = (int32_t) val; 1355 error = sysctl_handle_int(oidp, &v, 0, req); 1356 1357 return (error); 1358 } 1359 1360 static int 1361 asmc_mbp_sysctl_light_left(SYSCTL_HANDLER_ARGS) 1362 { 1363 device_t dev = (device_t) arg1; 1364 uint8_t buf[6]; 1365 int error; 1366 int32_t v; 1367 1368 asmc_key_read(dev, ASMC_KEY_LIGHTLEFT, buf, sizeof buf); 1369 v = buf[2]; 1370 error = sysctl_handle_int(oidp, &v, 0, req); 1371 1372 return (error); 1373 } 1374 1375 static int 1376 asmc_mbp_sysctl_light_right(SYSCTL_HANDLER_ARGS) 1377 { 1378 device_t dev = (device_t) arg1; 1379 uint8_t buf[6]; 1380 int error; 1381 int32_t v; 1382 1383 asmc_key_read(dev, ASMC_KEY_LIGHTRIGHT, buf, sizeof buf); 1384 v = buf[2]; 1385 error = sysctl_handle_int(oidp, &v, 0, req); 1386 1387 return (error); 1388 } 1389 1390 static int 1391 asmc_mbp_sysctl_light_control(SYSCTL_HANDLER_ARGS) 1392 { 1393 device_t dev = (device_t) arg1; 1394 uint8_t buf[2]; 1395 int error; 1396 int v; 1397 1398 v = light_control; 1399 error = sysctl_handle_int(oidp, &v, 0, req); 1400 1401 if (error == 0 && req->newptr != NULL) { 1402 if (v < 0 || v > 255) 1403 return (EINVAL); 1404 light_control = v; 1405 buf[0] = light_control; 1406 buf[1] = 0x00; 1407 asmc_key_write(dev, ASMC_KEY_LIGHTVALUE, buf, sizeof buf); 1408 } 1409 return (error); 1410 } 1411