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