drivers/misc/thinkpad_acpi.c

   1 /*
   2  *  thinkpad_acpi.c - ThinkPad ACPI Extras
   3  *
   4  *
   5  *  Copyright (C) 2004-2005 Borislav Deianov <borislav@users.sf.net>
   6  *  Copyright (C) 2006-2007 Henrique de Moraes Holschuh <hmh@hmh.eng.br>
   7  *
   8  *  This program is free software; you can redistribute it and/or modify
   9  *  it under the terms of the GNU General Public License as published by
  10  *  the Free Software Foundation; either version 2 of the License, or
  11  *  (at your option) any later version.
  12  *
  13  *  This program is distributed in the hope that it will be useful,
  14  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  *  GNU General Public License for more details.
  17  *
  18  *  You should have received a copy of the GNU General Public License
  19  *  along with this program; if not, write to the Free Software
  20  *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
  21  *  02110-1301, USA.
  22  */
  23
  24 #define IBM_VERSION "0.16"
  25 #define TPACPI_SYSFS_VERSION 0x010000
  26
  27 /*
  28  *  Changelog:
  29  *  2007-03-27  0.14    renamed to thinkpad_acpi and moved to
  30  *                      drivers/misc.
  31  *
  32  *  2006-11-22  0.13    new maintainer
  33  *                      changelog now lives in git commit history, and will
  34  *                      not be updated further in-file.
  35  *
  36  *  2005-08-17  0.12    fix compilation on 2.6.13-rc kernels
  37  *  2005-03-17  0.11    support for 600e, 770x
  38  *                          thanks to Jamie Lentin <lentinj@dial.pipex.com>
  39  *                      support for 770e, G41
  40  *                      G40 and G41 don't have a thinklight
  41  *                      temperatures no longer experimental
  42  *                      experimental brightness control
  43  *                      experimental volume control
  44  *                      experimental fan enable/disable
  45  *  2005-01-16  0.10    fix module loading on R30, R31
  46  *  2005-01-16  0.9     support for 570, R30, R31
  47  *                      ultrabay support on A22p, A3x
  48  *                      limit arg for cmos, led, beep, drop experimental status
  49  *                      more capable led control on A21e, A22p, T20-22, X20
  50  *                      experimental temperatures and fan speed
  51  *                      experimental embedded controller register dump
  52  *                      mark more functions as __init, drop incorrect __exit
  53  *                      use MODULE_VERSION
  54  *                          thanks to Henrik Brix Andersen <brix@gentoo.org>
  55  *                      fix parameter passing on module loading
  56  *                          thanks to Rusty Russell <rusty@rustcorp.com.au>
  57  *                          thanks to Jim Radford <radford@blackbean.org>
  58  *  2004-11-08  0.8     fix init error case, don't return from a macro
  59  *                          thanks to Chris Wright <chrisw@osdl.org>
  60  *  2004-10-23  0.7     fix module loading on A21e, A22p, T20, T21, X20
  61  *                      fix led control on A21e
  62  *  2004-10-19  0.6     use acpi_bus_register_driver() to claim HKEY device
  63  *  2004-10-18  0.5     thinklight support on A21e, G40, R32, T20, T21, X20
  64  *                      proc file format changed
  65  *                      video_switch command
  66  *                      experimental cmos control
  67  *                      experimental led control
  68  *                      experimental acpi sounds
  69  *  2004-09-16  0.4     support for module parameters
  70  *                      hotkey mask can be prefixed by 0x
  71  *                      video output switching
  72  *                      video expansion control
  73  *                      ultrabay eject support
  74  *                      removed lcd brightness/on/off control, didn't work
  75  *  2004-08-17  0.3     support for R40
  76  *                      lcd off, brightness control
  77  *                      thinklight on/off
  78  *  2004-08-14  0.2     support for T series, X20
  79  *                      bluetooth enable/disable
  80  *                      hotkey events disabled by default
  81  *                      removed fan control, currently useless
  82  *  2004-08-09  0.1     initial release, support for X series
  83  */
  84
  85 #include "thinkpad_acpi.h"
  86
  87 MODULE_AUTHOR("Borislav Deianov, Henrique de Moraes Holschuh");
  88 MODULE_DESCRIPTION(IBM_DESC);
  89 MODULE_VERSION(IBM_VERSION);
  90 MODULE_LICENSE("GPL");
  91
  92 /* Please remove this in year 2009 */
  93 MODULE_ALIAS("ibm_acpi");
  94
  95 /*
  96  * DMI matching for module autoloading
  97  *
  98  * See http://thinkwiki.org/wiki/List_of_DMI_IDs
  99  * See http://thinkwiki.org/wiki/BIOS_Upgrade_Downloads
 100  *
 101  * Only models listed in thinkwiki will be supported, so add yours
 102  * if it is not there yet.
 103  */
 104 #define IBM_BIOS_MODULE_ALIAS(__type) \
 105         MODULE_ALIAS("dmi:bvnIBM:bvr" __type "ET??WW")
 106
 107 /* Non-ancient thinkpads */
 108 MODULE_ALIAS("dmi:bvnIBM:*:svnIBM:*:pvrThinkPad*:rvnIBM:*");
 109 MODULE_ALIAS("dmi:bvnLENOVO:*:svnLENOVO:*:pvrThinkPad*:rvnLENOVO:*");
 110
 111 /* Ancient thinkpad BIOSes have to be identified by
 112  * BIOS type or model number, and there are far less
 113  * BIOS types than model numbers... */
 114 IBM_BIOS_MODULE_ALIAS("I[B,D,H,I,M,N,O,T,W,V,Y,Z]");
 115 IBM_BIOS_MODULE_ALIAS("1[0,3,6,8,A-G,I,K,M-P,S,T]");
 116 IBM_BIOS_MODULE_ALIAS("K[U,X-Z]");
 117
 118 #define __unused __attribute__ ((unused))
 119
 120 /****************************************************************************
 121  ****************************************************************************
 122  *
 123  * ACPI Helpers and device model
 124  *
 125  ****************************************************************************
 126  ****************************************************************************/
 127
 128 /*************************************************************************
 129  * ACPI basic handles
 130  */
 131
 132 static acpi_handle root_handle;
 133
 134 #define IBM_HANDLE(object, parent, paths...)                    \
 135         static acpi_handle  object##_handle;                    \
 136         static acpi_handle *object##_parent = &parent##_handle; \
 137         static char        *object##_path;                      \
 138         static char        *object##_paths[] = { paths }
 139
 140 IBM_HANDLE(ec, root, "\\_SB.PCI0.ISA.EC0",      /* 240, 240x */
 141            "\\_SB.PCI.ISA.EC",  /* 570 */
 142            "\\_SB.PCI0.ISA0.EC0",       /* 600e/x, 770e, 770x */
 143            "\\_SB.PCI0.ISA.EC", /* A21e, A2xm/p, T20-22, X20-21 */
 144            "\\_SB.PCI0.AD4S.EC0",       /* i1400, R30 */
 145            "\\_SB.PCI0.ICH3.EC0",       /* R31 */
 146            "\\_SB.PCI0.LPC.EC", /* all others */
 147            );
 148
 149 IBM_HANDLE(ecrd, ec, "ECRD");   /* 570 */
 150 IBM_HANDLE(ecwr, ec, "ECWR");   /* 570 */
 151
 152
 153 /*************************************************************************
 154  * Misc ACPI handles
 155  */
 156
 157 IBM_HANDLE(cmos, root, "\\UCMS",        /* R50, R50e, R50p, R51, T4x, X31, X40 */
 158            "\\CMOS",            /* A3x, G4x, R32, T23, T30, X22-24, X30 */
 159            "\\CMS",             /* R40, R40e */
 160            );                   /* all others */
 161
 162 IBM_HANDLE(hkey, ec, "\\_SB.HKEY",      /* 600e/x, 770e, 770x */
 163            "^HKEY",             /* R30, R31 */
 164            "HKEY",              /* all others */
 165            );                   /* 570 */
 166
 167
 168 /*************************************************************************
 169  * ACPI helpers
 170  */
 171
 172 static int acpi_evalf(acpi_handle handle,
 173                       void *res, char *method, char *fmt, ...)
 174 {
 175         char *fmt0 = fmt;
 176         struct acpi_object_list params;
 177         union acpi_object in_objs[IBM_MAX_ACPI_ARGS];
 178         struct acpi_buffer result, *resultp;
 179         union acpi_object out_obj;
 180         acpi_status status;
 181         va_list ap;
 182         char res_type;
 183         int success;
 184         int quiet;
 185
 186         if (!*fmt) {
 187                 printk(IBM_ERR "acpi_evalf() called with empty format\n");
 188                 return 0;
 189         }
 190
 191         if (*fmt == 'q') {
 192                 quiet = 1;
 193                 fmt++;
 194         } else
 195                 quiet = 0;
 196
 197         res_type = *(fmt++);
 198
 199         params.count = 0;
 200         params.pointer = &in_objs[0];
 201
 202         va_start(ap, fmt);
 203         while (*fmt) {
 204                 char c = *(fmt++);
 205                 switch (c) {
 206                 case 'd':       /* int */
 207                         in_objs[params.count].integer.value = va_arg(ap, int);
 208                         in_objs[params.count++].type = ACPI_TYPE_INTEGER;
 209                         break;
 210                         /* add more types as needed */
 211                 default:
 212                         printk(IBM_ERR "acpi_evalf() called "
 213                                "with invalid format character '%c'\n", c);
 214                         return 0;
 215                 }
 216         }
 217         va_end(ap);
 218
 219         if (res_type != 'v') {
 220                 result.length = sizeof(out_obj);
 221                 result.pointer = &out_obj;
 222                 resultp = &result;
 223         } else
 224                 resultp = NULL;
 225
 226         status = acpi_evaluate_object(handle, method, &params, resultp);
 227
 228         switch (res_type) {
 229         case 'd':               /* int */
 230                 if (res)
 231                         *(int *)res = out_obj.integer.value;
 232                 success = status == AE_OK && out_obj.type == ACPI_TYPE_INTEGER;
 233                 break;
 234         case 'v':               /* void */
 235                 success = status == AE_OK;
 236                 break;
 237                 /* add more types as needed */
 238         default:
 239                 printk(IBM_ERR "acpi_evalf() called "
 240                        "with invalid format character '%c'\n", res_type);
 241                 return 0;
 242         }
 243
 244         if (!success && !quiet)
 245                 printk(IBM_ERR "acpi_evalf(%s, %s, ...) failed: %d\n",
 246                        method, fmt0, status);
 247
 248         return success;
 249 }
 250
 251 static void __unused acpi_print_int(acpi_handle handle, char *method)
 252 {
 253         int i;
 254
 255         if (acpi_evalf(handle, &i, method, "d"))
 256                 printk(IBM_INFO "%s = 0x%x\n", method, i);
 257         else
 258                 printk(IBM_ERR "error calling %s\n", method);
 259 }
 260
 261 static int acpi_ec_read(int i, u8 * p)
 262 {
 263         int v;
 264
 265         if (ecrd_handle) {
 266                 if (!acpi_evalf(ecrd_handle, &v, NULL, "dd", i))
 267                         return 0;
 268                 *p = v;
 269         } else {
 270                 if (ec_read(i, p) < 0)
 271                         return 0;
 272         }
 273
 274         return 1;
 275 }
 276
 277 static int acpi_ec_write(int i, u8 v)
 278 {
 279         if (ecwr_handle) {
 280                 if (!acpi_evalf(ecwr_handle, NULL, NULL, "vdd", i, v))
 281                         return 0;
 282         } else {
 283                 if (ec_write(i, v) < 0)
 284                         return 0;
 285         }
 286
 287         return 1;
 288 }
 289
 290 static int _sta(acpi_handle handle)
 291 {
 292         int status;
 293
 294         if (!handle || !acpi_evalf(handle, &status, "_STA", "d"))
 295                 status = 0;
 296
 297         return status;
 298 }
 299
 300 static int issue_thinkpad_cmos_command(int cmos_cmd)
 301 {
 302         if (!cmos_handle)
 303                 return -ENXIO;
 304
 305         if (!acpi_evalf(cmos_handle, NULL, NULL, "vd", cmos_cmd))
 306                 return -EIO;
 307
 308         return 0;
 309 }
 310
 311 /*************************************************************************
 312  * ACPI device model
 313  */
 314
 315 static void drv_acpi_handle_init(char *name,
 316                            acpi_handle *handle, acpi_handle parent,
 317                            char **paths, int num_paths, char **path)
 318 {
 319         int i;
 320         acpi_status status;
 321
 322         vdbg_printk(TPACPI_DBG_INIT, "trying to locate ACPI handle for %s\n",
 323                 name);
 324
 325         for (i = 0; i < num_paths; i++) {
 326                 status = acpi_get_handle(parent, paths[i], handle);
 327                 if (ACPI_SUCCESS(status)) {
 328                         *path = paths[i];
 329                         dbg_printk(TPACPI_DBG_INIT,
 330                                    "Found ACPI handle %s for %s\n",
 331                                    *path, name);
 332                         return;
 333                 }
 334         }
 335
 336         vdbg_printk(TPACPI_DBG_INIT, "ACPI handle for %s not found\n",
 337                     name);
 338         *handle = NULL;
 339 }
 340
 341 static void dispatch_acpi_notify(acpi_handle handle, u32 event, void *data)
 342 {
 343         struct ibm_struct *ibm = data;
 344
 345         if (!ibm || !ibm->acpi || !ibm->acpi->notify)
 346                 return;
 347
 348         ibm->acpi->notify(ibm, event);
 349 }
 350
 351 static int __init setup_acpi_notify(struct ibm_struct *ibm)
 352 {
 353         acpi_status status;
 354         int rc;
 355
 356         BUG_ON(!ibm->acpi);
 357
 358         if (!*ibm->acpi->handle)
 359                 return 0;
 360
 361         vdbg_printk(TPACPI_DBG_INIT,
 362                 "setting up ACPI notify for %s\n", ibm->name);
 363
 364         rc = acpi_bus_get_device(*ibm->acpi->handle, &ibm->acpi->device);
 365         if (rc < 0) {
 366                 printk(IBM_ERR "acpi_bus_get_device(%s) failed: %d\n",
 367                         ibm->name, rc);
 368                 return -ENODEV;
 369         }
 370
 371         acpi_driver_data(ibm->acpi->device) = ibm;
 372         sprintf(acpi_device_class(ibm->acpi->device), "%s/%s",
 373                 IBM_ACPI_EVENT_PREFIX,
 374                 ibm->name);
 375
 376         status = acpi_install_notify_handler(*ibm->acpi->handle,
 377                         ibm->acpi->type, dispatch_acpi_notify, ibm);
 378         if (ACPI_FAILURE(status)) {
 379                 if (status == AE_ALREADY_EXISTS) {
 380                         printk(IBM_NOTICE "another device driver is already handling %s events\n",
 381                                 ibm->name);
 382                 } else {
 383                         printk(IBM_ERR "acpi_install_notify_handler(%s) failed: %d\n",
 384                                 ibm->name, status);
 385                 }
 386                 return -ENODEV;
 387         }
 388         ibm->flags.acpi_notify_installed = 1;
 389         return 0;
 390 }
 391
 392 static int __init tpacpi_device_add(struct acpi_device *device)
 393 {
 394         return 0;
 395 }
 396
 397 static int __init register_tpacpi_subdriver(struct ibm_struct *ibm)
 398 {
 399         int rc;
 400
 401         dbg_printk(TPACPI_DBG_INIT,
 402                 "registering %s as an ACPI driver\n", ibm->name);
 403
 404         BUG_ON(!ibm->acpi);
 405
 406         ibm->acpi->driver = kzalloc(sizeof(struct acpi_driver), GFP_KERNEL);
 407         if (!ibm->acpi->driver) {
 408                 printk(IBM_ERR "kzalloc(ibm->driver) failed\n");
 409                 return -ENOMEM;
 410         }
 411
 412         sprintf(ibm->acpi->driver->name, "%s_%s", IBM_NAME, ibm->name);
 413         ibm->acpi->driver->ids = ibm->acpi->hid;
 414
 415         ibm->acpi->driver->ops.add = &tpacpi_device_add;
 416
 417         rc = acpi_bus_register_driver(ibm->acpi->driver);
 418         if (rc < 0) {
 419                 printk(IBM_ERR "acpi_bus_register_driver(%s) failed: %d\n",
 420                        ibm->name, rc);
 421                 kfree(ibm->acpi->driver);
 422                 ibm->acpi->driver = NULL;
 423         } else if (!rc)
 424                 ibm->flags.acpi_driver_registered = 1;
 425
 426         return rc;
 427 }
 428
 429
 430 /****************************************************************************
 431  ****************************************************************************
 432  *
 433  * Procfs Helpers
 434  *
 435  ****************************************************************************
 436  ****************************************************************************/
 437
 438 static int dispatch_procfs_read(char *page, char **start, off_t off,
 439                         int count, int *eof, void *data)
 440 {
 441         struct ibm_struct *ibm = data;
 442         int len;
 443
 444         if (!ibm || !ibm->read)
 445                 return -EINVAL;
 446
 447         len = ibm->read(page);
 448         if (len < 0)
 449                 return len;
 450
 451         if (len <= off + count)
 452                 *eof = 1;
 453         *start = page + off;
 454         len -= off;
 455         if (len > count)
 456                 len = count;
 457         if (len < 0)
 458                 len = 0;
 459
 460         return len;
 461 }
 462
 463 static int dispatch_procfs_write(struct file *file,
 464                         const char __user * userbuf,
 465                         unsigned long count, void *data)
 466 {
 467         struct ibm_struct *ibm = data;
 468         char *kernbuf;
 469         int ret;
 470
 471         if (!ibm || !ibm->write)
 472                 return -EINVAL;
 473
 474         kernbuf = kmalloc(count + 2, GFP_KERNEL);
 475         if (!kernbuf)
 476                 return -ENOMEM;
 477
 478         if (copy_from_user(kernbuf, userbuf, count)) {
 479                 kfree(kernbuf);
 480                 return -EFAULT;
 481         }
 482
 483         kernbuf[count] = 0;
 484         strcat(kernbuf, ",");
 485         ret = ibm->write(kernbuf);
 486         if (ret == 0)
 487                 ret = count;
 488
 489         kfree(kernbuf);
 490
 491         return ret;
 492 }
 493
 494 static char *next_cmd(char **cmds)
 495 {
 496         char *start = *cmds;
 497         char *end;
 498
 499         while ((end = strchr(start, ',')) && end == start)
 500                 start = end + 1;
 501
 502         if (!end)
 503                 return NULL;
 504
 505         *end = 0;
 506         *cmds = end + 1;
 507         return start;
 508 }
 509
 510
 511 /****************************************************************************
 512  ****************************************************************************
 513  *
 514  * Device model: input, hwmon and platform
 515  *
 516  ****************************************************************************
 517  ****************************************************************************/
 518
 519 static struct platform_device *tpacpi_pdev;
 520 static struct class_device *tpacpi_hwmon;
 521 static struct input_dev *tpacpi_inputdev;
 522
 523
 524 static int tpacpi_resume_handler(struct platform_device *pdev)
 525 {
 526         struct ibm_struct *ibm, *itmp;
 527
 528         list_for_each_entry_safe(ibm, itmp,
 529                                  &tpacpi_all_drivers,
 530                                  all_drivers) {
 531                 if (ibm->resume)
 532                         (ibm->resume)();
 533         }
 534
 535         return 0;
 536 }
 537
 538 static struct platform_driver tpacpi_pdriver = {
 539         .driver = {
 540                 .name = IBM_DRVR_NAME,
 541                 .owner = THIS_MODULE,
 542         },
 543         .resume = tpacpi_resume_handler,
 544 };
 545
 546
 547 /*************************************************************************
 548  * thinkpad-acpi driver attributes
 549  */
 550
 551 /* interface_version --------------------------------------------------- */
 552 static ssize_t tpacpi_driver_interface_version_show(
 553                                 struct device_driver *drv,
 554                                 char *buf)
 555 {
 556         return snprintf(buf, PAGE_SIZE, "0x%08x\n", TPACPI_SYSFS_VERSION);
 557 }
 558
 559 static DRIVER_ATTR(interface_version, S_IRUGO,
 560                 tpacpi_driver_interface_version_show, NULL);
 561
 562 /* debug_level --------------------------------------------------------- */
 563 static ssize_t tpacpi_driver_debug_show(struct device_driver *drv,
 564                                                 char *buf)
 565 {
 566         return snprintf(buf, PAGE_SIZE, "0x%04x\n", dbg_level);
 567 }
 568
 569 static ssize_t tpacpi_driver_debug_store(struct device_driver *drv,
 570                                                 const char *buf, size_t count)
 571 {
 572         unsigned long t;
 573
 574         if (parse_strtoul(buf, 0xffff, &t))
 575                 return -EINVAL;
 576
 577         dbg_level = t;
 578
 579         return count;
 580 }
 581
 582 static DRIVER_ATTR(debug_level, S_IWUSR | S_IRUGO,
 583                 tpacpi_driver_debug_show, tpacpi_driver_debug_store);
 584
 585 /* version ------------------------------------------------------------- */
 586 static ssize_t tpacpi_driver_version_show(struct device_driver *drv,
 587                                                 char *buf)
 588 {
 589         return snprintf(buf, PAGE_SIZE, "%s v%s\n", IBM_DESC, IBM_VERSION);
 590 }
 591
 592 static DRIVER_ATTR(version, S_IRUGO,
 593                 tpacpi_driver_version_show, NULL);
 594
 595 /* --------------------------------------------------------------------- */
 596
 597 static struct driver_attribute* tpacpi_driver_attributes[] = {
 598         &driver_attr_debug_level, &driver_attr_version,
 599         &driver_attr_interface_version,
 600 };
 601
 602 static int __init tpacpi_create_driver_attributes(struct device_driver *drv)
 603 {
 604         int i, res;
 605
 606         i = 0;
 607         res = 0;
 608         while (!res && i < ARRAY_SIZE(tpacpi_driver_attributes)) {
 609                 res = driver_create_file(drv, tpacpi_driver_attributes[i]);
 610                 i++;
 611         }
 612
 613         return res;
 614 }
 615
 616 static void tpacpi_remove_driver_attributes(struct device_driver *drv)
 617 {
 618         int i;
 619
 620         for(i = 0; i < ARRAY_SIZE(tpacpi_driver_attributes); i++)
 621                 driver_remove_file(drv, tpacpi_driver_attributes[i]);
 622 }
 623
 624 /*************************************************************************
 625  * sysfs support helpers
 626  */
 627
 628 struct attribute_set_obj {
 629         struct attribute_set s;
 630         struct attribute *a;
 631 } __attribute__((packed));
 632
 633 static struct attribute_set *create_attr_set(unsigned int max_members,
 634                                                 const char* name)
 635 {
 636         struct attribute_set_obj *sobj;
 637
 638         if (max_members == 0)
 639                 return NULL;
 640
 641         /* Allocates space for implicit NULL at the end too */
 642         sobj = kzalloc(sizeof(struct attribute_set_obj) +
 643                     max_members * sizeof(struct attribute *),
 644                     GFP_KERNEL);
 645         if (!sobj)
 646                 return NULL;
 647         sobj->s.max_members = max_members;
 648         sobj->s.group.attrs = &sobj->a;
 649         sobj->s.group.name = name;
 650
 651         return &sobj->s;
 652 }
 653
 654 /* not multi-threaded safe, use it in a single thread per set */
 655 static int add_to_attr_set(struct attribute_set* s, struct attribute *attr)
 656 {
 657         if (!s || !attr)
 658                 return -EINVAL;
 659
 660         if (s->members >= s->max_members)
 661                 return -ENOMEM;
 662
 663         s->group.attrs[s->members] = attr;
 664         s->members++;
 665
 666         return 0;
 667 }
 668
 669 static int add_many_to_attr_set(struct attribute_set* s,
 670                         struct attribute **attr,
 671                         unsigned int count)
 672 {
 673         int i, res;
 674
 675         for (i = 0; i < count; i++) {
 676                 res = add_to_attr_set(s, attr[i]);
 677                 if (res)
 678                         return res;
 679         }
 680
 681         return 0;
 682 }
 683
 684 static void delete_attr_set(struct attribute_set* s, struct kobject *kobj)
 685 {
 686         sysfs_remove_group(kobj, &s->group);
 687         destroy_attr_set(s);
 688 }
 689
 690 static int parse_strtoul(const char *buf,
 691                 unsigned long max, unsigned long *value)
 692 {
 693         char *endp;
 694
 695         *value = simple_strtoul(buf, &endp, 0);
 696         while (*endp && isspace(*endp))
 697                 endp++;
 698         if (*endp || *value > max)
 699                 return -EINVAL;
 700
 701         return 0;
 702 }
 703
 704 /****************************************************************************
 705  ****************************************************************************
 706  *
 707  * Subdrivers
 708  *
 709  ****************************************************************************
 710  ****************************************************************************/
 711
 712 /*************************************************************************
 713  * thinkpad-acpi init subdriver
 714  */
 715
 716 static int __init thinkpad_acpi_driver_init(struct ibm_init_struct *iibm)
 717 {
 718         printk(IBM_INFO "%s v%s\n", IBM_DESC, IBM_VERSION);
 719         printk(IBM_INFO "%s\n", IBM_URL);
 720
 721         printk(IBM_INFO "ThinkPad BIOS %s, EC %s\n",
 722                 (thinkpad_id.bios_version_str) ?
 723                         thinkpad_id.bios_version_str : "unknown",
 724                 (thinkpad_id.ec_version_str) ?
 725                         thinkpad_id.ec_version_str : "unknown");
 726
 727         if (thinkpad_id.vendor && thinkpad_id.model_str)
 728                 printk(IBM_INFO "%s %s\n",
 729                         (thinkpad_id.vendor == PCI_VENDOR_ID_IBM) ?
 730                                 "IBM" : ((thinkpad_id.vendor ==
 731                                                 PCI_VENDOR_ID_LENOVO) ?
 732                                         "Lenovo" : "Unknown vendor"),
 733                         thinkpad_id.model_str);
 734
 735         return 0;
 736 }
 737
 738 static int thinkpad_acpi_driver_read(char *p)
 739 {
 740         int len = 0;
 741
 742         len += sprintf(p + len, "driver:\t\t%s\n", IBM_DESC);
 743         len += sprintf(p + len, "version:\t%s\n", IBM_VERSION);
 744
 745         return len;
 746 }
 747
 748 static struct ibm_struct thinkpad_acpi_driver_data = {
 749         .name = "driver",
 750         .read = thinkpad_acpi_driver_read,
 751 };
 752
 753 /*************************************************************************
 754  * Hotkey subdriver
 755  */
 756
 757 static int hotkey_orig_status;
 758 static u32 hotkey_orig_mask;
 759 static u32 hotkey_all_mask;
 760 static u32 hotkey_reserved_mask;
 761
 762 static u16 *hotkey_keycode_map;
 763
 764 static struct attribute_set *hotkey_dev_attributes;
 765
 766 static int hotkey_get_wlsw(int *status)
 767 {
 768         if (!acpi_evalf(hkey_handle, status, "WLSW", "d"))
 769                 return -EIO;
 770         return 0;
 771 }
 772
 773 /* sysfs hotkey enable ------------------------------------------------- */
 774 static ssize_t hotkey_enable_show(struct device *dev,
 775                            struct device_attribute *attr,
 776                            char *buf)
 777 {
 778         int res, status;
 779         u32 mask;
 780
 781         res = hotkey_get(&status, &mask);
 782         if (res)
 783                 return res;
 784
 785         return snprintf(buf, PAGE_SIZE, "%d\n", status);
 786 }
 787
 788 static ssize_t hotkey_enable_store(struct device *dev,
 789                             struct device_attribute *attr,
 790                             const char *buf, size_t count)
 791 {
 792         unsigned long t;
 793         int res, status;
 794         u32 mask;
 795
 796         if (parse_strtoul(buf, 1, &t))
 797                 return -EINVAL;
 798
 799         res = hotkey_get(&status, &mask);
 800         if (!res)
 801                 res = hotkey_set(t, mask);
 802
 803         return (res) ? res : count;
 804 }
 805
 806 static struct device_attribute dev_attr_hotkey_enable =
 807         __ATTR(hotkey_enable, S_IWUSR | S_IRUGO,
 808                 hotkey_enable_show, hotkey_enable_store);
 809
 810 /* sysfs hotkey mask --------------------------------------------------- */
 811 static ssize_t hotkey_mask_show(struct device *dev,
 812                            struct device_attribute *attr,
 813                            char *buf)
 814 {
 815         int res, status;
 816         u32 mask;
 817
 818         res = hotkey_get(&status, &mask);
 819         if (res)
 820                 return res;
 821
 822         return snprintf(buf, PAGE_SIZE, "0x%08x\n", mask);
 823 }
 824
 825 static ssize_t hotkey_mask_store(struct device *dev,
 826                             struct device_attribute *attr,
 827                             const char *buf, size_t count)
 828 {
 829         unsigned long t;
 830         int res, status;
 831         u32 mask;
 832
 833         if (parse_strtoul(buf, 0xffffffffUL, &t))
 834                 return -EINVAL;
 835
 836         res = hotkey_get(&status, &mask);
 837         if (!res)
 838                 hotkey_set(status, t);
 839
 840         return (res) ? res : count;
 841 }
 842
 843 static struct device_attribute dev_attr_hotkey_mask =
 844         __ATTR(hotkey_mask, S_IWUSR | S_IRUGO,
 845                 hotkey_mask_show, hotkey_mask_store);
 846
 847 /* sysfs hotkey bios_enabled ------------------------------------------- */
 848 static ssize_t hotkey_bios_enabled_show(struct device *dev,
 849                            struct device_attribute *attr,
 850                            char *buf)
 851 {
 852         return snprintf(buf, PAGE_SIZE, "%d\n", hotkey_orig_status);
 853 }
 854
 855 static struct device_attribute dev_attr_hotkey_bios_enabled =
 856         __ATTR(hotkey_bios_enabled, S_IRUGO, hotkey_bios_enabled_show, NULL);
 857
 858 /* sysfs hotkey bios_mask ---------------------------------------------- */
 859 static ssize_t hotkey_bios_mask_show(struct device *dev,
 860                            struct device_attribute *attr,
 861                            char *buf)
 862 {
 863         return snprintf(buf, PAGE_SIZE, "0x%08x\n", hotkey_orig_mask);
 864 }
 865
 866 static struct device_attribute dev_attr_hotkey_bios_mask =
 867         __ATTR(hotkey_bios_mask, S_IRUGO, hotkey_bios_mask_show, NULL);
 868
 869 /* sysfs hotkey all_mask ----------------------------------------------- */
 870 static ssize_t hotkey_all_mask_show(struct device *dev,
 871                            struct device_attribute *attr,
 872                            char *buf)
 873 {
 874         return snprintf(buf, PAGE_SIZE, "0x%08x\n", hotkey_all_mask);
 875 }
 876
 877 static struct device_attribute dev_attr_hotkey_all_mask =
 878         __ATTR(hotkey_all_mask, S_IRUGO, hotkey_all_mask_show, NULL);
 879
 880 /* sysfs hotkey recommended_mask --------------------------------------- */
 881 static ssize_t hotkey_recommended_mask_show(struct device *dev,
 882                                             struct device_attribute *attr,
 883                                             char *buf)
 884 {
 885         return snprintf(buf, PAGE_SIZE, "0x%08x\n",
 886                         hotkey_all_mask & ~hotkey_reserved_mask);
 887 }
 888
 889 static struct device_attribute dev_attr_hotkey_recommended_mask =
 890         __ATTR(hotkey_recommended_mask, S_IRUGO,
 891                 hotkey_recommended_mask_show, NULL);
 892
 893 /* sysfs hotkey radio_sw ----------------------------------------------- */
 894 static ssize_t hotkey_radio_sw_show(struct device *dev,
 895                            struct device_attribute *attr,
 896                            char *buf)
 897 {
 898         int res, s;
 899         res = hotkey_get_wlsw(&s);
 900         if (res < 0)
 901                 return res;
 902
 903         return snprintf(buf, PAGE_SIZE, "%d\n", !!s);
 904 }
 905
 906 static struct device_attribute dev_attr_hotkey_radio_sw =
 907         __ATTR(hotkey_radio_sw, S_IRUGO, hotkey_radio_sw_show, NULL);
 908
 909 /* sysfs hotkey report_mode -------------------------------------------- */
 910 static ssize_t hotkey_report_mode_show(struct device *dev,
 911                            struct device_attribute *attr,
 912                            char *buf)
 913 {
 914         return snprintf(buf, PAGE_SIZE, "%d\n",
 915                 (hotkey_report_mode != 0) ? hotkey_report_mode : 1);
 916 }
 917
 918 static struct device_attribute dev_attr_hotkey_report_mode =
 919         __ATTR(hotkey_report_mode, S_IRUGO, hotkey_report_mode_show, NULL);
 920
 921 /* --------------------------------------------------------------------- */
 922
 923 static struct attribute *hotkey_attributes[] __initdata = {
 924         &dev_attr_hotkey_enable.attr,
 925         &dev_attr_hotkey_report_mode.attr,
 926 };
 927
 928 static struct attribute *hotkey_mask_attributes[] __initdata = {
 929         &dev_attr_hotkey_mask.attr,
 930         &dev_attr_hotkey_bios_enabled.attr,
 931         &dev_attr_hotkey_bios_mask.attr,
 932         &dev_attr_hotkey_all_mask.attr,
 933         &dev_attr_hotkey_recommended_mask.attr,
 934 };
 935
 936 static int __init hotkey_init(struct ibm_init_struct *iibm)
 937 {
 938
 939         static u16 ibm_keycode_map[] __initdata = {
 940                 /* Scan Codes 0x00 to 0x0B: ACPI HKEY FN+F1..F12 */
 941                 KEY_FN_F1,      KEY_FN_F2,      KEY_COFFEE,     KEY_SLEEP,
 942                 KEY_WLAN,       KEY_FN_F6, KEY_SWITCHVIDEOMODE, KEY_FN_F8,
 943                 KEY_FN_F9,      KEY_FN_F10,     KEY_FN_F11,     KEY_SUSPEND,
 944                 /* Scan codes 0x0C to 0x0F: Other ACPI HKEY hot keys */
 945                 KEY_UNKNOWN,    /* 0x0C: FN+BACKSPACE */
 946                 KEY_UNKNOWN,    /* 0x0D: FN+INSERT */
 947                 KEY_UNKNOWN,    /* 0x0E: FN+DELETE */
 948                 KEY_RESERVED,   /* 0x0F: FN+HOME (brightness up) */
 949                 /* Scan codes 0x10 to 0x1F: Extended ACPI HKEY hot keys */
 950                 KEY_RESERVED,   /* 0x10: FN+END (brightness down) */
 951                 KEY_RESERVED,   /* 0x11: FN+PGUP (thinklight toggle) */
 952                 KEY_UNKNOWN,    /* 0x12: FN+PGDOWN */
 953                 KEY_ZOOM,       /* 0x13: FN+SPACE (zoom) */
 954                 KEY_RESERVED,   /* 0x14: VOLUME UP */
 955                 KEY_RESERVED,   /* 0x15: VOLUME DOWN */
 956                 KEY_RESERVED,   /* 0x16: MUTE */
 957                 KEY_VENDOR,     /* 0x17: Thinkpad/AccessIBM/Lenovo */
 958                 /* (assignments unknown, please report if found) */
 959                 KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN,
 960                 KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN,
 961         };
 962         static u16 lenovo_keycode_map[] __initdata = {
 963                 /* Scan Codes 0x00 to 0x0B: ACPI HKEY FN+F1..F12 */
 964                 KEY_FN_F1,      KEY_COFFEE,     KEY_BATTERY,    KEY_SLEEP,
 965                 KEY_WLAN,       KEY_FN_F6, KEY_SWITCHVIDEOMODE, KEY_FN_F8,
 966                 KEY_FN_F9,      KEY_FN_F10,     KEY_FN_F11,     KEY_SUSPEND,
 967                 /* Scan codes 0x0C to 0x0F: Other ACPI HKEY hot keys */
 968                 KEY_UNKNOWN,    /* 0x0C: FN+BACKSPACE */
 969                 KEY_UNKNOWN,    /* 0x0D: FN+INSERT */
 970                 KEY_UNKNOWN,    /* 0x0E: FN+DELETE */
 971                 KEY_BRIGHTNESSUP,       /* 0x0F: FN+HOME (brightness up) */
 972                 /* Scan codes 0x10 to 0x1F: Extended ACPI HKEY hot keys */
 973                 KEY_BRIGHTNESSDOWN,     /* 0x10: FN+END (brightness down) */
 974                 KEY_RESERVED,   /* 0x11: FN+PGUP (thinklight toggle) */
 975                 KEY_UNKNOWN,    /* 0x12: FN+PGDOWN */
 976                 KEY_ZOOM,       /* 0x13: FN+SPACE (zoom) */
 977                 KEY_RESERVED,   /* 0x14: VOLUME UP */
 978                 KEY_RESERVED,   /* 0x15: VOLUME DOWN */
 979                 KEY_RESERVED,   /* 0x16: MUTE */
 980                 KEY_VENDOR,     /* 0x17: Thinkpad/AccessIBM/Lenovo */
 981                 /* (assignments unknown, please report if found) */
 982                 KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN,
 983                 KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN,
 984         };
 985
 986 #define TPACPI_HOTKEY_MAP_LEN           ARRAY_SIZE(ibm_keycode_map)
 987 #define TPACPI_HOTKEY_MAP_SIZE          sizeof(ibm_keycode_map)
 988 #define TPACPI_HOTKEY_MAP_TYPESIZE      sizeof(ibm_keycode_map[0])
 989
 990         int res, i;
 991         int status;
 992
 993         vdbg_printk(TPACPI_DBG_INIT, "initializing hotkey subdriver\n");
 994
 995         BUG_ON(!tpacpi_inputdev);
 996
 997         IBM_ACPIHANDLE_INIT(hkey);
 998         mutex_init(&hotkey_mutex);
 999
1000         /* hotkey not supported on 570 */
1001         tp_features.hotkey = hkey_handle != NULL;
1002
1003         vdbg_printk(TPACPI_DBG_INIT, "hotkeys are %s\n",
1004                 str_supported(tp_features.hotkey));
1005
1006         if (tp_features.hotkey) {
1007                 hotkey_dev_attributes = create_attr_set(8, NULL);
1008                 if (!hotkey_dev_attributes)
1009                         return -ENOMEM;
1010                 res = add_many_to_attr_set(hotkey_dev_attributes,
1011                                 hotkey_attributes,
1012                                 ARRAY_SIZE(hotkey_attributes));
1013                 if (res)
1014                         return res;
1015
1016                 /* mask not supported on 570, 600e/x, 770e, 770x, A21e, A2xm/p,
1017                    A30, R30, R31, T20-22, X20-21, X22-24 */
1018                 tp_features.hotkey_mask =
1019                         acpi_evalf(hkey_handle, NULL, "DHKN", "qv");
1020
1021                 vdbg_printk(TPACPI_DBG_INIT, "hotkey masks are %s\n",
1022                         str_supported(tp_features.hotkey_mask));
1023
1024                 if (tp_features.hotkey_mask) {
1025                         /* MHKA available in A31, R40, R40e, T4x, X31, and later */
1026                         if (!acpi_evalf(hkey_handle, &hotkey_all_mask,
1027                                         "MHKA", "qd"))
1028                                 hotkey_all_mask = 0x080cU; /* FN+F12, FN+F4, FN+F3 */
1029                 }
1030
1031                 res = hotkey_get(&hotkey_orig_status, &hotkey_orig_mask);
1032                 if (!res && tp_features.hotkey_mask) {
1033                         res = add_many_to_attr_set(hotkey_dev_attributes,
1034                                 hotkey_mask_attributes,
1035                                 ARRAY_SIZE(hotkey_mask_attributes));
1036                 }
1037
1038                 /* Not all thinkpads have a hardware radio switch */
1039                 if (!res && acpi_evalf(hkey_handle, &status, "WLSW", "qd")) {
1040                         tp_features.hotkey_wlsw = 1;
1041                         printk(IBM_INFO
1042                                 "radio switch found; radios are %s\n",
1043                                 enabled(status, 0));
1044                         res = add_to_attr_set(hotkey_dev_attributes,
1045                                         &dev_attr_hotkey_radio_sw.attr);
1046                 }
1047
1048                 if (!res)
1049                         res = register_attr_set_with_sysfs(
1050                                         hotkey_dev_attributes,
1051                                         &tpacpi_pdev->dev.kobj);
1052                 if (res)
1053                         return res;
1054
1055                 /* Set up key map */
1056
1057                 hotkey_keycode_map = kmalloc(TPACPI_HOTKEY_MAP_SIZE,
1058                                                 GFP_KERNEL);
1059                 if (!hotkey_keycode_map) {
1060                         printk(IBM_ERR "failed to allocate memory for key map\n");
1061                         return -ENOMEM;
1062                 }
1063
1064                 if (thinkpad_id.vendor == PCI_VENDOR_ID_LENOVO) {
1065                         dbg_printk(TPACPI_DBG_INIT,
1066                                    "using Lenovo default hot key map\n");
1067                         memcpy(hotkey_keycode_map, &lenovo_keycode_map,
1068                                 TPACPI_HOTKEY_MAP_SIZE);
1069                 } else {
1070                         dbg_printk(TPACPI_DBG_INIT,
1071                                    "using IBM default hot key map\n");
1072                         memcpy(hotkey_keycode_map, &ibm_keycode_map,
1073                                 TPACPI_HOTKEY_MAP_SIZE);
1074                 }
1075
1076                 set_bit(EV_KEY, tpacpi_inputdev->evbit);
1077                 set_bit(EV_MSC, tpacpi_inputdev->evbit);
1078                 set_bit(MSC_SCAN, tpacpi_inputdev->mscbit);
1079                 tpacpi_inputdev->keycodesize = TPACPI_HOTKEY_MAP_TYPESIZE;
1080                 tpacpi_inputdev->keycodemax = TPACPI_HOTKEY_MAP_LEN;
1081                 tpacpi_inputdev->keycode = hotkey_keycode_map;
1082                 for (i = 0; i < TPACPI_HOTKEY_MAP_LEN; i++) {
1083                         if (hotkey_keycode_map[i] != KEY_RESERVED) {
1084                                 set_bit(hotkey_keycode_map[i],
1085                                         tpacpi_inputdev->keybit);
1086                         } else {
1087                                 if (i < sizeof(hotkey_reserved_mask)*8)
1088                                         hotkey_reserved_mask |= 1 << i;
1089                         }
1090                 }
1091
1092                 if (tp_features.hotkey_wlsw) {
1093                         set_bit(EV_SW, tpacpi_inputdev->evbit);
1094                         set_bit(SW_RADIO, tpacpi_inputdev->swbit);
1095                 }
1096
1097                 dbg_printk(TPACPI_DBG_INIT,
1098                                 "enabling hot key handling\n");
1099                 res = hotkey_set(1, (hotkey_all_mask & ~hotkey_reserved_mask)
1100                                         | hotkey_orig_mask);
1101                 if (res)
1102                         return res;
1103
1104                 dbg_printk(TPACPI_DBG_INIT,
1105                                 "legacy hot key reporting over procfs %s\n",
1106                                 (hotkey_report_mode < 2) ?
1107                                         "enabled" : "disabled");
1108         }
1109
1110         return (tp_features.hotkey)? 0 : 1;
1111 }
1112
1113 static void hotkey_exit(void)
1114 {
1115         int res;
1116
1117         if (tp_features.hotkey) {
1118                 dbg_printk(TPACPI_DBG_EXIT, "restoring original hotkey mask\n");
1119                 res = hotkey_set(hotkey_orig_status, hotkey_orig_mask);
1120                 if (res)
1121                         printk(IBM_ERR "failed to restore hotkey to BIOS defaults\n");
1122         }
1123
1124         if (hotkey_dev_attributes) {
1125                 delete_attr_set(hotkey_dev_attributes, &tpacpi_pdev->dev.kobj);
1126                 hotkey_dev_attributes = NULL;
1127         }
1128 }
1129
1130 static void tpacpi_input_send_key(unsigned int scancode,
1131                                   unsigned int keycode)
1132 {
1133         if (keycode != KEY_RESERVED) {
1134                 input_report_key(tpacpi_inputdev, keycode, 1);
1135                 if (keycode == KEY_UNKNOWN)
1136                         input_event(tpacpi_inputdev, EV_MSC, MSC_SCAN,
1137                                     scancode);
1138                 input_sync(tpacpi_inputdev);
1139
1140                 input_report_key(tpacpi_inputdev, keycode, 0);
1141                 if (keycode == KEY_UNKNOWN)
1142                         input_event(tpacpi_inputdev, EV_MSC, MSC_SCAN,
1143                                     scancode);
1144                 input_sync(tpacpi_inputdev);
1145         }
1146 }
1147
1148 static void tpacpi_input_send_radiosw(void)
1149 {
1150         int wlsw;
1151
1152         if (tp_features.hotkey_wlsw && !hotkey_get_wlsw(&wlsw))
1153                 input_report_switch(tpacpi_inputdev,
1154                                     SW_RADIO, !!wlsw);
1155 }
1156
1157 static void hotkey_notify(struct ibm_struct *ibm, u32 event)
1158 {
1159         u32 hkey;
1160         unsigned int keycode, scancode;
1161         int send_acpi_ev = 0;
1162
1163         if (event == 0x80 && acpi_evalf(hkey_handle, &hkey, "MHKP", "d")) {
1164                 switch (hkey >> 12) {
1165                 case 1:
1166                         /* 0x1000-0x1FFF: key presses */
1167                         scancode = hkey & 0xfff;
1168                         if (scancode > 0 && scancode < 0x21) {
1169                                 scancode--;
1170                                 keycode = hotkey_keycode_map[scancode];
1171                                 tpacpi_input_send_key(scancode, keycode);
1172                         } else {
1173                                 printk(IBM_ERR
1174                                        "hotkey 0x%04x out of range for keyboard map\n",
1175                                        hkey);
1176                                 send_acpi_ev = 1;
1177                         }
1178                         break;
1179                 case 5:
1180                         /* 0x5000-0x5FFF: LID */
1181                         /* we don't handle it through this path, just
1182                          * eat up known LID events */
1183                         if (hkey != 0x5001 && hkey != 0x5002) {
1184                                 printk(IBM_ERR
1185                                         "unknown LID-related hotkey event: 0x%04x\n",
1186                                         hkey);
1187                                 send_acpi_ev = 1;
1188                         }
1189                         break;
1190                 case 7:
1191                         /* 0x7000-0x7FFF: misc */
1192                         if (tp_features.hotkey_wlsw && hkey == 0x7000) {
1193                                 tpacpi_input_send_radiosw();
1194                                 break;
1195                         }
1196                         /* fallthrough to default */
1197                 default:
1198                         /* case 2: dock-related */
1199                         /*      0x2305 - T43 waking up due to bay lever eject while aslept */
1200                         /* case 3: ultra-bay related. maybe bay in dock? */
1201                         /*      0x3003 - T43 after wake up by bay lever eject (0x2305) */
1202                         printk(IBM_NOTICE "unhandled HKEY event 0x%04x\n", hkey);
1203                         send_acpi_ev = 1;
1204                 }
1205         } else {
1206                 printk(IBM_ERR "unknown hotkey notification event %d\n", event);
1207                 hkey = 0;
1208                 send_acpi_ev = 1;
1209         }
1210
1211         /* Legacy events */
1212         if (send_acpi_ev || hotkey_report_mode < 2)
1213                 acpi_bus_generate_proc_event(ibm->acpi->device, event, hkey);
1214
1215         /* netlink events */
1216         if (send_acpi_ev) {
1217                 acpi_bus_generate_netlink_event(ibm->acpi->device->pnp.device_class,
1218                                                 ibm->acpi->device->dev.bus_id,
1219                                                 event, hkey);
1220         }
1221 }
1222
1223 static void hotkey_resume(void)
1224 {
1225         tpacpi_input_send_radiosw();
1226 }
1227
1228 /*
1229  * Call with hotkey_mutex held
1230  */
1231 static int hotkey_get(int *status, u32 *mask)
1232 {
1233         if (!acpi_evalf(hkey_handle, status, "DHKC", "d"))
1234                 return -EIO;
1235
1236         if (tp_features.hotkey_mask)
1237                 if (!acpi_evalf(hkey_handle, mask, "DHKN", "d"))
1238                         return -EIO;
1239
1240         return 0;
1241 }
1242
1243 /*
1244  * Call with hotkey_mutex held
1245  */
1246 static int hotkey_set(int status, u32 mask)
1247 {
1248         int i;
1249
1250         if (!acpi_evalf(hkey_handle, NULL, "MHKC", "vd", status))
1251                 return -EIO;
1252
1253         if (tp_features.hotkey_mask)
1254                 for (i = 0; i < 32; i++) {
1255                         int bit = ((1 << i) & mask) != 0;
1256                         if (!acpi_evalf(hkey_handle,
1257                                         NULL, "MHKM", "vdd", i + 1, bit))
1258                                 return -EIO;
1259                 }
1260
1261         return 0;
1262 }
1263
1264 /* procfs -------------------------------------------------------------- */
1265 static int hotkey_read(char *p)
1266 {
1267         int res, status;
1268         u32 mask;
1269         int len = 0;
1270
1271         if (!tp_features.hotkey) {
1272                 len += sprintf(p + len, "status:\t\tnot supported\n");
1273                 return len;
1274         }
1275
1276         res = mutex_lock_interruptible(&hotkey_mutex);
1277         if (res < 0)
1278                 return res;
1279         res = hotkey_get(&status, &mask);
1280         mutex_unlock(&hotkey_mutex);
1281         if (res)
1282                 return res;
1283
1284         len += sprintf(p + len, "status:\t\t%s\n", enabled(status, 0));
1285         if (tp_features.hotkey_mask) {
1286                 len += sprintf(p + len, "mask:\t\t0x%08x\n", mask);
1287                 len += sprintf(p + len,
1288                                "commands:\tenable, disable, reset, <mask>\n");
1289         } else {
1290                 len += sprintf(p + len, "mask:\t\tnot supported\n");
1291                 len += sprintf(p + len, "commands:\tenable, disable, reset\n");
1292         }
1293
1294         return len;
1295 }
1296
1297 static int hotkey_write(char *buf)
1298 {
1299         int res, status;
1300         u32 mask;
1301         char *cmd;
1302         int do_cmd = 0;
1303
1304         if (!tp_features.hotkey)
1305                 return -ENODEV;
1306
1307         res = mutex_lock_interruptible(&hotkey_mutex);
1308         if (res < 0)
1309                 return res;
1310
1311         res = hotkey_get(&status, &mask);
1312         if (res)
1313                 goto errexit;
1314
1315         res = 0;
1316         while ((cmd = next_cmd(&buf))) {
1317                 if (strlencmp(cmd, "enable") == 0) {
1318                         status = 1;
1319                 } else if (strlencmp(cmd, "disable") == 0) {
1320                         status = 0;
1321                 } else if (strlencmp(cmd, "reset") == 0) {
1322                         status = hotkey_orig_status;
1323                         mask = hotkey_orig_mask;
1324                 } else if (sscanf(cmd, "0x%x", &mask) == 1) {
1325                         /* mask set */
1326                 } else if (sscanf(cmd, "%x", &mask) == 1) {
1327                         /* mask set */
1328                 } else {
1329                         res = -EINVAL;
1330                         goto errexit;
1331                 }
1332                 do_cmd = 1;
1333         }
1334
1335         if (do_cmd)
1336                 res = hotkey_set(status, mask);
1337
1338 errexit:
1339         mutex_unlock(&hotkey_mutex);
1340         return res;
1341 }
1342
1343 static const struct acpi_device_id ibm_htk_device_ids[] = {
1344         {IBM_HKEY_HID, 0},
1345         {"", 0},
1346 };
1347
1348 static struct tp_acpi_drv_struct ibm_hotkey_acpidriver = {
1349         .hid = ibm_htk_device_ids,
1350         .notify = hotkey_notify,
1351         .handle = &hkey_handle,
1352         .type = ACPI_DEVICE_NOTIFY,
1353 };
1354
1355 static struct ibm_struct hotkey_driver_data = {
1356         .name = "hotkey",
1357         .read = hotkey_read,
1358         .write = hotkey_write,
1359         .exit = hotkey_exit,
1360         .resume = hotkey_resume,
1361         .acpi = &ibm_hotkey_acpidriver,
1362 };
1363
1364 /*************************************************************************
1365  * Bluetooth subdriver
1366  */
1367
1368 /* sysfs bluetooth enable ---------------------------------------------- */
1369 static ssize_t bluetooth_enable_show(struct device *dev,
1370                            struct device_attribute *attr,
1371                            char *buf)
1372 {
1373         int status;
1374
1375         status = bluetooth_get_radiosw();
1376         if (status < 0)
1377                 return status;
1378
1379         return snprintf(buf, PAGE_SIZE, "%d\n", status ? 1 : 0);
1380 }
1381
1382 static ssize_t bluetooth_enable_store(struct device *dev,
1383                             struct device_attribute *attr,
1384                             const char *buf, size_t count)
1385 {
1386         unsigned long t;
1387         int res;
1388
1389         if (parse_strtoul(buf, 1, &t))
1390                 return -EINVAL;
1391
1392         res = bluetooth_set_radiosw(t);
1393
1394         return (res) ? res : count;
1395 }
1396
1397 static struct device_attribute dev_attr_bluetooth_enable =
1398         __ATTR(bluetooth_enable, S_IWUSR | S_IRUGO,
1399                 bluetooth_enable_show, bluetooth_enable_store);
1400
1401 /* --------------------------------------------------------------------- */
1402
1403 static struct attribute *bluetooth_attributes[] = {
1404         &dev_attr_bluetooth_enable.attr,
1405         NULL
1406 };
1407
1408 static const struct attribute_group bluetooth_attr_group = {
1409         .attrs = bluetooth_attributes,
1410 };
1411
1412 static int __init bluetooth_init(struct ibm_init_struct *iibm)
1413 {
1414         int res;
1415         int status = 0;
1416
1417         vdbg_printk(TPACPI_DBG_INIT, "initializing bluetooth subdriver\n");
1418
1419         IBM_ACPIHANDLE_INIT(hkey);
1420
1421         /* bluetooth not supported on 570, 600e/x, 770e, 770x, A21e, A2xm/p,
1422            G4x, R30, R31, R40e, R50e, T20-22, X20-21 */
1423         tp_features.bluetooth = hkey_handle &&
1424             acpi_evalf(hkey_handle, &status, "GBDC", "qd");
1425
1426         vdbg_printk(TPACPI_DBG_INIT, "bluetooth is %s, status 0x%02x\n",
1427                 str_supported(tp_features.bluetooth),
1428                 status);
1429
1430         if (tp_features.bluetooth) {
1431                 if (!(status & TP_ACPI_BLUETOOTH_HWPRESENT)) {
1432                         /* no bluetooth hardware present in system */
1433                         tp_features.bluetooth = 0;
1434                         dbg_printk(TPACPI_DBG_INIT,
1435                                    "bluetooth hardware not installed\n");
1436                 } else {
1437                         res = sysfs_create_group(&tpacpi_pdev->dev.kobj,
1438                                         &bluetooth_attr_group);
1439                         if (res)
1440                                 return res;
1441                 }
1442         }
1443
1444         return (tp_features.bluetooth)? 0 : 1;
1445 }
1446
1447 static void bluetooth_exit(void)
1448 {
1449         sysfs_remove_group(&tpacpi_pdev->dev.kobj,
1450                         &bluetooth_attr_group);
1451 }
1452
1453 static int bluetooth_get_radiosw(void)
1454 {
1455         int status;
1456
1457         if (!tp_features.bluetooth)
1458                 return -ENODEV;
1459
1460         if (!acpi_evalf(hkey_handle, &status, "GBDC", "d"))
1461                 return -EIO;
1462
1463         return ((status & TP_ACPI_BLUETOOTH_RADIOSSW) != 0);
1464 }
1465
1466 static int bluetooth_set_radiosw(int radio_on)
1467 {
1468         int status;
1469
1470         if (!tp_features.bluetooth)
1471                 return -ENODEV;
1472
1473         if (!acpi_evalf(hkey_handle, &status, "GBDC", "d"))
1474                 return -EIO;
1475         if (radio_on)
1476                 status |= TP_ACPI_BLUETOOTH_RADIOSSW;
1477         else
1478                 status &= ~TP_ACPI_BLUETOOTH_RADIOSSW;
1479         if (!acpi_evalf(hkey_handle, NULL, "SBDC", "vd", status))
1480                 return -EIO;
1481
1482         return 0;
1483 }
1484
1485 /* procfs -------------------------------------------------------------- */
1486 static int bluetooth_read(char *p)
1487 {
1488         int len = 0;
1489         int status = bluetooth_get_radiosw();
1490
1491         if (!tp_features.bluetooth)
1492                 len += sprintf(p + len, "status:\t\tnot supported\n");
1493         else {
1494                 len += sprintf(p + len, "status:\t\t%s\n",
1495                                 (status)? "enabled" : "disabled");
1496                 len += sprintf(p + len, "commands:\tenable, disable\n");
1497         }
1498
1499         return len;
1500 }
1501
1502 static int bluetooth_write(char *buf)
1503 {
1504         char *cmd;
1505
1506         if (!tp_features.bluetooth)
1507                 return -ENODEV;
1508
1509         while ((cmd = next_cmd(&buf))) {
1510                 if (strlencmp(cmd, "enable") == 0) {
1511                         bluetooth_set_radiosw(1);
1512                 } else if (strlencmp(cmd, "disable") == 0) {
1513                         bluetooth_set_radiosw(0);
1514                 } else
1515                         return -EINVAL;
1516         }
1517
1518         return 0;
1519 }
1520
1521 static struct ibm_struct bluetooth_driver_data = {
1522         .name = "bluetooth",
1523         .read = bluetooth_read,
1524         .write = bluetooth_write,
1525         .exit = bluetooth_exit,
1526 };
1527
1528 /*************************************************************************
1529  * Wan subdriver
1530  */
1531
1532 /* sysfs wan enable ---------------------------------------------------- */
1533 static ssize_t wan_enable_show(struct device *dev,
1534                            struct device_attribute *attr,
1535                            char *buf)
1536 {
1537         int status;
1538
1539         status = wan_get_radiosw();
1540         if (status < 0)
1541                 return status;
1542
1543         return snprintf(buf, PAGE_SIZE, "%d\n", status ? 1 : 0);
1544 }
1545
1546 static ssize_t wan_enable_store(struct device *dev,
1547                             struct device_attribute *attr,
1548                             const char *buf, size_t count)
1549 {
1550         unsigned long t;
1551         int res;
1552
1553         if (parse_strtoul(buf, 1, &t))
1554                 return -EINVAL;
1555
1556         res = wan_set_radiosw(t);
1557
1558         return (res) ? res : count;
1559 }
1560
1561 static struct device_attribute dev_attr_wan_enable =
1562         __ATTR(wwan_enable, S_IWUSR | S_IRUGO,
1563                 wan_enable_show, wan_enable_store);
1564
1565 /* --------------------------------------------------------------------- */
1566
1567 static struct attribute *wan_attributes[] = {
1568         &dev_attr_wan_enable.attr,
1569         NULL
1570 };
1571
1572 static const struct attribute_group wan_attr_group = {
1573         .attrs = wan_attributes,
1574 };
1575
1576 static int __init wan_init(struct ibm_init_struct *iibm)
1577 {
1578         int res;
1579         int status = 0;
1580
1581         vdbg_printk(TPACPI_DBG_INIT, "initializing wan subdriver\n");
1582
1583         IBM_ACPIHANDLE_INIT(hkey);
1584
1585         tp_features.wan = hkey_handle &&
1586             acpi_evalf(hkey_handle, &status, "GWAN", "qd");
1587
1588         vdbg_printk(TPACPI_DBG_INIT, "wan is %s, status 0x%02x\n",
1589                 str_supported(tp_features.wan),
1590                 status);
1591
1592         if (tp_features.wan) {
1593                 if (!(status & TP_ACPI_WANCARD_HWPRESENT)) {
1594                         /* no wan hardware present in system */
1595                         tp_features.wan = 0;
1596                         dbg_printk(TPACPI_DBG_INIT,
1597                                    "wan hardware not installed\n");
1598                 } else {
1599                         res = sysfs_create_group(&tpacpi_pdev->dev.kobj,
1600                                         &wan_attr_group);
1601                         if (res)
1602                                 return res;
1603                 }
1604         }
1605
1606         return (tp_features.wan)? 0 : 1;
1607 }
1608
1609 static void wan_exit(void)
1610 {
1611         sysfs_remove_group(&tpacpi_pdev->dev.kobj,
1612                 &wan_attr_group);
1613 }
1614
1615 static int wan_get_radiosw(void)
1616 {
1617         int status;
1618
1619         if (!tp_features.wan)
1620                 return -ENODEV;
1621
1622         if (!acpi_evalf(hkey_handle, &status, "GWAN", "d"))
1623                 return -EIO;
1624
1625         return ((status & TP_ACPI_WANCARD_RADIOSSW) != 0);
1626 }
1627
1628 static int wan_set_radiosw(int radio_on)
1629 {
1630         int status;
1631
1632         if (!tp_features.wan)
1633                 return -ENODEV;
1634
1635         if (!acpi_evalf(hkey_handle, &status, "GWAN", "d"))
1636                 return -EIO;
1637         if (radio_on)
1638                 status |= TP_ACPI_WANCARD_RADIOSSW;
1639         else
1640                 status &= ~TP_ACPI_WANCARD_RADIOSSW;
1641         if (!acpi_evalf(hkey_handle, NULL, "SWAN", "vd", status))
1642                 return -EIO;
1643
1644         return 0;
1645 }
1646
1647 /* procfs -------------------------------------------------------------- */
1648 static int wan_read(char *p)
1649 {
1650         int len = 0;
1651         int status = wan_get_radiosw();
1652
1653         if (!tp_features.wan)
1654                 len += sprintf(p + len, "status:\t\tnot supported\n");
1655         else {
1656                 len += sprintf(p + len, "status:\t\t%s\n",
1657                                 (status)? "enabled" : "disabled");
1658                 len += sprintf(p + len, "commands:\tenable, disable\n");
1659         }
1660
1661         return len;
1662 }
1663
1664 static int wan_write(char *buf)
1665 {
1666         char *cmd;
1667
1668         if (!tp_features.wan)
1669                 return -ENODEV;
1670
1671         while ((cmd = next_cmd(&buf))) {
1672                 if (strlencmp(cmd, "enable") == 0) {
1673                         wan_set_radiosw(1);
1674                 } else if (strlencmp(cmd, "disable") == 0) {
1675                         wan_set_radiosw(0);
1676                 } else
1677                         return -EINVAL;
1678         }
1679
1680         return 0;
1681 }
1682
1683 static struct ibm_struct wan_driver_data = {
1684         .name = "wan",
1685         .read = wan_read,
1686         .write = wan_write,
1687         .exit = wan_exit,
1688         .flags.experimental = 1,
1689 };
1690
1691 /*************************************************************************
1692  * Video subdriver
1693  */
1694
1695 static enum video_access_mode video_supported;
1696 static int video_orig_autosw;
1697
1698 IBM_HANDLE(vid, root, "\\_SB.PCI.AGP.VGA",      /* 570 */
1699            "\\_SB.PCI0.AGP0.VID0",      /* 600e/x, 770x */
1700            "\\_SB.PCI0.VID0",   /* 770e */
1701            "\\_SB.PCI0.VID",    /* A21e, G4x, R50e, X30, X40 */
1702            "\\_SB.PCI0.AGP.VID",        /* all others */
1703            );                           /* R30, R31 */
1704
1705 IBM_HANDLE(vid2, root, "\\_SB.PCI0.AGPB.VID");  /* G41 */
1706
1707 static int __init video_init(struct ibm_init_struct *iibm)
1708 {
1709         int ivga;
1710
1711         vdbg_printk(TPACPI_DBG_INIT, "initializing video subdriver\n");
1712
1713         IBM_ACPIHANDLE_INIT(vid);
1714         IBM_ACPIHANDLE_INIT(vid2);
1715
1716         if (vid2_handle && acpi_evalf(NULL, &ivga, "\\IVGA", "d") && ivga)
1717                 /* G41, assume IVGA doesn't change */
1718                 vid_handle = vid2_handle;
1719
1720         if (!vid_handle)
1721                 /* video switching not supported on R30, R31 */
1722                 video_supported = TPACPI_VIDEO_NONE;
1723         else if (acpi_evalf(vid_handle, &video_orig_autosw, "SWIT", "qd"))
1724                 /* 570 */
1725                 video_supported = TPACPI_VIDEO_570;
1726         else if (acpi_evalf(vid_handle, &video_orig_autosw, "^VADL", "qd"))
1727                 /* 600e/x, 770e, 770x */
1728                 video_supported = TPACPI_VIDEO_770;
1729         else
1730                 /* all others */
1731                 video_supported = TPACPI_VIDEO_NEW;
1732
1733         vdbg_printk(TPACPI_DBG_INIT, "video is %s, mode %d\n",
1734                 str_supported(video_supported != TPACPI_VIDEO_NONE),
1735                 video_supported);
1736
1737         return (video_supported != TPACPI_VIDEO_NONE)? 0 : 1;
1738 }
1739
1740 static void video_exit(void)
1741 {
1742         dbg_printk(TPACPI_DBG_EXIT,
1743                    "restoring original video autoswitch mode\n");
1744         if (video_autosw_set(video_orig_autosw))
1745                 printk(IBM_ERR "error while trying to restore original "
1746                         "video autoswitch mode\n");
1747 }
1748
1749 static int video_outputsw_get(void)
1750 {
1751         int status = 0;
1752         int i;
1753
1754         switch (video_supported) {
1755         case TPACPI_VIDEO_570:
1756                 if (!acpi_evalf(NULL, &i, "\\_SB.PHS", "dd",
1757                                  TP_ACPI_VIDEO_570_PHSCMD))
1758                         return -EIO;
1759                 status = i & TP_ACPI_VIDEO_570_PHSMASK;
1760                 break;
1761         case TPACPI_VIDEO_770:
1762                 if (!acpi_evalf(NULL, &i, "\\VCDL", "d"))
1763                         return -EIO;
1764                 if (i)
1765                         status |= TP_ACPI_VIDEO_S_LCD;
1766                 if (!acpi_evalf(NULL, &i, "\\VCDC", "d"))
1767                         return -EIO;
1768                 if (i)
1769                         status |= TP_ACPI_VIDEO_S_CRT;
1770                 break;
1771         case TPACPI_VIDEO_NEW:
1772                 if (!acpi_evalf(NULL, NULL, "\\VUPS", "vd", 1) ||
1773                     !acpi_evalf(NULL, &i, "\\VCDC", "d"))
1774                         return -EIO;
1775                 if (i)
1776                         status |= TP_ACPI_VIDEO_S_CRT;
1777
1778                 if (!acpi_evalf(NULL, NULL, "\\VUPS", "vd", 0) ||
1779                     !acpi_evalf(NULL, &i, "\\VCDL", "d"))
1780                         return -EIO;
1781                 if (i)
1782                         status |= TP_ACPI_VIDEO_S_LCD;
1783                 if (!acpi_evalf(NULL, &i, "\\VCDD", "d"))
1784                         return -EIO;
1785                 if (i)
1786                         status |= TP_ACPI_VIDEO_S_DVI;
1787                 break;
1788         default:
1789                 return -ENOSYS;
1790         }
1791
1792         return status;
1793 }
1794
1795 static int video_outputsw_set(int status)
1796 {
1797         int autosw;
1798         int res = 0;
1799
1800         switch (video_supported) {
1801         case TPACPI_VIDEO_570:
1802                 res = acpi_evalf(NULL, NULL,
1803                                  "\\_SB.PHS2", "vdd",
1804                                  TP_ACPI_VIDEO_570_PHS2CMD,
1805                                  status | TP_ACPI_VIDEO_570_PHS2SET);
1806                 break;
1807         case TPACPI_VIDEO_770:
1808                 autosw = video_autosw_get();
1809                 if (autosw < 0)
1810                         return autosw;
1811
1812                 res = video_autosw_set(1);
1813                 if (res)
1814                         return res;
1815                 res = acpi_evalf(vid_handle, NULL,
1816                                  "ASWT", "vdd", status * 0x100, 0);
1817                 if (!autosw && video_autosw_set(autosw)) {
1818                         printk(IBM_ERR "video auto-switch left enabled due to error\n");
1819                         return -EIO;
1820                 }
1821                 break;
1822         case TPACPI_VIDEO_NEW:
1823                 res = acpi_evalf(NULL, NULL, "\\VUPS", "vd", 0x80) &&
1824                         acpi_evalf(NULL, NULL, "\\VSDS", "vdd", status, 1);
1825                 break;
1826         default:
1827                 return -ENOSYS;
1828         }
1829
1830         return (res)? 0 : -EIO;
1831 }
1832
1833 static int video_autosw_get(void)
1834 {
1835         int autosw = 0;
1836
1837         switch (video_supported) {
1838         case TPACPI_VIDEO_570:
1839                 if (!acpi_evalf(vid_handle, &autosw, "SWIT", "d"))
1840                         return -EIO;
1841                 break;
1842         case TPACPI_VIDEO_770:
1843         case TPACPI_VIDEO_NEW:
1844                 if (!acpi_evalf(vid_handle, &autosw, "^VDEE", "d"))
1845                         return -EIO;
1846                 break;
1847         default:
1848                 return -ENOSYS;
1849         }
1850
1851         return autosw & 1;
1852 }
1853
1854 static int video_autosw_set(int enable)
1855 {
1856         if (!acpi_evalf(vid_handle, NULL, "_DOS", "vd", (enable)? 1 : 0))
1857                 return -EIO;
1858         return 0;
1859 }
1860
1861 static int video_outputsw_cycle(void)
1862 {
1863         int autosw = video_autosw_get();
1864         int res;
1865
1866         if (autosw < 0)
1867                 return autosw;
1868
1869         switch (video_supported) {
1870         case TPACPI_VIDEO_570:
1871                 res = video_autosw_set(1);
1872                 if (res)
1873                         return res;
1874                 res = acpi_evalf(ec_handle, NULL, "_Q16", "v");
1875                 break;
1876         case TPACPI_VIDEO_770:
1877         case TPACPI_VIDEO_NEW:
1878                 res = video_autosw_set(1);
1879                 if (res)
1880                         return res;
1881                 res = acpi_evalf(vid_handle, NULL, "VSWT", "v");
1882                 break;
1883         default:
1884                 return -ENOSYS;
1885         }
1886         if (!autosw && video_autosw_set(autosw)) {
1887                 printk(IBM_ERR "video auto-switch left enabled due to error\n");
1888                 return -EIO;
1889         }
1890
1891         return (res)? 0 : -EIO;
1892 }
1893
1894 static int video_expand_toggle(void)
1895 {
1896         switch (video_supported) {
1897         case TPACPI_VIDEO_570:
1898                 return acpi_evalf(ec_handle, NULL, "_Q17", "v")?
1899                         0 : -EIO;
1900         case TPACPI_VIDEO_770:
1901                 return acpi_evalf(vid_handle, NULL, "VEXP", "v")?
1902                         0 : -EIO;
1903         case TPACPI_VIDEO_NEW:
1904                 return acpi_evalf(NULL, NULL, "\\VEXP", "v")?
1905                         0 : -EIO;
1906         default:
1907                 return -ENOSYS;
1908         }
1909         /* not reached */
1910 }
1911
1912 static int video_read(char *p)
1913 {
1914         int status, autosw;
1915         int len = 0;
1916
1917         if (video_supported == TPACPI_VIDEO_NONE) {
1918                 len += sprintf(p + len, "status:\t\tnot supported\n");
1919                 return len;
1920         }
1921
1922         status = video_outputsw_get();
1923         if (status < 0)
1924                 return status;
1925
1926         autosw = video_autosw_get();
1927         if (autosw < 0)
1928                 return autosw;
1929
1930         len += sprintf(p + len, "status:\t\tsupported\n");
1931         len += sprintf(p + len, "lcd:\t\t%s\n", enabled(status, 0));
1932         len += sprintf(p + len, "crt:\t\t%s\n", enabled(status, 1));
1933         if (video_supported == TPACPI_VIDEO_NEW)
1934                 len += sprintf(p + len, "dvi:\t\t%s\n", enabled(status, 3));
1935         len += sprintf(p + len, "auto:\t\t%s\n", enabled(autosw, 0));
1936         len += sprintf(p + len, "commands:\tlcd_enable, lcd_disable\n");
1937         len += sprintf(p + len, "commands:\tcrt_enable, crt_disable\n");
1938         if (video_supported == TPACPI_VIDEO_NEW)
1939                 len += sprintf(p + len, "commands:\tdvi_enable, dvi_disable\n");
1940         len += sprintf(p + len, "commands:\tauto_enable, auto_disable\n");
1941         len += sprintf(p + len, "commands:\tvideo_switch, expand_toggle\n");
1942
1943         return len;
1944 }
1945
1946 static int video_write(char *buf)
1947 {
1948         char *cmd;
1949         int enable, disable, status;
1950         int res;
1951
1952         if (video_supported == TPACPI_VIDEO_NONE)
1953                 return -ENODEV;
1954
1955         enable = 0;
1956         disable = 0;
1957
1958         while ((cmd = next_cmd(&buf))) {
1959                 if (strlencmp(cmd, "lcd_enable") == 0) {
1960                         enable |= TP_ACPI_VIDEO_S_LCD;
1961                 } else if (strlencmp(cmd, "lcd_disable") == 0) {
1962                         disable |= TP_ACPI_VIDEO_S_LCD;
1963                 } else if (strlencmp(cmd, "crt_enable") == 0) {
1964                         enable |= TP_ACPI_VIDEO_S_CRT;
1965                 } else if (strlencmp(cmd, "crt_disable") == 0) {
1966                         disable |= TP_ACPI_VIDEO_S_CRT;
1967                 } else if (video_supported == TPACPI_VIDEO_NEW &&
1968                            strlencmp(cmd, "dvi_enable") == 0) {
1969                         enable |= TP_ACPI_VIDEO_S_DVI;
1970                 } else if (video_supported == TPACPI_VIDEO_NEW &&
1971                            strlencmp(cmd, "dvi_disable") == 0) {
1972                         disable |= TP_ACPI_VIDEO_S_DVI;
1973                 } else if (strlencmp(cmd, "auto_enable") == 0) {
1974                         res = video_autosw_set(1);
1975                         if (res)
1976                                 return res;
1977                 } else if (strlencmp(cmd, "auto_disable") == 0) {
1978                         res = video_autosw_set(0);
1979                         if (res)
1980                                 return res;
1981                 } else if (strlencmp(cmd, "video_switch") == 0) {
1982                         res = video_outputsw_cycle();
1983                         if (res)
1984                                 return res;
1985                 } else if (strlencmp(cmd, "expand_toggle") == 0) {
1986                         res = video_expand_toggle();
1987                         if (res)
1988                                 return res;
1989                 } else
1990                         return -EINVAL;
1991         }
1992
1993         if (enable || disable) {
1994                 status = video_outputsw_get();
1995                 if (status < 0)
1996                         return status;
1997                 res = video_outputsw_set((status & ~disable) | enable);
1998                 if (res)
1999                         return res;
2000         }
2001
2002         return 0;
2003 }
2004
2005 static struct ibm_struct video_driver_data = {
2006         .name = "video",
2007         .read = video_read,
2008         .write = video_write,
2009         .exit = video_exit,
2010 };
2011
2012 /*************************************************************************
2013  * Light (thinklight) subdriver
2014  */
2015
2016 IBM_HANDLE(lght, root, "\\LGHT");       /* A21e, A2xm/p, T20-22, X20-21 */
2017 IBM_HANDLE(ledb, ec, "LEDB");           /* G4x */
2018
2019 static int __init light_init(struct ibm_init_struct *iibm)
2020 {
2021         vdbg_printk(TPACPI_DBG_INIT, "initializing light subdriver\n");
2022
2023         IBM_ACPIHANDLE_INIT(ledb);
2024         IBM_ACPIHANDLE_INIT(lght);
2025         IBM_ACPIHANDLE_INIT(cmos);
2026
2027         /* light not supported on 570, 600e/x, 770e, 770x, G4x, R30, R31 */
2028         tp_features.light = (cmos_handle || lght_handle) && !ledb_handle;
2029
2030         if (tp_features.light)
2031                 /* light status not supported on
2032                    570, 600e/x, 770e, 770x, G4x, R30, R31, R32, X20 */
2033                 tp_features.light_status =
2034                         acpi_evalf(ec_handle, NULL, "KBLT", "qv");
2035
2036         vdbg_printk(TPACPI_DBG_INIT, "light is %s\n",
2037                 str_supported(tp_features.light));
2038
2039         return (tp_features.light)? 0 : 1;
2040 }
2041
2042 static int light_read(char *p)
2043 {
2044         int len = 0;
2045         int status = 0;
2046
2047         if (!tp_features.light) {
2048                 len += sprintf(p + len, "status:\t\tnot supported\n");
2049         } else if (!tp_features.light_status) {
2050                 len += sprintf(p + len, "status:\t\tunknown\n");
2051                 len += sprintf(p + len, "commands:\ton, off\n");
2052         } else {
2053                 if (!acpi_evalf(ec_handle, &status, "KBLT", "d"))
2054                         return -EIO;
2055                 len += sprintf(p + len, "status:\t\t%s\n", onoff(status, 0));
2056                 len += sprintf(p + len, "commands:\ton, off\n");
2057         }
2058
2059         return len;
2060 }
2061
2062 static int light_write(char *buf)
2063 {
2064         int cmos_cmd, lght_cmd;
2065         char *cmd;
2066         int success;
2067
2068         if (!tp_features.light)
2069                 return -ENODEV;
2070
2071         while ((cmd = next_cmd(&buf))) {
2072                 if (strlencmp(cmd, "on") == 0) {
2073                         cmos_cmd = 0x0c;
2074                         lght_cmd = 1;
2075                 } else if (strlencmp(cmd, "off") == 0) {
2076                         cmos_cmd = 0x0d;
2077                         lght_cmd = 0;
2078                 } else
2079                         return -EINVAL;
2080
2081                 success = cmos_handle ?
2082                     acpi_evalf(cmos_handle, NULL, NULL, "vd", cmos_cmd) :
2083                     acpi_evalf(lght_handle, NULL, NULL, "vd", lght_cmd);
2084                 if (!success)
2085                         return -EIO;
2086         }
2087
2088         return 0;
2089 }
2090
2091 static struct ibm_struct light_driver_data = {
2092         .name = "light",
2093         .read = light_read,
2094         .write = light_write,
2095 };
2096
2097 /*************************************************************************
2098  * Dock subdriver
2099  */
2100
2101 #ifdef CONFIG_THINKPAD_ACPI_DOCK
2102
2103 IBM_HANDLE(dock, root, "\\_SB.GDCK",    /* X30, X31, X40 */
2104            "\\_SB.PCI0.DOCK",   /* 600e/x,770e,770x,A2xm/p,T20-22,X20-21 */
2105            "\\_SB.PCI0.PCI1.DOCK",      /* all others */
2106            "\\_SB.PCI.ISA.SLCE",        /* 570 */
2107     );                          /* A21e,G4x,R30,R31,R32,R40,R40e,R50e */
2108
2109 /* don't list other alternatives as we install a notify handler on the 570 */
2110 IBM_HANDLE(pci, root, "\\_SB.PCI");     /* 570 */
2111
2112 static const struct acpi_device_id ibm_pci_device_ids[] = {
2113         {PCI_ROOT_HID_STRING, 0},
2114         {"", 0},
2115 };
2116
2117 static struct tp_acpi_drv_struct ibm_dock_acpidriver[2] = {
2118         {
2119          .notify = dock_notify,
2120          .handle = &dock_handle,
2121          .type = ACPI_SYSTEM_NOTIFY,
2122         },
2123         {
2124         /* THIS ONE MUST NEVER BE USED FOR DRIVER AUTOLOADING.
2125          * We just use it to get notifications of dock hotplug
2126          * in very old thinkpads */
2127          .hid = ibm_pci_device_ids,
2128          .notify = dock_notify,
2129          .handle = &pci_handle,
2130          .type = ACPI_SYSTEM_NOTIFY,
2131         },
2132 };
2133
2134 static struct ibm_struct dock_driver_data[2] = {
2135         {
2136          .name = "dock",
2137          .read = dock_read,
2138          .write = dock_write,
2139          .acpi = &ibm_dock_acpidriver[0],
2140         },
2141         {
2142          .name = "dock",
2143          .acpi = &ibm_dock_acpidriver[1],
2144         },
2145 };
2146
2147 #define dock_docked() (_sta(dock_handle) & 1)
2148
2149 static int __init dock_init(struct ibm_init_struct *iibm)
2150 {
2151         vdbg_printk(TPACPI_DBG_INIT, "initializing dock subdriver\n");
2152
2153         IBM_ACPIHANDLE_INIT(dock);
2154
2155         vdbg_printk(TPACPI_DBG_INIT, "dock is %s\n",
2156                 str_supported(dock_handle != NULL));
2157
2158         return (dock_handle)? 0 : 1;
2159 }
2160
2161 static int __init dock_init2(struct ibm_init_struct *iibm)
2162 {
2163         int dock2_needed;
2164
2165         vdbg_printk(TPACPI_DBG_INIT, "initializing dock subdriver part 2\n");
2166
2167         if (dock_driver_data[0].flags.acpi_driver_registered &&
2168             dock_driver_data[0].flags.acpi_notify_installed) {
2169                 IBM_ACPIHANDLE_INIT(pci);
2170                 dock2_needed = (pci_handle != NULL);
2171                 vdbg_printk(TPACPI_DBG_INIT,
2172                             "dock PCI handler for the TP 570 is %s\n",
2173                             str_supported(dock2_needed));
2174         } else {
2175                 vdbg_printk(TPACPI_DBG_INIT,
2176                 "dock subdriver part 2 not required\n");
2177                 dock2_needed = 0;
2178         }
2179
2180         return (dock2_needed)? 0 : 1;
2181 }
2182
2183 static void dock_notify(struct ibm_struct *ibm, u32 event)
2184 {
2185         int docked = dock_docked();
2186         int pci = ibm->acpi->hid && ibm->acpi->device &&
2187                 acpi_match_device_ids(ibm->acpi->device, ibm_pci_device_ids);
2188         int data;
2189
2190         if (event == 1 && !pci) /* 570 */
2191                 data = 1;       /* button */
2192         else if (event == 1 && pci)     /* 570 */
2193                 data = 3;       /* dock */
2194         else if (event == 3 && docked)
2195                 data = 1;       /* button */
2196         else if (event == 3 && !docked)
2197                 data = 2;       /* undock */
2198         else if (event == 0 && docked)
2199                 data = 3;       /* dock */
2200         else {
2201                 printk(IBM_ERR "unknown dock event %d, status %d\n",
2202                        event, _sta(dock_handle));
2203                 data = 0;       /* unknown */
2204         }
2205         acpi_bus_generate_proc_event(ibm->acpi->device, event, data);
2206         acpi_bus_generate_netlink_event(ibm->acpi->device->pnp.device_class,
2207                                           ibm->acpi->device->dev.bus_id,
2208                                           event, data);
2209 }
2210
2211 static int dock_read(char *p)
2212 {
2213         int len = 0;
2214         int docked = dock_docked();
2215
2216         if (!dock_handle)
2217                 len += sprintf(p + len, "status:\t\tnot supported\n");
2218         else if (!docked)
2219                 len += sprintf(p + len, "status:\t\tundocked\n");
2220         else {
2221                 len += sprintf(p + len, "status:\t\tdocked\n");
2222                 len += sprintf(p + len, "commands:\tdock, undock\n");
2223         }
2224
2225         return len;
2226 }
2227
2228 static int dock_write(char *buf)
2229 {
2230         char *cmd;
2231
2232         if (!dock_docked())
2233                 return -ENODEV;
2234
2235         while ((cmd = next_cmd(&buf))) {
2236                 if (strlencmp(cmd, "undock") == 0) {
2237                         if (!acpi_evalf(dock_handle, NULL, "_DCK", "vd", 0) ||
2238                             !acpi_evalf(dock_handle, NULL, "_EJ0", "vd", 1))
2239                                 return -EIO;
2240                 } else if (strlencmp(cmd, "dock") == 0) {
2241                         if (!acpi_evalf(dock_handle, NULL, "_DCK", "vd", 1))
2242                                 return -EIO;
2243                 } else
2244                         return -EINVAL;
2245         }
2246
2247         return 0;
2248 }
2249
2250 #endif /* CONFIG_THINKPAD_ACPI_DOCK */
2251
2252 /*************************************************************************
2253  * Bay subdriver
2254  */
2255
2256 #ifdef CONFIG_THINKPAD_ACPI_BAY
2257 IBM_HANDLE(bay, root, "\\_SB.PCI.IDE.SECN.MAST",        /* 570 */
2258            "\\_SB.PCI0.IDE0.IDES.IDSM", /* 600e/x, 770e, 770x */
2259            "\\_SB.PCI0.SATA.SCND.MSTR", /* T60, X60, Z60 */
2260            "\\_SB.PCI0.IDE0.SCND.MSTR", /* all others */
2261            );                           /* A21e, R30, R31 */
2262 IBM_HANDLE(bay_ej, bay, "_EJ3", /* 600e/x, A2xm/p, A3x */
2263            "_EJ0",              /* all others */
2264            );                   /* 570,A21e,G4x,R30,R31,R32,R40e,R50e */
2265 IBM_HANDLE(bay2, root, "\\_SB.PCI0.IDE0.PRIM.SLAV",     /* A3x, R32 */
2266            "\\_SB.PCI0.IDE0.IDEP.IDPS", /* 600e/x, 770e, 770x */
2267            );                           /* all others */
2268 IBM_HANDLE(bay2_ej, bay2, "_EJ3",       /* 600e/x, 770e, A3x */
2269            "_EJ0",                      /* 770x */
2270            );                           /* all others */
2271
2272 static int __init bay_init(struct ibm_init_struct *iibm)
2273 {
2274         vdbg_printk(TPACPI_DBG_INIT, "initializing bay subdriver\n");
2275
2276         IBM_ACPIHANDLE_INIT(bay);
2277         if (bay_handle)
2278                 IBM_ACPIHANDLE_INIT(bay_ej);
2279         IBM_ACPIHANDLE_INIT(bay2);
2280         if (bay2_handle)
2281                 IBM_ACPIHANDLE_INIT(bay2_ej);
2282
2283         tp_features.bay_status = bay_handle &&
2284                 acpi_evalf(bay_handle, NULL, "_STA", "qv");
2285         tp_features.bay_status2 = bay2_handle &&
2286                 acpi_evalf(bay2_handle, NULL, "_STA", "qv");
2287
2288         tp_features.bay_eject = bay_handle && bay_ej_handle &&
2289                 (strlencmp(bay_ej_path, "_EJ0") == 0 || experimental);
2290         tp_features.bay_eject2 = bay2_handle && bay2_ej_handle &&
2291                 (strlencmp(bay2_ej_path, "_EJ0") == 0 || experimental);
2292
2293         vdbg_printk(TPACPI_DBG_INIT,
2294                 "bay 1: status %s, eject %s; bay 2: status %s, eject %s\n",
2295                 str_supported(tp_features.bay_status),
2296                 str_supported(tp_features.bay_eject),
2297                 str_supported(tp_features.bay_status2),
2298                 str_supported(tp_features.bay_eject2));
2299
2300         return (tp_features.bay_status || tp_features.bay_eject ||
2301                 tp_features.bay_status2 || tp_features.bay_eject2)? 0 : 1;
2302 }
2303
2304 static void bay_notify(struct ibm_struct *ibm, u32 event)
2305 {
2306         acpi_bus_generate_proc_event(ibm->acpi->device, event, 0);
2307         acpi_bus_generate_netlink_event(ibm->acpi->device->pnp.device_class,
2308                                           ibm->acpi->device->dev.bus_id,
2309                                           event, 0);
2310 }
2311
2312 #define bay_occupied(b) (_sta(b##_handle) & 1)
2313
2314 static int bay_read(char *p)
2315 {
2316         int len = 0;
2317         int occupied = bay_occupied(bay);
2318         int occupied2 = bay_occupied(bay2);
2319         int eject, eject2;
2320
2321         len += sprintf(p + len, "status:\t\t%s\n",
2322                 tp_features.bay_status ?
2323                         (occupied ? "occupied" : "unoccupied") :
2324                                 "not supported");
2325         if (tp_features.bay_status2)
2326                 len += sprintf(p + len, "status2:\t%s\n", occupied2 ?
2327                                "occupied" : "unoccupied");
2328
2329         eject = tp_features.bay_eject && occupied;
2330         eject2 = tp_features.bay_eject2 && occupied2;
2331
2332         if (eject && eject2)
2333                 len += sprintf(p + len, "commands:\teject, eject2\n");
2334         else if (eject)
2335                 len += sprintf(p + len, "commands:\teject\n");
2336         else if (eject2)
2337                 len += sprintf(p + len, "commands:\teject2\n");
2338
2339         return len;
2340 }
2341
2342 static int bay_write(char *buf)
2343 {
2344         char *cmd;
2345
2346         if (!tp_features.bay_eject && !tp_features.bay_eject2)
2347                 return -ENODEV;
2348
2349         while ((cmd = next_cmd(&buf))) {
2350                 if (tp_features.bay_eject && strlencmp(cmd, "eject") == 0) {
2351                         if (!acpi_evalf(bay_ej_handle, NULL, NULL, "vd", 1))
2352                                 return -EIO;
2353                 } else if (tp_features.bay_eject2 &&
2354                            strlencmp(cmd, "eject2") == 0) {
2355                         if (!acpi_evalf(bay2_ej_handle, NULL, NULL, "vd", 1))
2356                                 return -EIO;
2357                 } else
2358                         return -EINVAL;
2359         }
2360
2361         return 0;
2362 }
2363
2364 static struct tp_acpi_drv_struct ibm_bay_acpidriver = {
2365         .notify = bay_notify,
2366         .handle = &bay_handle,
2367         .type = ACPI_SYSTEM_NOTIFY,
2368 };
2369
2370 static struct ibm_struct bay_driver_data = {
2371         .name = "bay",
2372         .read = bay_read,
2373         .write = bay_write,
2374         .acpi = &ibm_bay_acpidriver,
2375 };
2376
2377 #endif /* CONFIG_THINKPAD_ACPI_BAY */
2378
2379 /*************************************************************************
2380  * CMOS subdriver
2381  */
2382
2383 /* sysfs cmos_command -------------------------------------------------- */
2384 static ssize_t cmos_command_store(struct device *dev,
2385                             struct device_attribute *attr,
2386                             const char *buf, size_t count)
2387 {
2388         unsigned long cmos_cmd;
2389         int res;
2390
2391         if (parse_strtoul(buf, 21, &cmos_cmd))
2392                 return -EINVAL;
2393
2394         res = issue_thinkpad_cmos_command(cmos_cmd);
2395         return (res)? res : count;
2396 }
2397
2398 static struct device_attribute dev_attr_cmos_command =
2399         __ATTR(cmos_command, S_IWUSR, NULL, cmos_command_store);
2400
2401 /* --------------------------------------------------------------------- */
2402
2403 static int __init cmos_init(struct ibm_init_struct *iibm)
2404 {
2405         int res;
2406
2407         vdbg_printk(TPACPI_DBG_INIT,
2408                 "initializing cmos commands subdriver\n");
2409
2410         IBM_ACPIHANDLE_INIT(cmos);
2411
2412         vdbg_printk(TPACPI_DBG_INIT, "cmos commands are %s\n",
2413                 str_supported(cmos_handle != NULL));
2414
2415         res = device_create_file(&tpacpi_pdev->dev, &dev_attr_cmos_command);
2416         if (res)
2417                 return res;
2418
2419         return (cmos_handle)? 0 : 1;
2420 }
2421
2422 static void cmos_exit(void)
2423 {
2424         device_remove_file(&tpacpi_pdev->dev, &dev_attr_cmos_command);
2425 }
2426
2427 static int cmos_read(char *p)
2428 {
2429         int len = 0;
2430
2431         /* cmos not supported on 570, 600e/x, 770e, 770x, A21e, A2xm/p,
2432            R30, R31, T20-22, X20-21 */
2433         if (!cmos_handle)
2434                 len += sprintf(p + len, "status:\t\tnot supported\n");
2435         else {
2436                 len += sprintf(p + len, "status:\t\tsupported\n");
2437                 len += sprintf(p + len, "commands:\t<cmd> (<cmd> is 0-21)\n");
2438         }
2439
2440         return len;
2441 }
2442
2443 static int cmos_write(char *buf)
2444 {
2445         char *cmd;
2446         int cmos_cmd, res;
2447
2448         while ((cmd = next_cmd(&buf))) {
2449                 if (sscanf(cmd, "%u", &cmos_cmd) == 1 &&
2450                     cmos_cmd >= 0 && cmos_cmd <= 21) {
2451                         /* cmos_cmd set */
2452                 } else
2453                         return -EINVAL;
2454
2455                 res = issue_thinkpad_cmos_command(cmos_cmd);
2456                 if (res)
2457                         return res;
2458         }
2459
2460         return 0;
2461 }
2462
2463 static struct ibm_struct cmos_driver_data = {
2464         .name = "cmos",
2465         .read = cmos_read,
2466         .write = cmos_write,
2467         .exit = cmos_exit,
2468 };
2469
2470 /*************************************************************************
2471  * LED subdriver
2472  */
2473
2474 static enum led_access_mode led_supported;
2475
2476 IBM_HANDLE(led, ec, "SLED",     /* 570 */
2477            "SYSL",              /* 600e/x, 770e, 770x, A21e, A2xm/p, T20-22, X20-21 */
2478            "LED",               /* all others */
2479            );                   /* R30, R31 */
2480
2481 static int __init led_init(struct ibm_init_struct *iibm)
2482 {
2483         vdbg_printk(TPACPI_DBG_INIT, "initializing LED subdriver\n");
2484
2485         IBM_ACPIHANDLE_INIT(led);
2486
2487         if (!led_handle)
2488                 /* led not supported on R30, R31 */
2489                 led_supported = TPACPI_LED_NONE;
2490         else if (strlencmp(led_path, "SLED") == 0)
2491                 /* 570 */
2492                 led_supported = TPACPI_LED_570;
2493         else if (strlencmp(led_path, "SYSL") == 0)
2494                 /* 600e/x, 770e, 770x, A21e, A2xm/p, T20-22, X20-21 */
2495                 led_supported = TPACPI_LED_OLD;
2496         else
2497                 /* all others */
2498                 led_supported = TPACPI_LED_NEW;
2499
2500         vdbg_printk(TPACPI_DBG_INIT, "LED commands are %s, mode %d\n",
2501                 str_supported(led_supported), led_supported);
2502
2503         return (led_supported != TPACPI_LED_NONE)? 0 : 1;
2504 }
2505
2506 #define led_status(s) ((s) == 0 ? "off" : ((s) == 1 ? "on" : "blinking"))
2507
2508 static int led_read(char *p)
2509 {
2510         int len = 0;
2511
2512         if (!led_supported) {
2513                 len += sprintf(p + len, "status:\t\tnot supported\n");
2514                 return len;
2515         }
2516         len += sprintf(p + len, "status:\t\tsupported\n");
2517
2518         if (led_supported == TPACPI_LED_570) {
2519                 /* 570 */
2520                 int i, status;
2521                 for (i = 0; i < 8; i++) {
2522                         if (!acpi_evalf(ec_handle,
2523                                         &status, "GLED", "dd", 1 << i))
2524                                 return -EIO;
2525                         len += sprintf(p + len, "%d:\t\t%s\n",
2526                                        i, led_status(status));
2527                 }
2528         }
2529
2530         len += sprintf(p + len, "commands:\t"
2531                        "<led> on, <led> off, <led> blink (<led> is 0-7)\n");
2532
2533         return len;
2534 }
2535
2536 /* off, on, blink */
2537 static const int led_sled_arg1[] = { 0, 1, 3 };
2538 static const int led_exp_hlbl[] = { 0, 0, 1 };  /* led# * */
2539 static const int led_exp_hlcl[] = { 0, 1, 1 };  /* led# * */
2540 static const int led_led_arg1[] = { 0, 0x80, 0xc0 };
2541
2542 static int led_write(char *buf)
2543 {
2544         char *cmd;
2545         int led, ind, ret;
2546
2547         if (!led_supported)
2548                 return -ENODEV;
2549
2550         while ((cmd = next_cmd(&buf))) {
2551                 if (sscanf(cmd, "%d", &led) != 1 || led < 0 || led > 7)
2552                         return -EINVAL;
2553
2554                 if (strstr(cmd, "off")) {
2555                         ind = 0;
2556                 } else if (strstr(cmd, "on")) {
2557                         ind = 1;
2558                 } else if (strstr(cmd, "blink")) {
2559                         ind = 2;
2560                 } else
2561                         return -EINVAL;
2562
2563                 if (led_supported == TPACPI_LED_570) {
2564                         /* 570 */
2565                         led = 1 << led;
2566                         if (!acpi_evalf(led_handle, NULL, NULL, "vdd",
2567                                         led, led_sled_arg1[ind]))
2568                                 return -EIO;
2569                 } else if (led_supported == TPACPI_LED_OLD) {
2570                         /* 600e/x, 770e, 770x, A21e, A2xm/p, T20-22, X20 */
2571                         led = 1 << led;
2572                         ret = ec_write(TPACPI_LED_EC_HLMS, led);
2573                         if (ret >= 0)
2574                                 ret =
2575                                     ec_write(TPACPI_LED_EC_HLBL,
2576                                              led * led_exp_hlbl[ind]);
2577                         if (ret >= 0)
2578                                 ret =
2579                                     ec_write(TPACPI_LED_EC_HLCL,
2580                                              led * led_exp_hlcl[ind]);
2581                         if (ret < 0)
2582                                 return ret;
2583                 } else {
2584                         /* all others */
2585                         if (!acpi_evalf(led_handle, NULL, NULL, "vdd",
2586                                         led, led_led_arg1[ind]))
2587                                 return -EIO;
2588                 }
2589         }
2590
2591         return 0;
2592 }
2593
2594 static struct ibm_struct led_driver_data = {
2595         .name = "led",
2596         .read = led_read,
2597         .write = led_write,
2598 };
2599
2600 /*************************************************************************
2601  * Beep subdriver
2602  */
2603
2604 IBM_HANDLE(beep, ec, "BEEP");   /* all except R30, R31 */
2605
2606 static int __init beep_init(struct ibm_init_struct *iibm)
2607 {
2608         vdbg_printk(TPACPI_DBG_INIT, "initializing beep subdriver\n");
2609
2610         IBM_ACPIHANDLE_INIT(beep);
2611
2612         vdbg_printk(TPACPI_DBG_INIT, "beep is %s\n",
2613                 str_supported(beep_handle != NULL));
2614
2615         return (beep_handle)? 0 : 1;
2616 }
2617
2618 static int beep_read(char *p)
2619 {
2620         int len = 0;
2621
2622         if (!beep_handle)
2623                 len += sprintf(p + len, "status:\t\tnot supported\n");
2624         else {
2625                 len += sprintf(p + len, "status:\t\tsupported\n");
2626                 len += sprintf(p + len, "commands:\t<cmd> (<cmd> is 0-17)\n");
2627         }
2628
2629         return len;
2630 }
2631
2632 static int beep_write(char *buf)
2633 {
2634         char *cmd;
2635         int beep_cmd;
2636
2637         if (!beep_handle)
2638                 return -ENODEV;
2639
2640         while ((cmd = next_cmd(&buf))) {
2641                 if (sscanf(cmd, "%u", &beep_cmd) == 1 &&
2642                     beep_cmd >= 0 && beep_cmd <= 17) {
2643                         /* beep_cmd set */
2644                 } else
2645                         return -EINVAL;
2646                 if (!acpi_evalf(beep_handle, NULL, NULL, "vdd", beep_cmd, 0))
2647                         return -EIO;
2648         }
2649
2650         return 0;
2651 }
2652
2653 static struct ibm_struct beep_driver_data = {
2654         .name = "beep",
2655         .read = beep_read,
2656         .write = beep_write,
2657 };
2658
2659 /*************************************************************************
2660  * Thermal subdriver
2661  */
2662
2663 static enum thermal_access_mode thermal_read_mode;
2664
2665 /* sysfs temp##_input -------------------------------------------------- */
2666
2667 static ssize_t thermal_temp_input_show(struct device *dev,
2668                            struct device_attribute *attr,
2669                            char *buf)
2670 {
2671         struct sensor_device_attribute *sensor_attr =
2672                                         to_sensor_dev_attr(attr);
2673         int idx = sensor_attr->index;
2674         s32 value;
2675         int res;
2676
2677         res = thermal_get_sensor(idx, &value);
2678         if (res)
2679                 return res;
2680         if (value == TP_EC_THERMAL_TMP_NA * 1000)
2681                 return -ENXIO;
2682
2683         return snprintf(buf, PAGE_SIZE, "%d\n", value);
2684 }
2685
2686 #define THERMAL_SENSOR_ATTR_TEMP(_idxA, _idxB) \
2687          SENSOR_ATTR(temp##_idxA##_input, S_IRUGO, thermal_temp_input_show, NULL, _idxB)
2688
2689 static struct sensor_device_attribute sensor_dev_attr_thermal_temp_input[] = {
2690         THERMAL_SENSOR_ATTR_TEMP(1, 0),
2691         THERMAL_SENSOR_ATTR_TEMP(2, 1),
2692         THERMAL_SENSOR_ATTR_TEMP(3, 2),
2693         THERMAL_SENSOR_ATTR_TEMP(4, 3),
2694         THERMAL_SENSOR_ATTR_TEMP(5, 4),
2695         THERMAL_SENSOR_ATTR_TEMP(6, 5),
2696         THERMAL_SENSOR_ATTR_TEMP(7, 6),
2697         THERMAL_SENSOR_ATTR_TEMP(8, 7),
2698         THERMAL_SENSOR_ATTR_TEMP(9, 8),
2699         THERMAL_SENSOR_ATTR_TEMP(10, 9),
2700         THERMAL_SENSOR_ATTR_TEMP(11, 10),
2701         THERMAL_SENSOR_ATTR_TEMP(12, 11),
2702         THERMAL_SENSOR_ATTR_TEMP(13, 12),
2703         THERMAL_SENSOR_ATTR_TEMP(14, 13),
2704         THERMAL_SENSOR_ATTR_TEMP(15, 14),
2705         THERMAL_SENSOR_ATTR_TEMP(16, 15),
2706 };
2707
2708 #define THERMAL_ATTRS(X) \
2709         &sensor_dev_attr_thermal_temp_input[X].dev_attr.attr
2710
2711 static struct attribute *thermal_temp_input_attr[] = {
2712         THERMAL_ATTRS(8),
2713         THERMAL_ATTRS(9),
2714         THERMAL_ATTRS(10),
2715         THERMAL_ATTRS(11),
2716         THERMAL_ATTRS(12),
2717         THERMAL_ATTRS(13),
2718         THERMAL_ATTRS(14),
2719         THERMAL_ATTRS(15),
2720         THERMAL_ATTRS(0),
2721         THERMAL_ATTRS(1),
2722         THERMAL_ATTRS(2),
2723         THERMAL_ATTRS(3),
2724         THERMAL_ATTRS(4),
2725         THERMAL_ATTRS(5),
2726         THERMAL_ATTRS(6),
2727         THERMAL_ATTRS(7),
2728         NULL
2729 };
2730
2731 static const struct attribute_group thermal_temp_input16_group = {
2732         .attrs = thermal_temp_input_attr
2733 };
2734
2735 static const struct attribute_group thermal_temp_input8_group = {
2736         .attrs = &thermal_temp_input_attr[8]
2737 };
2738
2739 #undef THERMAL_SENSOR_ATTR_TEMP
2740 #undef THERMAL_ATTRS
2741
2742 /* --------------------------------------------------------------------- */
2743
2744 static int __init thermal_init(struct ibm_init_struct *iibm)
2745 {
2746         u8 t, ta1, ta2;
2747         int i;
2748         int acpi_tmp7;
2749         int res;
2750
2751         vdbg_printk(TPACPI_DBG_INIT, "initializing thermal subdriver\n");
2752
2753         acpi_tmp7 = acpi_evalf(ec_handle, NULL, "TMP7", "qv");
2754
2755         if (thinkpad_id.ec_model) {
2756                 /*
2757                  * Direct EC access mode: sensors at registers
2758                  * 0x78-0x7F, 0xC0-0xC7.  Registers return 0x00 for
2759                  * non-implemented, thermal sensors return 0x80 when
2760                  * not available
2761                  */
2762
2763                 ta1 = ta2 = 0;
2764                 for (i = 0; i < 8; i++) {
2765                         if (acpi_ec_read(TP_EC_THERMAL_TMP0 + i, &t)) {
2766                                 ta1 |= t;
2767                         } else {
2768                                 ta1 = 0;
2769                                 break;
2770                         }
2771                         if (acpi_ec_read(TP_EC_THERMAL_TMP8 + i, &t)) {
2772                                 ta2 |= t;
2773                         } else {
2774                                 ta1 = 0;
2775                                 break;
2776                         }
2777                 }
2778                 if (ta1 == 0) {
2779                         /* This is sheer paranoia, but we handle it anyway */
2780                         if (acpi_tmp7) {
2781                                 printk(IBM_ERR
2782                                        "ThinkPad ACPI EC access misbehaving, "
2783                                        "falling back to ACPI TMPx access mode\n");
2784                                 thermal_read_mode = TPACPI_THERMAL_ACPI_TMP07;
2785                         } else {
2786                                 printk(IBM_ERR
2787                                        "ThinkPad ACPI EC access misbehaving, "
2788                                        "disabling thermal sensors access\n");
2789                                 thermal_read_mode = TPACPI_THERMAL_NONE;
2790                         }
2791                 } else {
2792                         thermal_read_mode =
2793                             (ta2 != 0) ?
2794                             TPACPI_THERMAL_TPEC_16 : TPACPI_THERMAL_TPEC_8;
2795                 }
2796         } else if (acpi_tmp7) {
2797                 if (acpi_evalf(ec_handle, NULL, "UPDT", "qv")) {
2798                         /* 600e/x, 770e, 770x */
2799                         thermal_read_mode = TPACPI_THERMAL_ACPI_UPDT;
2800                 } else {
2801                         /* Standard ACPI TMPx access, max 8 sensors */
2802                         thermal_read_mode = TPACPI_THERMAL_ACPI_TMP07;
2803                 }
2804         } else {
2805                 /* temperatures not supported on 570, G4x, R30, R31, R32 */
2806                 thermal_read_mode = TPACPI_THERMAL_NONE;
2807         }
2808
2809         vdbg_printk(TPACPI_DBG_INIT, "thermal is %s, mode %d\n",
2810                 str_supported(thermal_read_mode != TPACPI_THERMAL_NONE),
2811                 thermal_read_mode);
2812
2813         switch(thermal_read_mode) {
2814         case TPACPI_THERMAL_TPEC_16:
2815                 res = sysfs_create_group(&tpacpi_pdev->dev.kobj,
2816                                 &thermal_temp_input16_group);
2817                 if (res)
2818                         return res;
2819                 break;
2820         case TPACPI_THERMAL_TPEC_8:
2821         case TPACPI_THERMAL_ACPI_TMP07:
2822         case TPACPI_THERMAL_ACPI_UPDT:
2823                 res = sysfs_create_group(&tpacpi_pdev->dev.kobj,
2824                                 &thermal_temp_input8_group);
2825                 if (res)
2826                         return res;
2827                 break;
2828         case TPACPI_THERMAL_NONE:
2829         default:
2830                 return 1;
2831         }
2832
2833         return 0;
2834 }
2835
2836 static void thermal_exit(void)
2837 {
2838         switch(thermal_read_mode) {
2839         case TPACPI_THERMAL_TPEC_16:
2840                 sysfs_remove_group(&tpacpi_pdev->dev.kobj,
2841                                    &thermal_temp_input16_group);
2842                 break;
2843         case TPACPI_THERMAL_TPEC_8:
2844         case TPACPI_THERMAL_ACPI_TMP07:
2845         case TPACPI_THERMAL_ACPI_UPDT:
2846                 sysfs_remove_group(&tpacpi_pdev->dev.kobj,
2847                                    &thermal_temp_input16_group);
2848                 break;
2849         case TPACPI_THERMAL_NONE:
2850         default:
2851                 break;
2852         }
2853 }
2854
2855 /* idx is zero-based */
2856 static int thermal_get_sensor(int idx, s32 *value)
2857 {
2858         int t;
2859         s8 tmp;
2860         char tmpi[5];
2861
2862         t = TP_EC_THERMAL_TMP0;
2863
2864         switch (thermal_read_mode) {
2865 #if TPACPI_MAX_THERMAL_SENSORS >= 16
2866         case TPACPI_THERMAL_TPEC_16:
2867                 if (idx >= 8 && idx <= 15) {
2868                         t = TP_EC_THERMAL_TMP8;
2869                         idx -= 8;
2870                 }
2871                 /* fallthrough */
2872 #endif
2873         case TPACPI_THERMAL_TPEC_8:
2874                 if (idx <= 7) {
2875                         if (!acpi_ec_read(t + idx, &tmp))
2876                                 return -EIO;
2877                         *value = tmp * 1000;
2878                         return 0;
2879                 }
2880                 break;
2881
2882         case TPACPI_THERMAL_ACPI_UPDT:
2883                 if (idx <= 7) {
2884                         snprintf(tmpi, sizeof(tmpi), "TMP%c", '0' + idx);
2885                         if (!acpi_evalf(ec_handle, NULL, "UPDT", "v"))
2886                                 return -EIO;
2887                         if (!acpi_evalf(ec_handle, &t, tmpi, "d"))
2888                                 return -EIO;
2889                         *value = (t - 2732) * 100;
2890                         return 0;
2891                 }
2892                 break;
2893
2894         case TPACPI_THERMAL_ACPI_TMP07:
2895                 if (idx <= 7) {
2896                         snprintf(tmpi, sizeof(tmpi), "TMP%c", '0' + idx);
2897                         if (!acpi_evalf(ec_handle, &t, tmpi, "d"))
2898                                 return -EIO;
2899                         if (t > 127 || t < -127)
2900                                 t = TP_EC_THERMAL_TMP_NA;
2901                         *value = t * 1000;
2902                         return 0;
2903                 }
2904                 break;
2905
2906         case TPACPI_THERMAL_NONE:
2907         default:
2908                 return -ENOSYS;
2909         }
2910
2911         return -EINVAL;
2912 }
2913
2914 static int thermal_get_sensors(struct ibm_thermal_sensors_struct *s)
2915 {
2916         int res, i;
2917         int n;
2918
2919         n = 8;
2920         i = 0;
2921
2922         if (!s)
2923                 return -EINVAL;
2924
2925         if (thermal_read_mode == TPACPI_THERMAL_TPEC_16)
2926                 n = 16;
2927
2928         for(i = 0 ; i < n; i++) {
2929                 res = thermal_get_sensor(i, &s->temp[i]);
2930                 if (res)
2931                         return res;
2932         }
2933
2934         return n;
2935 }
2936
2937 static int thermal_read(char *p)
2938 {
2939         int len = 0;
2940         int n, i;
2941         struct ibm_thermal_sensors_struct t;
2942
2943         n = thermal_get_sensors(&t);
2944         if (unlikely(n < 0))
2945                 return n;
2946
2947         len += sprintf(p + len, "temperatures:\t");
2948
2949         if (n > 0) {
2950                 for (i = 0; i < (n - 1); i++)
2951                         len += sprintf(p + len, "%d ", t.temp[i] / 1000);
2952                 len += sprintf(p + len, "%d\n", t.temp[i] / 1000);
2953         } else
2954                 len += sprintf(p + len, "not supported\n");
2955
2956         return len;
2957 }
2958
2959 static struct ibm_struct thermal_driver_data = {
2960         .name = "thermal",
2961         .read = thermal_read,
2962         .exit = thermal_exit,
2963 };
2964
2965 /*************************************************************************
2966  * EC Dump subdriver
2967  */
2968
2969 static u8 ecdump_regs[256];
2970
2971 static int ecdump_read(char *p)
2972 {
2973         int len = 0;
2974         int i, j;
2975         u8 v;
2976
2977         len += sprintf(p + len, "EC      "
2978                        " +00 +01 +02 +03 +04 +05 +06 +07"
2979                        " +08 +09 +0a +0b +0c +0d +0e +0f\n");
2980         for (i = 0; i < 256; i += 16) {
2981                 len += sprintf(p + len, "EC 0x%02x:", i);
2982                 for (j = 0; j < 16; j++) {
2983                         if (!acpi_ec_read(i + j, &v))
2984                                 break;
2985                         if (v != ecdump_regs[i + j])
2986                                 len += sprintf(p + len, " *%02x", v);
2987                         else
2988                                 len += sprintf(p + len, "  %02x", v);
2989                         ecdump_regs[i + j] = v;
2990                 }
2991                 len += sprintf(p + len, "\n");
2992                 if (j != 16)
2993                         break;
2994         }
2995
2996         /* These are way too dangerous to advertise openly... */
2997 #if 0
2998         len += sprintf(p + len, "commands:\t0x<offset> 0x<value>"
2999                        " (<offset> is 00-ff, <value> is 00-ff)\n");
3000         len += sprintf(p + len, "commands:\t0x<offset> <value>  "
3001                        " (<offset> is 00-ff, <value> is 0-255)\n");
3002 #endif
3003         return len;
3004 }
3005
3006 static int ecdump_write(char *buf)
3007 {
3008         char *cmd;
3009         int i, v;
3010
3011         while ((cmd = next_cmd(&buf))) {
3012                 if (sscanf(cmd, "0x%x 0x%x", &i, &v) == 2) {
3013                         /* i and v set */
3014                 } else if (sscanf(cmd, "0x%x %u", &i, &v) == 2) {
3015                         /* i and v set */
3016                 } else
3017                         return -EINVAL;
3018                 if (i >= 0 && i < 256 && v >= 0 && v < 256) {
3019                         if (!acpi_ec_write(i, v))
3020                                 return -EIO;
3021                 } else
3022                         return -EINVAL;
3023         }
3024
3025         return 0;
3026 }
3027
3028 static struct ibm_struct ecdump_driver_data = {
3029         .name = "ecdump",
3030         .read = ecdump_read,
3031         .write = ecdump_write,
3032         .flags.experimental = 1,
3033 };
3034
3035 /*************************************************************************
3036  * Backlight/brightness subdriver
3037  */
3038
3039 static struct backlight_device *ibm_backlight_device;
3040
3041 static struct backlight_ops ibm_backlight_data = {
3042         .get_brightness = brightness_get,
3043         .update_status  = brightness_update_status,
3044 };
3045
3046 static struct mutex brightness_mutex;
3047
3048 static int __init brightness_init(struct ibm_init_struct *iibm)
3049 {
3050         int b;
3051
3052         vdbg_printk(TPACPI_DBG_INIT, "initializing brightness subdriver\n");
3053
3054         mutex_init(&brightness_mutex);
3055
3056         if (!brightness_mode) {
3057                 if (thinkpad_id.vendor == PCI_VENDOR_ID_LENOVO)
3058                         brightness_mode = 2;
3059                 else
3060                         brightness_mode = 3;
3061
3062                 dbg_printk(TPACPI_DBG_INIT, "selected brightness_mode=%d\n",
3063                         brightness_mode);
3064         }
3065
3066         if (brightness_mode > 3)
3067                 return -EINVAL;
3068
3069         b = brightness_get(NULL);
3070         if (b < 0)
3071                 return 1;
3072
3073         ibm_backlight_device = backlight_device_register(
3074                                         TPACPI_BACKLIGHT_DEV_NAME, NULL, NULL,
3075                                         &ibm_backlight_data);
3076         if (IS_ERR(ibm_backlight_device)) {
3077                 printk(IBM_ERR "Could not register backlight device\n");
3078                 return PTR_ERR(ibm_backlight_device);
3079         }
3080         vdbg_printk(TPACPI_DBG_INIT, "brightness is supported\n");
3081
3082         ibm_backlight_device->props.max_brightness = 7;
3083         ibm_backlight_device->props.brightness = b;
3084         backlight_update_status(ibm_backlight_device);
3085
3086         return 0;
3087 }
3088
3089 static void brightness_exit(void)
3090 {
3091         if (ibm_backlight_device) {
3092                 vdbg_printk(TPACPI_DBG_EXIT,
3093                             "calling backlight_device_unregister()\n");
3094                 backlight_device_unregister(ibm_backlight_device);
3095                 ibm_backlight_device = NULL;
3096         }
3097 }
3098
3099 static int brightness_update_status(struct backlight_device *bd)
3100 {
3101         return brightness_set(
3102                 (bd->props.fb_blank == FB_BLANK_UNBLANK &&
3103                  bd->props.power == FB_BLANK_UNBLANK) ?
3104                                 bd->props.brightness : 0);
3105 }
3106
3107 /*
3108  * ThinkPads can read brightness from two places: EC 0x31, or
3109  * CMOS NVRAM byte 0x5E, bits 0-3.
3110  */
3111 static int brightness_get(struct backlight_device *bd)
3112 {
3113         u8 lec = 0, lcmos = 0, level = 0;
3114
3115         if (brightness_mode & 1) {
3116                 if (!acpi_ec_read(brightness_offset, &lec))
3117                         return -EIO;
3118                 lec &= 7;
3119                 level = lec;
3120         };
3121         if (brightness_mode & 2) {
3122                 lcmos = (nvram_read_byte(TP_NVRAM_ADDR_BRIGHTNESS)
3123                          & TP_NVRAM_MASK_LEVEL_BRIGHTNESS)
3124                         >> TP_NVRAM_POS_LEVEL_BRIGHTNESS;
3125                 level = lcmos;
3126         }
3127
3128         if (brightness_mode == 3 && lec != lcmos) {
3129                 printk(IBM_ERR
3130                         "CMOS NVRAM (%u) and EC (%u) do not agree "
3131                         "on display brightness level\n",
3132                         (unsigned int) lcmos,
3133                         (unsigned int) lec);
3134                 return -EIO;
3135         }
3136
3137         return level;
3138 }
3139
3140 static int brightness_set(int value)
3141 {
3142         int cmos_cmd, inc, i, res;
3143         int current_value;
3144
3145         if (value > 7)
3146                 return -EINVAL;
3147
3148         res = mutex_lock_interruptible(&brightness_mutex);
3149         if (res < 0)
3150                 return res;
3151
3152         current_value = brightness_get(NULL);
3153         if (current_value < 0) {
3154                 res = current_value;
3155                 goto errout;
3156         }
3157
3158         cmos_cmd = value > current_value ?
3159                         TP_CMOS_BRIGHTNESS_UP :
3160                         TP_CMOS_BRIGHTNESS_DOWN;
3161         inc = value > current_value ? 1 : -1;
3162
3163         res = 0;
3164         for (i = current_value; i != value; i += inc) {
3165                 if ((brightness_mode & 2) &&
3166                     issue_thinkpad_cmos_command(cmos_cmd)) {
3167                         res = -EIO;
3168                         goto errout;
3169                 }
3170                 if ((brightness_mode & 1) &&
3171                     !acpi_ec_write(brightness_offset, i + inc)) {
3172                         res = -EIO;
3173                         goto errout;;
3174                 }
3175         }
3176
3177 errout:
3178         mutex_unlock(&brightness_mutex);
3179         return res;
3180 }
3181
3182 static int brightness_read(char *p)
3183 {
3184         int len = 0;
3185         int level;
3186
3187         if ((level = brightness_get(NULL)) < 0) {
3188                 len += sprintf(p + len, "level:\t\tunreadable\n");
3189         } else {
3190                 len += sprintf(p + len, "level:\t\t%d\n", level & 0x7);
3191                 len += sprintf(p + len, "commands:\tup, down\n");
3192                 len += sprintf(p + len, "commands:\tlevel <level>"
3193                                " (<level> is 0-7)\n");
3194         }
3195
3196         return len;
3197 }
3198
3199 static int brightness_write(char *buf)
3200 {
3201         int level;
3202         int new_level;
3203         char *cmd;
3204
3205         while ((cmd = next_cmd(&buf))) {
3206                 if ((level = brightness_get(NULL)) < 0)
3207                         return level;
3208                 level &= 7;
3209
3210                 if (strlencmp(cmd, "up") == 0) {
3211                         new_level = level == 7 ? 7 : level + 1;
3212                 } else if (strlencmp(cmd, "down") == 0) {
3213                         new_level = level == 0 ? 0 : level - 1;
3214                 } else if (sscanf(cmd, "level %d", &new_level) == 1 &&
3215                            new_level >= 0 && new_level <= 7) {
3216                         /* new_level set */
3217                 } else
3218                         return -EINVAL;
3219
3220                 brightness_set(new_level);
3221         }
3222
3223         return 0;
3224 }
3225
3226 static struct ibm_struct brightness_driver_data = {
3227         .name = "brightness",
3228         .read = brightness_read,
3229         .write = brightness_write,
3230         .exit = brightness_exit,
3231 };
3232
3233 /*************************************************************************
3234  * Volume subdriver
3235  */
3236
3237 static int volume_read(char *p)
3238 {
3239         int len = 0;
3240         u8 level;
3241
3242         if (!acpi_ec_read(volume_offset, &level)) {
3243                 len += sprintf(p + len, "level:\t\tunreadable\n");
3244         } else {
3245                 len += sprintf(p + len, "level:\t\t%d\n", level & 0xf);
3246                 len += sprintf(p + len, "mute:\t\t%s\n", onoff(level, 6));
3247                 len += sprintf(p + len, "commands:\tup, down, mute\n");
3248                 len += sprintf(p + len, "commands:\tlevel <level>"
3249                                " (<level> is 0-15)\n");
3250         }
3251
3252         return len;
3253 }
3254
3255 static int volume_write(char *buf)
3256 {
3257         int cmos_cmd, inc, i;
3258         u8 level, mute;
3259         int new_level, new_mute;
3260         char *cmd;
3261
3262         while ((cmd = next_cmd(&buf))) {
3263                 if (!acpi_ec_read(volume_offset, &level))
3264                         return -EIO;
3265                 new_mute = mute = level & 0x40;
3266                 new_level = level = level & 0xf;
3267
3268                 if (strlencmp(cmd, "up") == 0) {
3269                         if (mute)
3270                                 new_mute = 0;
3271                         else
3272                                 new_level = level == 15 ? 15 : level + 1;
3273                 } else if (strlencmp(cmd, "down") == 0) {
3274                         if (mute)
3275                                 new_mute = 0;
3276                         else
3277                                 new_level = level == 0 ? 0 : level - 1;
3278                 } else if (sscanf(cmd, "level %d", &new_level) == 1 &&
3279                            new_level >= 0 && new_level <= 15) {
3280                         /* new_level set */
3281                 } else if (strlencmp(cmd, "mute") == 0) {
3282                         new_mute = 0x40;
3283                 } else
3284                         return -EINVAL;
3285
3286                 if (new_level != level) {       /* mute doesn't change */
3287                         cmos_cmd = new_level > level ? TP_CMOS_VOLUME_UP : TP_CMOS_VOLUME_DOWN;
3288                         inc = new_level > level ? 1 : -1;
3289
3290                   &n