sys/dev/asmc/asmc.c

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