sys/dev/asmc/asmc.c

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