]> nv-tegra.nvidia Code Review - linux-2.6.git/blob - drivers/misc/thinkpad_acpi.c
ACPI: thinkpad-acpi: checkpoint sysfs interface version due to input layer
[linux-2.6.git] / 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.14"
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         ibm->acpi->driver->ops.add = &tpacpi_device_add;
415
416         rc = acpi_bus_register_driver(ibm->acpi->driver);
417         if (rc < 0) {
418                 printk(IBM_ERR "acpi_bus_register_driver(%s) failed: %d\n",
419                        ibm->acpi->hid, rc);
420                 kfree(ibm->acpi->driver);
421                 ibm->acpi->driver = NULL;
422         } else if (!rc)
423                 ibm->flags.acpi_driver_registered = 1;
424
425         return rc;
426 }
427
428
429 /****************************************************************************
430  ****************************************************************************
431  *
432  * Procfs Helpers
433  *
434  ****************************************************************************
435  ****************************************************************************/
436
437 static int dispatch_procfs_read(char *page, char **start, off_t off,
438                         int count, int *eof, void *data)
439 {
440         struct ibm_struct *ibm = data;
441         int len;
442
443         if (!ibm || !ibm->read)
444                 return -EINVAL;
445
446         len = ibm->read(page);
447         if (len < 0)
448                 return len;
449
450         if (len <= off + count)
451                 *eof = 1;
452         *start = page + off;
453         len -= off;
454         if (len > count)
455                 len = count;
456         if (len < 0)
457                 len = 0;
458
459         return len;
460 }
461
462 static int dispatch_procfs_write(struct file *file,
463                         const char __user * userbuf,
464                         unsigned long count, void *data)
465 {
466         struct ibm_struct *ibm = data;
467         char *kernbuf;
468         int ret;
469
470         if (!ibm || !ibm->write)
471                 return -EINVAL;
472
473         kernbuf = kmalloc(count + 2, GFP_KERNEL);
474         if (!kernbuf)
475                 return -ENOMEM;
476
477         if (copy_from_user(kernbuf, userbuf, count)) {
478                 kfree(kernbuf);
479                 return -EFAULT;
480         }
481
482         kernbuf[count] = 0;
483         strcat(kernbuf, ",");
484         ret = ibm->write(kernbuf);
485         if (ret == 0)
486                 ret = count;
487
488         kfree(kernbuf);
489
490         return ret;
491 }
492
493 static char *next_cmd(char **cmds)
494 {
495         char *start = *cmds;
496         char *end;
497
498         while ((end = strchr(start, ',')) && end == start)
499                 start = end + 1;
500
501         if (!end)
502                 return NULL;
503
504         *end = 0;
505         *cmds = end + 1;
506         return start;
507 }
508
509
510 /****************************************************************************
511  ****************************************************************************
512  *
513  * Device model: input, hwmon and platform
514  *
515  ****************************************************************************
516  ****************************************************************************/
517
518 static struct platform_device *tpacpi_pdev;
519 static struct class_device *tpacpi_hwmon;
520 static struct input_dev *tpacpi_inputdev;
521
522
523 static int tpacpi_resume_handler(struct platform_device *pdev)
524 {
525         struct ibm_struct *ibm, *itmp;
526
527         list_for_each_entry_safe(ibm, itmp,
528                                  &tpacpi_all_drivers,
529                                  all_drivers) {
530                 if (ibm->resume)
531                         (ibm->resume)();
532         }
533
534         return 0;
535 }
536
537 static struct platform_driver tpacpi_pdriver = {
538         .driver = {
539                 .name = IBM_DRVR_NAME,
540                 .owner = THIS_MODULE,
541         },
542         .resume = tpacpi_resume_handler,
543 };
544
545
546 /*************************************************************************
547  * thinkpad-acpi driver attributes
548  */
549
550 /* interface_version --------------------------------------------------- */
551 static ssize_t tpacpi_driver_interface_version_show(
552                                 struct device_driver *drv,
553                                 char *buf)
554 {
555         return snprintf(buf, PAGE_SIZE, "0x%08x\n", TPACPI_SYSFS_VERSION);
556 }
557
558 static DRIVER_ATTR(interface_version, S_IRUGO,
559                 tpacpi_driver_interface_version_show, NULL);
560
561 /* debug_level --------------------------------------------------------- */
562 static ssize_t tpacpi_driver_debug_show(struct device_driver *drv,
563                                                 char *buf)
564 {
565         return snprintf(buf, PAGE_SIZE, "0x%04x\n", dbg_level);
566 }
567
568 static ssize_t tpacpi_driver_debug_store(struct device_driver *drv,
569                                                 const char *buf, size_t count)
570 {
571         unsigned long t;
572
573         if (parse_strtoul(buf, 0xffff, &t))
574                 return -EINVAL;
575
576         dbg_level = t;
577
578         return count;
579 }
580
581 static DRIVER_ATTR(debug_level, S_IWUSR | S_IRUGO,
582                 tpacpi_driver_debug_show, tpacpi_driver_debug_store);
583
584 /* version ------------------------------------------------------------- */
585 static ssize_t tpacpi_driver_version_show(struct device_driver *drv,
586                                                 char *buf)
587 {
588         return snprintf(buf, PAGE_SIZE, "%s v%s\n", IBM_DESC, IBM_VERSION);
589 }
590
591 static DRIVER_ATTR(version, S_IRUGO,
592                 tpacpi_driver_version_show, NULL);
593
594 /* --------------------------------------------------------------------- */
595
596 static struct driver_attribute* tpacpi_driver_attributes[] = {
597         &driver_attr_debug_level, &driver_attr_version,
598         &driver_attr_interface_version,
599 };
600
601 static int __init tpacpi_create_driver_attributes(struct device_driver *drv)
602 {
603         int i, res;
604
605         i = 0;
606         res = 0;
607         while (!res && i < ARRAY_SIZE(tpacpi_driver_attributes)) {
608                 res = driver_create_file(drv, tpacpi_driver_attributes[i]);
609                 i++;
610         }
611
612         return res;
613 }
614
615 static void tpacpi_remove_driver_attributes(struct device_driver *drv)
616 {
617         int i;
618
619         for(i = 0; i < ARRAY_SIZE(tpacpi_driver_attributes); i++)
620                 driver_remove_file(drv, tpacpi_driver_attributes[i]);
621 }
622
623 /*************************************************************************
624  * sysfs support helpers
625  */
626
627 struct attribute_set_obj {
628         struct attribute_set s;
629         struct attribute *a;
630 } __attribute__((packed));
631
632 static struct attribute_set *create_attr_set(unsigned int max_members,
633                                                 const char* name)
634 {
635         struct attribute_set_obj *sobj;
636
637         if (max_members == 0)
638                 return NULL;
639
640         /* Allocates space for implicit NULL at the end too */
641         sobj = kzalloc(sizeof(struct attribute_set_obj) +
642                     max_members * sizeof(struct attribute *),
643                     GFP_KERNEL);
644         if (!sobj)
645                 return NULL;
646         sobj->s.max_members = max_members;
647         sobj->s.group.attrs = &sobj->a;
648         sobj->s.group.name = name;
649
650         return &sobj->s;
651 }
652
653 /* not multi-threaded safe, use it in a single thread per set */
654 static int add_to_attr_set(struct attribute_set* s, struct attribute *attr)
655 {
656         if (!s || !attr)
657                 return -EINVAL;
658
659         if (s->members >= s->max_members)
660                 return -ENOMEM;
661
662         s->group.attrs[s->members] = attr;
663         s->members++;
664
665         return 0;
666 }
667
668 static int add_many_to_attr_set(struct attribute_set* s,
669                         struct attribute **attr,
670                         unsigned int count)
671 {
672         int i, res;
673
674         for (i = 0; i < count; i++) {
675                 res = add_to_attr_set(s, attr[i]);
676                 if (res)
677                         return res;
678         }
679
680         return 0;
681 }
682
683 static void delete_attr_set(struct attribute_set* s, struct kobject *kobj)
684 {
685         sysfs_remove_group(kobj, &s->group);
686         destroy_attr_set(s);
687 }
688
689 static int parse_strtoul(const char *buf,
690                 unsigned long max, unsigned long *value)
691 {
692         char *endp;
693
694         *value = simple_strtoul(buf, &endp, 0);
695         while (*endp && isspace(*endp))
696                 endp++;
697         if (*endp || *value > max)
698                 return -EINVAL;
699
700         return 0;
701 }
702
703 /****************************************************************************
704  ****************************************************************************
705  *
706  * Subdrivers
707  *
708  ****************************************************************************
709  ****************************************************************************/
710
711 /*************************************************************************
712  * thinkpad-acpi init subdriver
713  */
714
715 static int __init thinkpad_acpi_driver_init(struct ibm_init_struct *iibm)
716 {
717         printk(IBM_INFO "%s v%s\n", IBM_DESC, IBM_VERSION);
718         printk(IBM_INFO "%s\n", IBM_URL);
719
720         if (ibm_thinkpad_ec_found)
721                 printk(IBM_INFO "ThinkPad EC firmware %s\n",
722                        ibm_thinkpad_ec_found);
723
724         return 0;
725 }
726
727 static int thinkpad_acpi_driver_read(char *p)
728 {
729         int len = 0;
730
731         len += sprintf(p + len, "driver:\t\t%s\n", IBM_DESC);
732         len += sprintf(p + len, "version:\t%s\n", IBM_VERSION);
733
734         return len;
735 }
736
737 static struct ibm_struct thinkpad_acpi_driver_data = {
738         .name = "driver",
739         .read = thinkpad_acpi_driver_read,
740 };
741
742 /*************************************************************************
743  * Hotkey subdriver
744  */
745
746 static int hotkey_orig_status;
747 static u32 hotkey_orig_mask;
748 static u32 hotkey_all_mask;
749 static u32 hotkey_reserved_mask;
750
751 static u16 hotkey_keycode_map[] = {
752         /* Scan Codes 0x00 to 0x0B: ACPI HKEY FN+F1..F12 */
753         KEY_FN_F1,      KEY_FN_F2,      KEY_FN_F3,      KEY_SLEEP,
754         KEY_FN_F5,      KEY_FN_F6,      KEY_FN_F7,      KEY_FN_F8,
755         KEY_FN_F9,      KEY_FN_F10,     KEY_FN_F11,     KEY_SUSPEND,
756         /* Scan codes 0x0C to 0x0F: Other ACPI HKEY hot keys */
757         KEY_UNKNOWN,    /* 0x0C: FN+BACKSPACE */
758         KEY_UNKNOWN,    /* 0x0D: FN+INSERT */
759         KEY_UNKNOWN,    /* 0x0E: FN+DELETE */
760         KEY_RESERVED,   /* 0x0F: FN+HOME (brightness up) */
761         /* Scan codes 0x10 to 0x1F: Extended ACPI HKEY hot keys */
762         KEY_RESERVED,   /* 0x10: FN+END (brightness down) */
763         KEY_RESERVED,   /* 0x11: FN+PGUP (thinklight toggle) */
764         KEY_UNKNOWN,    /* 0x12: FN+PGDOWN */
765         KEY_ZOOM,       /* 0x13: FN+SPACE (zoom) */
766         KEY_RESERVED,   /* 0x14: VOLUME UP */
767         KEY_RESERVED,   /* 0x15: VOLUME DOWN */
768         KEY_RESERVED,   /* 0x16: MUTE */
769         KEY_VENDOR,     /* 0x17: Thinkpad/AccessIBM/Lenovo */
770         /* (assignments unknown, please report if found) */
771         KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN,
772         KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN, KEY_UNKNOWN,
773 };
774
775 static struct attribute_set *hotkey_dev_attributes;
776
777 static int hotkey_get_wlsw(int *status)
778 {
779         if (!acpi_evalf(hkey_handle, status, "WLSW", "d"))
780                 return -EIO;
781         return 0;
782 }
783
784 /* sysfs hotkey enable ------------------------------------------------- */
785 static ssize_t hotkey_enable_show(struct device *dev,
786                            struct device_attribute *attr,
787                            char *buf)
788 {
789         int res, status;
790         u32 mask;
791
792         res = hotkey_get(&status, &mask);
793         if (res)
794                 return res;
795
796         return snprintf(buf, PAGE_SIZE, "%d\n", status);
797 }
798
799 static ssize_t hotkey_enable_store(struct device *dev,
800                             struct device_attribute *attr,
801                             const char *buf, size_t count)
802 {
803         unsigned long t;
804         int res, status;
805         u32 mask;
806
807         if (parse_strtoul(buf, 1, &t))
808                 return -EINVAL;
809
810         res = hotkey_get(&status, &mask);
811         if (!res)
812                 res = hotkey_set(t, mask);
813
814         return (res) ? res : count;
815 }
816
817 static struct device_attribute dev_attr_hotkey_enable =
818         __ATTR(hotkey_enable, S_IWUSR | S_IRUGO,
819                 hotkey_enable_show, hotkey_enable_store);
820
821 /* sysfs hotkey mask --------------------------------------------------- */
822 static ssize_t hotkey_mask_show(struct device *dev,
823                            struct device_attribute *attr,
824                            char *buf)
825 {
826         int res, status;
827         u32 mask;
828
829         res = hotkey_get(&status, &mask);
830         if (res)
831                 return res;
832
833         return snprintf(buf, PAGE_SIZE, "0x%08x\n", mask);
834 }
835
836 static ssize_t hotkey_mask_store(struct device *dev,
837                             struct device_attribute *attr,
838                             const char *buf, size_t count)
839 {
840         unsigned long t;
841         int res, status;
842         u32 mask;
843
844         if (parse_strtoul(buf, 0xffffffffUL, &t))
845                 return -EINVAL;
846
847         res = hotkey_get(&status, &mask);
848         if (!res)
849                 hotkey_set(status, t);
850
851         return (res) ? res : count;
852 }
853
854 static struct device_attribute dev_attr_hotkey_mask =
855         __ATTR(hotkey_mask, S_IWUSR | S_IRUGO,
856                 hotkey_mask_show, hotkey_mask_store);
857
858 /* sysfs hotkey bios_enabled ------------------------------------------- */
859 static ssize_t hotkey_bios_enabled_show(struct device *dev,
860                            struct device_attribute *attr,
861                            char *buf)
862 {
863         return snprintf(buf, PAGE_SIZE, "%d\n", hotkey_orig_status);
864 }
865
866 static struct device_attribute dev_attr_hotkey_bios_enabled =
867         __ATTR(hotkey_bios_enabled, S_IRUGO, hotkey_bios_enabled_show, NULL);
868
869 /* sysfs hotkey bios_mask ---------------------------------------------- */
870 static ssize_t hotkey_bios_mask_show(struct device *dev,
871                            struct device_attribute *attr,
872                            char *buf)
873 {
874         return snprintf(buf, PAGE_SIZE, "0x%08x\n", hotkey_orig_mask);
875 }
876
877 static struct device_attribute dev_attr_hotkey_bios_mask =
878         __ATTR(hotkey_bios_mask, S_IRUGO, hotkey_bios_mask_show, NULL);
879
880 /* sysfs hotkey all_mask ----------------------------------------------- */
881 static ssize_t hotkey_all_mask_show(struct device *dev,
882                            struct device_attribute *attr,
883                            char *buf)
884 {
885         return snprintf(buf, PAGE_SIZE, "0x%08x\n", hotkey_all_mask);
886 }
887
888 static struct device_attribute dev_attr_hotkey_all_mask =
889         __ATTR(hotkey_all_mask, S_IRUGO, hotkey_all_mask_show, NULL);
890
891 /* sysfs hotkey recommended_mask --------------------------------------- */
892 static ssize_t hotkey_recommended_mask_show(struct device *dev,
893                                             struct device_attribute *attr,
894                                             char *buf)
895 {
896         return snprintf(buf, PAGE_SIZE, "0x%08x\n",
897                         hotkey_all_mask & ~hotkey_reserved_mask);
898 }
899
900 static struct device_attribute dev_attr_hotkey_recommended_mask =
901         __ATTR(hotkey_recommended_mask, S_IRUGO,
902                 hotkey_recommended_mask_show, NULL);
903
904 /* sysfs hotkey radio_sw ----------------------------------------------- */
905 static ssize_t hotkey_radio_sw_show(struct device *dev,
906                            struct device_attribute *attr,
907                            char *buf)
908 {
909         int res, s;
910         res = hotkey_get_wlsw(&s);
911         if (res < 0)
912                 return res;
913
914         return snprintf(buf, PAGE_SIZE, "%d\n", !!s);
915 }
916
917 static struct device_attribute dev_attr_hotkey_radio_sw =
918         __ATTR(hotkey_radio_sw, S_IRUGO, hotkey_radio_sw_show, NULL);
919
920 /* --------------------------------------------------------------------- */
921
922 static struct attribute *hotkey_mask_attributes[] = {
923         &dev_attr_hotkey_mask.attr,
924         &dev_attr_hotkey_bios_enabled.attr,
925         &dev_attr_hotkey_bios_mask.attr,
926         &dev_attr_hotkey_all_mask.attr,
927         &dev_attr_hotkey_recommended_mask.attr,
928 };
929
930 static int __init hotkey_init(struct ibm_init_struct *iibm)
931 {
932         int res, i;
933         int status;
934
935         vdbg_printk(TPACPI_DBG_INIT, "initializing hotkey subdriver\n");
936
937         BUG_ON(!tpacpi_inputdev);
938
939         IBM_ACPIHANDLE_INIT(hkey);
940         mutex_init(&hotkey_mutex);
941
942         /* hotkey not supported on 570 */
943         tp_features.hotkey = hkey_handle != NULL;
944
945         vdbg_printk(TPACPI_DBG_INIT, "hotkeys are %s\n",
946                 str_supported(tp_features.hotkey));
947
948         if (tp_features.hotkey) {
949                 hotkey_dev_attributes = create_attr_set(7, NULL);
950                 if (!hotkey_dev_attributes)
951                         return -ENOMEM;
952                 res = add_to_attr_set(hotkey_dev_attributes,
953                                 &dev_attr_hotkey_enable.attr);
954                 if (res)
955                         return res;
956
957                 /* mask not supported on 570, 600e/x, 770e, 770x, A21e, A2xm/p,
958                    A30, R30, R31, T20-22, X20-21, X22-24 */
959                 tp_features.hotkey_mask =
960                         acpi_evalf(hkey_handle, NULL, "DHKN", "qv");
961
962                 vdbg_printk(TPACPI_DBG_INIT, "hotkey masks are %s\n",
963                         str_supported(tp_features.hotkey_mask));
964
965                 if (tp_features.hotkey_mask) {
966                         /* MHKA available in A31, R40, R40e, T4x, X31, and later */
967                         if (!acpi_evalf(hkey_handle, &hotkey_all_mask,
968                                         "MHKA", "qd"))
969                                 hotkey_all_mask = 0x080cU; /* FN+F12, FN+F4, FN+F3 */
970                 }
971
972                 res = hotkey_get(&hotkey_orig_status, &hotkey_orig_mask);
973                 if (!res && tp_features.hotkey_mask) {
974                         res = add_many_to_attr_set(hotkey_dev_attributes,
975                                 hotkey_mask_attributes,
976                                 ARRAY_SIZE(hotkey_mask_attributes));
977                 }
978
979                 /* Not all thinkpads have a hardware radio switch */
980                 if (!res && acpi_evalf(hkey_handle, &status, "WLSW", "qd")) {
981                         tp_features.hotkey_wlsw = 1;
982                         printk(IBM_INFO
983                                 "radio switch found; radios are %s\n",
984                                 enabled(status, 0));
985                         res = add_to_attr_set(hotkey_dev_attributes,
986                                         &dev_attr_hotkey_radio_sw.attr);
987                 }
988
989                 if (!res)
990                         res = register_attr_set_with_sysfs(
991                                         hotkey_dev_attributes,
992                                         &tpacpi_pdev->dev.kobj);
993                 if (res)
994                         return res;
995
996 #ifndef CONFIG_THINKPAD_ACPI_INPUT_ENABLED
997                 for (i = 0; i < 12; i++)
998                         hotkey_keycode_map[i] = KEY_UNKNOWN;
999 #endif /* ! CONFIG_THINKPAD_ACPI_INPUT_ENABLED */
1000
1001                 set_bit(EV_KEY, tpacpi_inputdev->evbit);
1002                 set_bit(EV_MSC, tpacpi_inputdev->evbit);
1003                 set_bit(MSC_SCAN, tpacpi_inputdev->mscbit);
1004                 tpacpi_inputdev->keycodesize = sizeof(hotkey_keycode_map[0]);
1005                 tpacpi_inputdev->keycodemax = ARRAY_SIZE(hotkey_keycode_map);
1006                 tpacpi_inputdev->keycode = &hotkey_keycode_map;
1007                 for (i = 0; i < ARRAY_SIZE(hotkey_keycode_map); i++) {
1008                         if (hotkey_keycode_map[i] != KEY_RESERVED) {
1009                                 set_bit(hotkey_keycode_map[i],
1010                                         tpacpi_inputdev->keybit);
1011                         } else {
1012                                 if (i < sizeof(hotkey_reserved_mask)*8)
1013                                         hotkey_reserved_mask |= 1 << i;
1014                         }
1015                 }
1016
1017                 if (tp_features.hotkey_wlsw) {
1018                         set_bit(EV_SW, tpacpi_inputdev->evbit);
1019                         set_bit(SW_RADIO, tpacpi_inputdev->swbit);
1020                 }
1021
1022 #ifdef CONFIG_THINKPAD_ACPI_INPUT_ENABLED
1023                 dbg_printk(TPACPI_DBG_INIT,
1024                                 "enabling hot key handling\n");
1025                 res = hotkey_set(1, (hotkey_all_mask & ~hotkey_reserved_mask)
1026                                         | hotkey_orig_mask);
1027                 if (res)
1028                         return res;
1029 #endif /* CONFIG_THINKPAD_ACPI_INPUT_ENABLED */
1030         }
1031
1032         return (tp_features.hotkey)? 0 : 1;
1033 }
1034
1035 static void hotkey_exit(void)
1036 {
1037         int res;
1038
1039         if (tp_features.hotkey) {
1040                 dbg_printk(TPACPI_DBG_EXIT, "restoring original hotkey mask\n");
1041                 res = hotkey_set(hotkey_orig_status, hotkey_orig_mask);
1042                 if (res)
1043                         printk(IBM_ERR "failed to restore hotkey to BIOS defaults\n");
1044         }
1045
1046         if (hotkey_dev_attributes) {
1047                 delete_attr_set(hotkey_dev_attributes, &tpacpi_pdev->dev.kobj);
1048                 hotkey_dev_attributes = NULL;
1049         }
1050 }
1051
1052 static void tpacpi_input_send_key(unsigned int scancode,
1053                                   unsigned int keycode)
1054 {
1055         if (keycode != KEY_RESERVED) {
1056                 input_report_key(tpacpi_inputdev, keycode, 1);
1057                 if (keycode == KEY_UNKNOWN)
1058                         input_event(tpacpi_inputdev, EV_MSC, MSC_SCAN,
1059                                     scancode);
1060                 input_sync(tpacpi_inputdev);
1061
1062                 input_report_key(tpacpi_inputdev, keycode, 0);
1063                 if (keycode == KEY_UNKNOWN)
1064                         input_event(tpacpi_inputdev, EV_MSC, MSC_SCAN,
1065                                     scancode);
1066                 input_sync(tpacpi_inputdev);
1067         }
1068 }
1069
1070 static void tpacpi_input_send_radiosw(void)
1071 {
1072         int wlsw;
1073
1074         if (tp_features.hotkey_wlsw && !hotkey_get_wlsw(&wlsw))
1075                 input_report_switch(tpacpi_inputdev,
1076                                     SW_RADIO, !!wlsw);
1077 }
1078
1079 static void hotkey_notify(struct ibm_struct *ibm, u32 event)
1080 {
1081         u32 hkey;
1082         unsigned int keycode, scancode;
1083         int sendacpi = 1;
1084
1085         if (event == 0x80 && acpi_evalf(hkey_handle, &hkey, "MHKP", "d")) {
1086                 if (tpacpi_inputdev->users > 0) {
1087                         switch (hkey >> 12) {
1088                         case 1:
1089                                 /* 0x1000-0x1FFF: key presses */
1090                                 scancode = hkey & 0xfff;
1091                                 if (scancode > 0 && scancode < 0x21) {
1092                                         scancode--;
1093                                         keycode = hotkey_keycode_map[scancode];
1094                                         tpacpi_input_send_key(scancode, keycode);
1095                                         sendacpi = (keycode == KEY_RESERVED
1096                                                 || keycode == KEY_UNKNOWN);
1097                                 } else {
1098                                         printk(IBM_ERR
1099                                                "hotkey 0x%04x out of range for keyboard map\n",
1100                                                hkey);
1101                                 }
1102                                 break;
1103                         case 5:
1104                                 /* 0x5000-0x5FFF: LID */
1105                                 /* we don't handle it through this path, just
1106                                  * eat up known LID events */
1107                                 if (hkey != 0x5001 && hkey != 0x5002) {
1108                                         printk(IBM_ERR
1109                                                 "unknown LID-related hotkey event: 0x%04x\n",
1110                                                 hkey);
1111                                 }
1112                                 break;
1113                         case 7:
1114                                 /* 0x7000-0x7FFF: misc */
1115                                 if (tp_features.hotkey_wlsw && hkey == 0x7000) {
1116                                                 tpacpi_input_send_radiosw();
1117                                                 sendacpi = 0;
1118                                         break;
1119                                 }
1120                                 /* fallthrough to default */
1121                         default:
1122                                 /* case 2: dock-related */
1123                                 /*      0x2305 - T43 waking up due to bay lever eject while aslept */
1124                                 /* case 3: ultra-bay related. maybe bay in dock? */
1125                                 /*      0x3003 - T43 after wake up by bay lever eject (0x2305) */
1126                                 printk(IBM_NOTICE "unhandled hotkey event 0x%04x\n", hkey);
1127                         }
1128                 }
1129
1130                 if (sendacpi)
1131                         acpi_bus_generate_event(ibm->acpi->device, event, hkey);
1132         } else {
1133                 printk(IBM_ERR "unknown hotkey notification event %d\n", event);
1134                 acpi_bus_generate_event(ibm->acpi->device, event, 0);
1135         }
1136 }
1137
1138 static void hotkey_resume(void)
1139 {
1140         tpacpi_input_send_radiosw();
1141 }
1142
1143 /*
1144  * Call with hotkey_mutex held
1145  */
1146 static int hotkey_get(int *status, u32 *mask)
1147 {
1148         if (!acpi_evalf(hkey_handle, status, "DHKC", "d"))
1149                 return -EIO;
1150
1151         if (tp_features.hotkey_mask)
1152                 if (!acpi_evalf(hkey_handle, mask, "DHKN", "d"))
1153                         return -EIO;
1154
1155         return 0;
1156 }
1157
1158 /*
1159  * Call with hotkey_mutex held
1160  */
1161 static int hotkey_set(int status, u32 mask)
1162 {
1163         int i;
1164
1165         if (!acpi_evalf(hkey_handle, NULL, "MHKC", "vd", status))
1166                 return -EIO;
1167
1168         if (tp_features.hotkey_mask)
1169                 for (i = 0; i < 32; i++) {
1170                         int bit = ((1 << i) & mask) != 0;
1171                         if (!acpi_evalf(hkey_handle,
1172                                         NULL, "MHKM", "vdd", i + 1, bit))
1173                                 return -EIO;
1174                 }
1175
1176         return 0;
1177 }
1178
1179 /* procfs -------------------------------------------------------------- */
1180 static int hotkey_read(char *p)
1181 {
1182         int res, status;
1183         u32 mask;
1184         int len = 0;
1185
1186         if (!tp_features.hotkey) {
1187                 len += sprintf(p + len, "status:\t\tnot supported\n");
1188                 return len;
1189         }
1190
1191         res = mutex_lock_interruptible(&hotkey_mutex);
1192         if (res < 0)
1193                 return res;
1194         res = hotkey_get(&status, &mask);
1195         mutex_unlock(&hotkey_mutex);
1196         if (res)
1197                 return res;
1198
1199         len += sprintf(p + len, "status:\t\t%s\n", enabled(status, 0));
1200         if (tp_features.hotkey_mask) {
1201                 len += sprintf(p + len, "mask:\t\t0x%08x\n", mask);
1202                 len += sprintf(p + len,
1203                                "commands:\tenable, disable, reset, <mask>\n");
1204         } else {
1205                 len += sprintf(p + len, "mask:\t\tnot supported\n");
1206                 len += sprintf(p + len, "commands:\tenable, disable, reset\n");
1207         }
1208
1209         return len;
1210 }
1211
1212 static int hotkey_write(char *buf)
1213 {
1214         int res, status;
1215         u32 mask;
1216         char *cmd;
1217         int do_cmd = 0;
1218
1219         if (!tp_features.hotkey)
1220                 return -ENODEV;
1221
1222         res = mutex_lock_interruptible(&hotkey_mutex);
1223         if (res < 0)
1224                 return res;
1225
1226         res = hotkey_get(&status, &mask);
1227         if (res)
1228                 goto errexit;
1229
1230         res = 0;
1231         while ((cmd = next_cmd(&buf))) {
1232                 if (strlencmp(cmd, "enable") == 0) {
1233                         status = 1;
1234                 } else if (strlencmp(cmd, "disable") == 0) {
1235                         status = 0;
1236                 } else if (strlencmp(cmd, "reset") == 0) {
1237                         status = hotkey_orig_status;
1238                         mask = hotkey_orig_mask;
1239                 } else if (sscanf(cmd, "0x%x", &mask) == 1) {
1240                         /* mask set */
1241                 } else if (sscanf(cmd, "%x", &mask) == 1) {
1242                         /* mask set */
1243                 } else {
1244                         res = -EINVAL;
1245                         goto errexit;
1246                 }
1247                 do_cmd = 1;
1248         }
1249
1250         if (do_cmd)
1251                 res = hotkey_set(status, mask);
1252
1253 errexit:
1254         mutex_unlock(&hotkey_mutex);
1255         return res;
1256 }
1257
1258 static struct tp_acpi_drv_struct ibm_hotkey_acpidriver = {
1259         .hid = IBM_HKEY_HID,
1260         .notify = hotkey_notify,
1261         .handle = &hkey_handle,
1262         .type = ACPI_DEVICE_NOTIFY,
1263 };
1264
1265 static struct ibm_struct hotkey_driver_data = {
1266         .name = "hotkey",
1267         .read = hotkey_read,
1268         .write = hotkey_write,
1269         .exit = hotkey_exit,
1270         .resume = hotkey_resume,
1271         .acpi = &ibm_hotkey_acpidriver,
1272 };
1273
1274 /*************************************************************************
1275  * Bluetooth subdriver
1276  */
1277
1278 /* sysfs bluetooth enable ---------------------------------------------- */
1279 static ssize_t bluetooth_enable_show(struct device *dev,
1280                            struct device_attribute *attr,
1281                            char *buf)
1282 {
1283         int status;
1284
1285         status = bluetooth_get_radiosw();
1286         if (status < 0)
1287                 return status;
1288
1289         return snprintf(buf, PAGE_SIZE, "%d\n", status ? 1 : 0);
1290 }
1291
1292 static ssize_t bluetooth_enable_store(struct device *dev,
1293                             struct device_attribute *attr,
1294                             const char *buf, size_t count)
1295 {
1296         unsigned long t;
1297         int res;
1298
1299         if (parse_strtoul(buf, 1, &t))
1300                 return -EINVAL;
1301
1302         res = bluetooth_set_radiosw(t);
1303
1304         return (res) ? res : count;
1305 }
1306
1307 static struct device_attribute dev_attr_bluetooth_enable =
1308         __ATTR(bluetooth_enable, S_IWUSR | S_IRUGO,
1309                 bluetooth_enable_show, bluetooth_enable_store);
1310
1311 /* --------------------------------------------------------------------- */
1312
1313 static struct attribute *bluetooth_attributes[] = {
1314         &dev_attr_bluetooth_enable.attr,
1315         NULL
1316 };
1317
1318 static const struct attribute_group bluetooth_attr_group = {
1319         .attrs = bluetooth_attributes,
1320 };
1321
1322 static int __init bluetooth_init(struct ibm_init_struct *iibm)
1323 {
1324         int res;
1325         int status = 0;
1326
1327         vdbg_printk(TPACPI_DBG_INIT, "initializing bluetooth subdriver\n");
1328
1329         IBM_ACPIHANDLE_INIT(hkey);
1330
1331         /* bluetooth not supported on 570, 600e/x, 770e, 770x, A21e, A2xm/p,
1332            G4x, R30, R31, R40e, R50e, T20-22, X20-21 */
1333         tp_features.bluetooth = hkey_handle &&
1334             acpi_evalf(hkey_handle, &status, "GBDC", "qd");
1335
1336         vdbg_printk(TPACPI_DBG_INIT, "bluetooth is %s, status 0x%02x\n",
1337                 str_supported(tp_features.bluetooth),
1338                 status);
1339
1340         if (tp_features.bluetooth) {
1341                 if (!(status & TP_ACPI_BLUETOOTH_HWPRESENT)) {
1342                         /* no bluetooth hardware present in system */
1343                         tp_features.bluetooth = 0;
1344                         dbg_printk(TPACPI_DBG_INIT,
1345                                    "bluetooth hardware not installed\n");
1346                 } else {
1347                         res = sysfs_create_group(&tpacpi_pdev->dev.kobj,
1348                                         &bluetooth_attr_group);
1349                         if (res)
1350                                 return res;
1351                 }
1352         }
1353
1354         return (tp_features.bluetooth)? 0 : 1;
1355 }
1356
1357 static void bluetooth_exit(void)
1358 {
1359         sysfs_remove_group(&tpacpi_pdev->dev.kobj,
1360                         &bluetooth_attr_group);
1361 }
1362
1363 static int bluetooth_get_radiosw(void)
1364 {
1365         int status;
1366
1367         if (!tp_features.bluetooth)
1368                 return -ENODEV;
1369
1370         if (!acpi_evalf(hkey_handle, &status, "GBDC", "d"))
1371                 return -EIO;
1372
1373         return ((status & TP_ACPI_BLUETOOTH_RADIOSSW) != 0);
1374 }
1375
1376 static int bluetooth_set_radiosw(int radio_on)
1377 {
1378         int status;
1379
1380         if (!tp_features.bluetooth)
1381                 return -ENODEV;
1382
1383         if (!acpi_evalf(hkey_handle, &status, "GBDC", "d"))
1384                 return -EIO;
1385         if (radio_on)
1386                 status |= TP_ACPI_BLUETOOTH_RADIOSSW;
1387         else
1388                 status &= ~TP_ACPI_BLUETOOTH_RADIOSSW;
1389         if (!acpi_evalf(hkey_handle, NULL, "SBDC", "vd", status))
1390                 return -EIO;
1391
1392         return 0;
1393 }
1394
1395 /* procfs -------------------------------------------------------------- */
1396 static int bluetooth_read(char *p)
1397 {
1398         int len = 0;
1399         int status = bluetooth_get_radiosw();
1400
1401         if (!tp_features.bluetooth)
1402                 len += sprintf(p + len, "status:\t\tnot supported\n");
1403         else {
1404                 len += sprintf(p + len, "status:\t\t%s\n",
1405                                 (status)? "enabled" : "disabled");
1406                 len += sprintf(p + len, "commands:\tenable, disable\n");
1407         }
1408
1409         return len;
1410 }
1411
1412 static int bluetooth_write(char *buf)
1413 {
1414         char *cmd;
1415
1416         if (!tp_features.bluetooth)
1417                 return -ENODEV;
1418
1419         while ((cmd = next_cmd(&buf))) {
1420                 if (strlencmp(cmd, "enable") == 0) {
1421                         bluetooth_set_radiosw(1);
1422                 } else if (strlencmp(cmd, "disable") == 0) {
1423                         bluetooth_set_radiosw(0);
1424                 } else
1425                         return -EINVAL;
1426         }
1427
1428         return 0;
1429 }
1430
1431 static struct ibm_struct bluetooth_driver_data = {
1432         .name = "bluetooth",
1433         .read = bluetooth_read,
1434         .write = bluetooth_write,
1435         .exit = bluetooth_exit,
1436 };
1437
1438 /*************************************************************************
1439  * Wan subdriver
1440  */
1441
1442 /* sysfs wan enable ---------------------------------------------------- */
1443 static ssize_t wan_enable_show(struct device *dev,
1444                            struct device_attribute *attr,
1445                            char *buf)
1446 {
1447         int status;
1448
1449         status = wan_get_radiosw();
1450         if (status < 0)
1451                 return status;
1452
1453         return snprintf(buf, PAGE_SIZE, "%d\n", status ? 1 : 0);
1454 }
1455
1456 static ssize_t wan_enable_store(struct device *dev,
1457                             struct device_attribute *attr,
1458                             const char *buf, size_t count)
1459 {
1460         unsigned long t;
1461         int res;
1462
1463         if (parse_strtoul(buf, 1, &t))
1464                 return -EINVAL;
1465
1466         res = wan_set_radiosw(t);
1467
1468         return (res) ? res : count;
1469 }
1470
1471 static struct device_attribute dev_attr_wan_enable =
1472         __ATTR(wwan_enable, S_IWUSR | S_IRUGO,
1473                 wan_enable_show, wan_enable_store);
1474
1475 /* --------------------------------------------------------------------- */
1476
1477 static struct attribute *wan_attributes[] = {
1478         &dev_attr_wan_enable.attr,
1479         NULL
1480 };
1481
1482 static const struct attribute_group wan_attr_group = {
1483         .attrs = wan_attributes,
1484 };
1485
1486 static int __init wan_init(struct ibm_init_struct *iibm)
1487 {
1488         int res;
1489         int status = 0;
1490
1491         vdbg_printk(TPACPI_DBG_INIT, "initializing wan subdriver\n");
1492
1493         IBM_ACPIHANDLE_INIT(hkey);
1494
1495         tp_features.wan = hkey_handle &&
1496             acpi_evalf(hkey_handle, &status, "GWAN", "qd");
1497
1498         vdbg_printk(TPACPI_DBG_INIT, "wan is %s, status 0x%02x\n",
1499                 str_supported(tp_features.wan),
1500                 status);
1501
1502         if (tp_features.wan) {
1503                 if (!(status & TP_ACPI_WANCARD_HWPRESENT)) {
1504                         /* no wan hardware present in system */
1505                         tp_features.wan = 0;
1506                         dbg_printk(TPACPI_DBG_INIT,
1507                                    "wan hardware not installed\n");
1508                 } else {
1509                         res = sysfs_create_group(&tpacpi_pdev->dev.kobj,
1510                                         &wan_attr_group);
1511                         if (res)
1512                                 return res;
1513                 }
1514         }
1515
1516         return (tp_features.wan)? 0 : 1;
1517 }
1518
1519 static void wan_exit(void)
1520 {
1521         sysfs_remove_group(&tpacpi_pdev->dev.kobj,
1522                 &wan_attr_group);
1523 }
1524
1525 static int wan_get_radiosw(void)
1526 {
1527         int status;
1528
1529         if (!tp_features.wan)
1530                 return -ENODEV;
1531
1532         if (!acpi_evalf(hkey_handle, &status, "GWAN", "d"))
1533                 return -EIO;
1534
1535         return ((status & TP_ACPI_WANCARD_RADIOSSW) != 0);
1536 }
1537
1538 static int wan_set_radiosw(int radio_on)
1539 {
1540         int status;
1541
1542         if (!tp_features.wan)
1543                 return -ENODEV;
1544
1545         if (!acpi_evalf(hkey_handle, &status, "GWAN", "d"))
1546                 return -EIO;
1547         if (radio_on)
1548                 status |= TP_ACPI_WANCARD_RADIOSSW;
1549         else
1550                 status &= ~TP_ACPI_WANCARD_RADIOSSW;
1551         if (!acpi_evalf(hkey_handle, NULL, "SWAN", "vd", status))
1552                 return -EIO;
1553
1554         return 0;
1555 }
1556
1557 /* procfs -------------------------------------------------------------- */
1558 static int wan_read(char *p)
1559 {
1560         int len = 0;
1561         int status = wan_get_radiosw();
1562
1563         if (!tp_features.wan)
1564                 len += sprintf(p + len, "status:\t\tnot supported\n");
1565         else {
1566                 len += sprintf(p + len, "status:\t\t%s\n",
1567                                 (status)? "enabled" : "disabled");
1568                 len += sprintf(p + len, "commands:\tenable, disable\n");
1569         }
1570
1571         return len;
1572 }
1573
1574 static int wan_write(char *buf)
1575 {
1576         char *cmd;
1577
1578         if (!tp_features.wan)
1579                 return -ENODEV;
1580
1581         while ((cmd = next_cmd(&buf))) {
1582                 if (strlencmp(cmd, "enable") == 0) {
1583                         wan_set_radiosw(1);
1584                 } else if (strlencmp(cmd, "disable") == 0) {
1585                         wan_set_radiosw(0);
1586                 } else
1587                         return -EINVAL;
1588         }
1589
1590         return 0;
1591 }
1592
1593 static struct ibm_struct wan_driver_data = {
1594         .name = "wan",
1595         .read = wan_read,
1596         .write = wan_write,
1597         .exit = wan_exit,
1598         .flags.experimental = 1,
1599 };
1600
1601 /*************************************************************************
1602  * Video subdriver
1603  */
1604
1605 static enum video_access_mode video_supported;
1606 static int video_orig_autosw;
1607
1608 IBM_HANDLE(vid, root, "\\_SB.PCI.AGP.VGA",      /* 570 */
1609            "\\_SB.PCI0.AGP0.VID0",      /* 600e/x, 770x */
1610            "\\_SB.PCI0.VID0",   /* 770e */
1611            "\\_SB.PCI0.VID",    /* A21e, G4x, R50e, X30, X40 */
1612            "\\_SB.PCI0.AGP.VID",        /* all others */
1613            );                           /* R30, R31 */
1614
1615 IBM_HANDLE(vid2, root, "\\_SB.PCI0.AGPB.VID");  /* G41 */
1616
1617 static int __init video_init(struct ibm_init_struct *iibm)
1618 {
1619         int ivga;
1620
1621         vdbg_printk(TPACPI_DBG_INIT, "initializing video subdriver\n");
1622
1623         IBM_ACPIHANDLE_INIT(vid);
1624         IBM_ACPIHANDLE_INIT(vid2);
1625
1626         if (vid2_handle && acpi_evalf(NULL, &ivga, "\\IVGA", "d") && ivga)
1627                 /* G41, assume IVGA doesn't change */
1628                 vid_handle = vid2_handle;
1629
1630         if (!vid_handle)
1631                 /* video switching not supported on R30, R31 */
1632                 video_supported = TPACPI_VIDEO_NONE;
1633         else if (acpi_evalf(vid_handle, &video_orig_autosw, "SWIT", "qd"))
1634                 /* 570 */
1635                 video_supported = TPACPI_VIDEO_570;
1636         else if (acpi_evalf(vid_handle, &video_orig_autosw, "^VADL", "qd"))
1637                 /* 600e/x, 770e, 770x */
1638                 video_supported = TPACPI_VIDEO_770;
1639         else
1640                 /* all others */
1641                 video_supported = TPACPI_VIDEO_NEW;
1642
1643         vdbg_printk(TPACPI_DBG_INIT, "video is %s, mode %d\n",
1644                 str_supported(video_supported != TPACPI_VIDEO_NONE),
1645                 video_supported);
1646
1647         return (video_supported != TPACPI_VIDEO_NONE)? 0 : 1;
1648 }
1649
1650 static void video_exit(void)
1651 {
1652         dbg_printk(TPACPI_DBG_EXIT,
1653                    "restoring original video autoswitch mode\n");
1654         if (video_autosw_set(video_orig_autosw))
1655                 printk(IBM_ERR "error while trying to restore original "
1656                         "video autoswitch mode\n");
1657 }
1658
1659 static int video_outputsw_get(void)
1660 {
1661         int status = 0;
1662         int i;
1663
1664         switch (video_supported) {
1665         case TPACPI_VIDEO_570:
1666                 if (!acpi_evalf(NULL, &i, "\\_SB.PHS", "dd",
1667                                  TP_ACPI_VIDEO_570_PHSCMD))
1668                         return -EIO;
1669                 status = i & TP_ACPI_VIDEO_570_PHSMASK;
1670                 break;
1671         case TPACPI_VIDEO_770:
1672                 if (!acpi_evalf(NULL, &i, "\\VCDL", "d"))
1673                         return -EIO;
1674                 if (i)
1675                         status |= TP_ACPI_VIDEO_S_LCD;
1676                 if (!acpi_evalf(NULL, &i, "\\VCDC", "d"))
1677                         return -EIO;
1678                 if (i)
1679                         status |= TP_ACPI_VIDEO_S_CRT;
1680                 break;
1681         case TPACPI_VIDEO_NEW:
1682                 if (!acpi_evalf(NULL, NULL, "\\VUPS", "vd", 1) ||
1683                     !acpi_evalf(NULL, &i, "\\VCDC", "d"))
1684                         return -EIO;
1685                 if (i)
1686                         status |= TP_ACPI_VIDEO_S_CRT;
1687
1688                 if (!acpi_evalf(NULL, NULL, "\\VUPS", "vd", 0) ||
1689                     !acpi_evalf(NULL, &i, "\\VCDL", "d"))
1690                         return -EIO;
1691                 if (i)
1692                         status |= TP_ACPI_VIDEO_S_LCD;
1693                 if (!acpi_evalf(NULL, &i, "\\VCDD", "d"))
1694                         return -EIO;
1695                 if (i)
1696                         status |= TP_ACPI_VIDEO_S_DVI;
1697                 break;
1698         default:
1699                 return -ENOSYS;
1700         }
1701
1702         return status;
1703 }
1704
1705 static int video_outputsw_set(int status)
1706 {
1707         int autosw;
1708         int res = 0;
1709
1710         switch (video_supported) {
1711         case TPACPI_VIDEO_570:
1712                 res = acpi_evalf(NULL, NULL,
1713                                  "\\_SB.PHS2", "vdd",
1714                                  TP_ACPI_VIDEO_570_PHS2CMD,
1715                                  status | TP_ACPI_VIDEO_570_PHS2SET);
1716                 break;
1717         case TPACPI_VIDEO_770:
1718                 autosw = video_autosw_get();
1719                 if (autosw < 0)
1720                         return autosw;
1721
1722                 res = video_autosw_set(1);
1723                 if (res)
1724                         return res;
1725                 res = acpi_evalf(vid_handle, NULL,
1726                                  "ASWT", "vdd", status * 0x100, 0);
1727                 if (!autosw && video_autosw_set(autosw)) {
1728                         printk(IBM_ERR "video auto-switch left enabled due to error\n");
1729                         return -EIO;
1730                 }
1731                 break;
1732         case TPACPI_VIDEO_NEW:
1733                 res = acpi_evalf(NULL, NULL, "\\VUPS", "vd", 0x80) &&
1734                         acpi_evalf(NULL, NULL, "\\VSDS", "vdd", status, 1);
1735                 break;
1736         default:
1737                 return -ENOSYS;
1738         }
1739
1740         return (res)? 0 : -EIO;
1741 }
1742
1743 static int video_autosw_get(void)
1744 {
1745         int autosw = 0;
1746
1747         switch (video_supported) {
1748         case TPACPI_VIDEO_570:
1749                 if (!acpi_evalf(vid_handle, &autosw, "SWIT", "d"))
1750                         return -EIO;
1751                 break;
1752         case TPACPI_VIDEO_770:
1753         case TPACPI_VIDEO_NEW:
1754                 if (!acpi_evalf(vid_handle, &autosw, "^VDEE", "d"))
1755                         return -EIO;
1756                 break;
1757         default:
1758                 return -ENOSYS;
1759         }
1760
1761         return autosw & 1;
1762 }
1763
1764 static int video_autosw_set(int enable)
1765 {
1766         if (!acpi_evalf(vid_handle, NULL, "_DOS", "vd", (enable)? 1 : 0))
1767                 return -EIO;
1768         return 0;
1769 }
1770
1771 static int video_outputsw_cycle(void)
1772 {
1773         int autosw = video_autosw_get();
1774         int res;
1775
1776         if (autosw < 0)
1777                 return autosw;
1778
1779         switch (video_supported) {
1780         case TPACPI_VIDEO_570:
1781                 res = video_autosw_set(1);
1782                 if (res)
1783                         return res;
1784                 res = acpi_evalf(ec_handle, NULL, "_Q16", "v");
1785                 break;
1786         case TPACPI_VIDEO_770:
1787         case TPACPI_VIDEO_NEW:
1788                 res = video_autosw_set(1);
1789                 if (res)
1790                         return res;
1791                 res = acpi_evalf(vid_handle, NULL, "VSWT", "v");
1792                 break;
1793         default:
1794                 return -ENOSYS;
1795         }
1796         if (!autosw && video_autosw_set(autosw)) {
1797                 printk(IBM_ERR "video auto-switch left enabled due to error\n");
1798                 return -EIO;
1799         }
1800
1801         return (res)? 0 : -EIO;
1802 }
1803
1804 static int video_expand_toggle(void)
1805 {
1806         switch (video_supported) {
1807         case TPACPI_VIDEO_570:
1808                 return acpi_evalf(ec_handle, NULL, "_Q17", "v")?
1809                         0 : -EIO;
1810         case TPACPI_VIDEO_770:
1811                 return acpi_evalf(vid_handle, NULL, "VEXP", "v")?
1812                         0 : -EIO;
1813         case TPACPI_VIDEO_NEW:
1814                 return acpi_evalf(NULL, NULL, "\\VEXP", "v")?
1815                         0 : -EIO;
1816         default:
1817                 return -ENOSYS;
1818         }
1819         /* not reached */
1820 }
1821
1822 static int video_read(char *p)
1823 {
1824         int status, autosw;
1825         int len = 0;
1826
1827         if (video_supported == TPACPI_VIDEO_NONE) {
1828                 len += sprintf(p + len, "status:\t\tnot supported\n");
1829                 return len;
1830         }
1831
1832         status = video_outputsw_get();
1833         if (status < 0)
1834                 return status;
1835
1836         autosw = video_autosw_get();
1837         if (autosw < 0)
1838                 return autosw;
1839
1840         len += sprintf(p + len, "status:\t\tsupported\n");
1841         len += sprintf(p + len, "lcd:\t\t%s\n", enabled(status, 0));
1842         len += sprintf(p + len, "crt:\t\t%s\n", enabled(status, 1));
1843         if (video_supported == TPACPI_VIDEO_NEW)
1844                 len += sprintf(p + len, "dvi:\t\t%s\n", enabled(status, 3));
1845         len += sprintf(p + len, "auto:\t\t%s\n", enabled(autosw, 0));
1846         len += sprintf(p + len, "commands:\tlcd_enable, lcd_disable\n");
1847         len += sprintf(p + len, "commands:\tcrt_enable, crt_disable\n");
1848         if (video_supported == TPACPI_VIDEO_NEW)
1849                 len += sprintf(p + len, "commands:\tdvi_enable, dvi_disable\n");
1850         len += sprintf(p + len, "commands:\tauto_enable, auto_disable\n");
1851         len += sprintf(p + len, "commands:\tvideo_switch, expand_toggle\n");
1852
1853         return len;
1854 }
1855
1856 static int video_write(char *buf)
1857 {
1858         char *cmd;
1859         int enable, disable, status;
1860         int res;
1861
1862         if (video_supported == TPACPI_VIDEO_NONE)
1863                 return -ENODEV;
1864
1865         enable = 0;
1866         disable = 0;
1867
1868         while ((cmd = next_cmd(&buf))) {
1869                 if (strlencmp(cmd, "lcd_enable") == 0) {
1870                         enable |= TP_ACPI_VIDEO_S_LCD;
1871                 } else if (strlencmp(cmd, "lcd_disable") == 0) {
1872                         disable |= TP_ACPI_VIDEO_S_LCD;
1873                 } else if (strlencmp(cmd, "crt_enable") == 0) {
1874                         enable |= TP_ACPI_VIDEO_S_CRT;
1875                 } else if (strlencmp(cmd, "crt_disable") == 0) {
1876                         disable |= TP_ACPI_VIDEO_S_CRT;
1877                 } else if (video_supported == TPACPI_VIDEO_NEW &&
1878                            strlencmp(cmd, "dvi_enable") == 0) {
1879                         enable |= TP_ACPI_VIDEO_S_DVI;
1880                 } else if (video_supported == TPACPI_VIDEO_NEW &&
1881                            strlencmp(cmd, "dvi_disable") == 0) {
1882                         disable |= TP_ACPI_VIDEO_S_DVI;
1883                 } else if (strlencmp(cmd, "auto_enable") == 0) {
1884                         res = video_autosw_set(1);
1885                         if (res)
1886                                 return res;
1887                 } else if (strlencmp(cmd, "auto_disable") == 0) {
1888                         res = video_autosw_set(0);
1889                         if (res)
1890                                 return res;
1891                 } else if (strlencmp(cmd, "video_switch") == 0) {
1892                         res = video_outputsw_cycle();
1893                         if (res)
1894                                 return res;
1895                 } else if (strlencmp(cmd, "expand_toggle") == 0) {
1896                         res = video_expand_toggle();
1897                         if (res)
1898                                 return res;
1899                 } else
1900                         return -EINVAL;
1901         }
1902
1903         if (enable || disable) {
1904                 status = video_outputsw_get();
1905                 if (status < 0)
1906                         return status;
1907                 res = video_outputsw_set((status & ~disable) | enable);
1908                 if (res)
1909                         return res;
1910         }
1911
1912         return 0;
1913 }
1914
1915 static struct ibm_struct video_driver_data = {
1916         .name = "video",
1917         .read = video_read,
1918         .write = video_write,
1919         .exit = video_exit,
1920 };
1921
1922 /*************************************************************************
1923  * Light (thinklight) subdriver
1924  */
1925
1926 IBM_HANDLE(lght, root, "\\LGHT");       /* A21e, A2xm/p, T20-22, X20-21 */
1927 IBM_HANDLE(ledb, ec, "LEDB");           /* G4x */
1928
1929 static int __init light_init(struct ibm_init_struct *iibm)
1930 {
1931         vdbg_printk(TPACPI_DBG_INIT, "initializing light subdriver\n");
1932
1933         IBM_ACPIHANDLE_INIT(ledb);
1934         IBM_ACPIHANDLE_INIT(lght);
1935         IBM_ACPIHANDLE_INIT(cmos);
1936
1937         /* light not supported on 570, 600e/x, 770e, 770x, G4x, R30, R31 */
1938         tp_features.light = (cmos_handle || lght_handle) && !ledb_handle;
1939
1940         if (tp_features.light)
1941                 /* light status not supported on
1942                    570, 600e/x, 770e, 770x, G4x, R30, R31, R32, X20 */
1943                 tp_features.light_status =
1944                         acpi_evalf(ec_handle, NULL, "KBLT", "qv");
1945
1946         vdbg_printk(TPACPI_DBG_INIT, "light is %s\n",
1947                 str_supported(tp_features.light));
1948
1949         return (tp_features.light)? 0 : 1;
1950 }
1951
1952 static int light_read(char *p)
1953 {
1954         int len = 0;
1955         int status = 0;
1956
1957         if (!tp_features.light) {
1958                 len += sprintf(p + len, "status:\t\tnot supported\n");
1959         } else if (!tp_features.light_status) {
1960                 len += sprintf(p + len, "status:\t\tunknown\n");
1961                 len += sprintf(p + len, "commands:\ton, off\n");
1962         } else {
1963                 if (!acpi_evalf(ec_handle, &status, "KBLT", "d"))
1964                         return -EIO;
1965                 len += sprintf(p + len, "status:\t\t%s\n", onoff(status, 0));
1966                 len += sprintf(p + len, "commands:\ton, off\n");
1967         }
1968
1969         return len;
1970 }
1971
1972 static int light_write(char *buf)
1973 {
1974         int cmos_cmd, lght_cmd;
1975         char *cmd;
1976         int success;
1977
1978         if (!tp_features.light)
1979                 return -ENODEV;
1980
1981         while ((cmd = next_cmd(&buf))) {
1982                 if (strlencmp(cmd, "on") == 0) {
1983                         cmos_cmd = 0x0c;
1984                         lght_cmd = 1;
1985                 } else if (strlencmp(cmd, "off") == 0) {
1986                         cmos_cmd = 0x0d;
1987                         lght_cmd = 0;
1988                 } else
1989                         return -EINVAL;
1990
1991                 success = cmos_handle ?
1992                     acpi_evalf(cmos_handle, NULL, NULL, "vd", cmos_cmd) :
1993                     acpi_evalf(lght_handle, NULL, NULL, "vd", lght_cmd);
1994                 if (!success)
1995                         return -EIO;
1996         }
1997
1998         return 0;
1999 }
2000
2001 static struct ibm_struct light_driver_data = {
2002         .name = "light",
2003         .read = light_read,
2004         .write = light_write,
2005 };
2006
2007 /*************************************************************************
2008  * Dock subdriver
2009  */
2010
2011 #ifdef CONFIG_THINKPAD_ACPI_DOCK
2012
2013 IBM_HANDLE(dock, root, "\\_SB.GDCK",    /* X30, X31, X40 */
2014            "\\_SB.PCI0.DOCK",   /* 600e/x,770e,770x,A2xm/p,T20-22,X20-21 */
2015            "\\_SB.PCI0.PCI1.DOCK",      /* all others */
2016            "\\_SB.PCI.ISA.SLCE",        /* 570 */
2017     );                          /* A21e,G4x,R30,R31,R32,R40,R40e,R50e */
2018
2019 /* don't list other alternatives as we install a notify handler on the 570 */
2020 IBM_HANDLE(pci, root, "\\_SB.PCI");     /* 570 */
2021
2022 static struct tp_acpi_drv_struct ibm_dock_acpidriver[2] = {
2023         {
2024          .notify = dock_notify,
2025          .handle = &dock_handle,
2026          .type = ACPI_SYSTEM_NOTIFY,
2027         },
2028         {
2029          .hid = IBM_PCI_HID,
2030          .notify = dock_notify,
2031          .handle = &pci_handle,
2032          .type = ACPI_SYSTEM_NOTIFY,
2033         },
2034 };
2035
2036 static struct ibm_struct dock_driver_data[2] = {
2037         {
2038          .name = "dock",
2039          .read = dock_read,
2040          .write = dock_write,
2041          .acpi = &ibm_dock_acpidriver[0],
2042         },
2043         {
2044          .name = "dock",
2045          .acpi = &ibm_dock_acpidriver[1],
2046         },
2047 };
2048
2049 #define dock_docked() (_sta(dock_handle) & 1)
2050
2051 static int __init dock_init(struct ibm_init_struct *iibm)
2052 {
2053         vdbg_printk(TPACPI_DBG_INIT, "initializing dock subdriver\n");
2054
2055         IBM_ACPIHANDLE_INIT(dock);
2056
2057         vdbg_printk(TPACPI_DBG_INIT, "dock is %s\n",
2058                 str_supported(dock_handle != NULL));
2059
2060         return (dock_handle)? 0 : 1;
2061 }
2062
2063 static int __init dock_init2(struct ibm_init_struct *iibm)
2064 {
2065         int dock2_needed;
2066
2067         vdbg_printk(TPACPI_DBG_INIT, "initializing dock subdriver part 2\n");
2068
2069         if (dock_driver_data[0].flags.acpi_driver_registered &&
2070             dock_driver_data[0].flags.acpi_notify_installed) {
2071                 IBM_ACPIHANDLE_INIT(pci);
2072                 dock2_needed = (pci_handle != NULL);
2073                 vdbg_printk(TPACPI_DBG_INIT,
2074                             "dock PCI handler for the TP 570 is %s\n",
2075                             str_supported(dock2_needed));
2076         } else {
2077                 vdbg_printk(TPACPI_DBG_INIT,
2078                 "dock subdriver part 2 not required\n");
2079                 dock2_needed = 0;
2080         }
2081
2082         return (dock2_needed)? 0 : 1;
2083 }
2084
2085 static void dock_notify(struct ibm_struct *ibm, u32 event)
2086 {
2087         int docked = dock_docked();
2088         int pci = ibm->acpi->hid && strstr(ibm->acpi->hid, IBM_PCI_HID);
2089
2090         if (event == 1 && !pci) /* 570 */
2091                 acpi_bus_generate_event(ibm->acpi->device, event, 1);   /* button */
2092         else if (event == 1 && pci)     /* 570 */
2093                 acpi_bus_generate_event(ibm->acpi->device, event, 3);   /* dock */
2094         else if (event == 3 && docked)
2095                 acpi_bus_generate_event(ibm->acpi->device, event, 1);   /* button */
2096         else if (event == 3 && !docked)
2097                 acpi_bus_generate_event(ibm->acpi->device, event, 2);   /* undock */
2098         else if (event == 0 && docked)
2099                 acpi_bus_generate_event(ibm->acpi->device, event, 3);   /* dock */
2100         else {
2101                 printk(IBM_ERR "unknown dock event %d, status %d\n",
2102                        event, _sta(dock_handle));
2103                 acpi_bus_generate_event(ibm->acpi->device, event, 0);   /* unknown */
2104         }
2105 }
2106
2107 static int dock_read(char *p)
2108 {
2109         int len = 0;
2110         int docked = dock_docked();
2111
2112         if (!dock_handle)
2113                 len += sprintf(p + len, "status:\t\tnot supported\n");
2114         else if (!docked)
2115                 len += sprintf(p + len, "status:\t\tundocked\n");
2116         else {
2117                 len += sprintf(p + len, "status:\t\tdocked\n");
2118                 len += sprintf(p + len, "commands:\tdock, undock\n");
2119         }
2120
2121         return len;
2122 }
2123
2124 static int dock_write(char *buf)
2125 {
2126         char *cmd;
2127
2128         if (!dock_docked())
2129                 return -ENODEV;
2130
2131         while ((cmd = next_cmd(&buf))) {
2132                 if (strlencmp(cmd, "undock") == 0) {
2133                         if (!acpi_evalf(dock_handle, NULL, "_DCK", "vd", 0) ||
2134                             !acpi_evalf(dock_handle, NULL, "_EJ0", "vd", 1))
2135                                 return -EIO;
2136                 } else if (strlencmp(cmd, "dock") == 0) {
2137                         if (!acpi_evalf(dock_handle, NULL, "_DCK", "vd", 1))
2138                                 return -EIO;
2139                 } else
2140                         return -EINVAL;
2141         }
2142
2143         return 0;
2144 }
2145
2146 #endif /* CONFIG_THINKPAD_ACPI_DOCK */
2147
2148 /*************************************************************************
2149  * Bay subdriver
2150  */
2151
2152 #ifdef CONFIG_THINKPAD_ACPI_BAY
2153 IBM_HANDLE(bay, root, "\\_SB.PCI.IDE.SECN.MAST",        /* 570 */
2154            "\\_SB.PCI0.IDE0.IDES.IDSM", /* 600e/x, 770e, 770x */
2155            "\\_SB.PCI0.SATA.SCND.MSTR", /* T60, X60, Z60 */
2156            "\\_SB.PCI0.IDE0.SCND.MSTR", /* all others */
2157            );                           /* A21e, R30, R31 */
2158 IBM_HANDLE(bay_ej, bay, "_EJ3", /* 600e/x, A2xm/p, A3x */
2159            "_EJ0",              /* all others */
2160            );                   /* 570,A21e,G4x,R30,R31,R32,R40e,R50e */
2161 IBM_HANDLE(bay2, root, "\\_SB.PCI0.IDE0.PRIM.SLAV",     /* A3x, R32 */
2162            "\\_SB.PCI0.IDE0.IDEP.IDPS", /* 600e/x, 770e, 770x */
2163            );                           /* all others */
2164 IBM_HANDLE(bay2_ej, bay2, "_EJ3",       /* 600e/x, 770e, A3x */
2165            "_EJ0",                      /* 770x */
2166            );                           /* all others */
2167
2168 static int __init bay_init(struct ibm_init_struct *iibm)
2169 {
2170         vdbg_printk(TPACPI_DBG_INIT, "initializing bay subdriver\n");
2171
2172         IBM_ACPIHANDLE_INIT(bay);
2173         if (bay_handle)
2174                 IBM_ACPIHANDLE_INIT(bay_ej);
2175         IBM_ACPIHANDLE_INIT(bay2);
2176         if (bay2_handle)
2177                 IBM_ACPIHANDLE_INIT(bay2_ej);
2178
2179         tp_features.bay_status = bay_handle &&
2180                 acpi_evalf(bay_handle, NULL, "_STA", "qv");
2181         tp_features.bay_status2 = bay2_handle &&
2182                 acpi_evalf(bay2_handle, NULL, "_STA", "qv");
2183
2184         tp_features.bay_eject = bay_handle && bay_ej_handle &&
2185                 (strlencmp(bay_ej_path, "_EJ0") == 0 || experimental);
2186         tp_features.bay_eject2 = bay2_handle && bay2_ej_handle &&
2187                 (strlencmp(bay2_ej_path, "_EJ0") == 0 || experimental);
2188
2189         vdbg_printk(TPACPI_DBG_INIT,
2190                 "bay 1: status %s, eject %s; bay 2: status %s, eject %s\n",
2191                 str_supported(tp_features.bay_status),
2192                 str_supported(tp_features.bay_eject),
2193                 str_supported(tp_features.bay_status2),
2194                 str_supported(tp_features.bay_eject2));
2195
2196         return (tp_features.bay_status || tp_features.bay_eject ||
2197                 tp_features.bay_status2 || tp_features.bay_eject2)? 0 : 1;
2198 }
2199
2200 static void bay_notify(struct ibm_struct *ibm, u32 event)
2201 {
2202         acpi_bus_generate_event(ibm->acpi->device, event, 0);
2203 }
2204
2205 #define bay_occupied(b) (_sta(b##_handle) & 1)
2206
2207 static int bay_read(char *p)
2208 {
2209         int len = 0;
2210         int occupied = bay_occupied(bay);
2211         int occupied2 = bay_occupied(bay2);
2212         int eject, eject2;
2213
2214         len += sprintf(p + len, "status:\t\t%s\n",
2215                 tp_features.bay_status ?
2216                         (occupied ? "occupied" : "unoccupied") :
2217                                 "not supported");
2218         if (tp_features.bay_status2)
2219                 len += sprintf(p + len, "status2:\t%s\n", occupied2 ?
2220                                "occupied" : "unoccupied");
2221
2222         eject = tp_features.bay_eject && occupied;
2223         eject2 = tp_features.bay_eject2 && occupied2;
2224
2225         if (eject && eject2)
2226                 len += sprintf(p + len, "commands:\teject, eject2\n");
2227         else if (eject)
2228                 len += sprintf(p + len, "commands:\teject\n");
2229         else if (eject2)
2230                 len += sprintf(p + len, "commands:\teject2\n");
2231
2232         return len;
2233 }
2234
2235 static int bay_write(char *buf)
2236 {
2237         char *cmd;
2238
2239         if (!tp_features.bay_eject && !tp_features.bay_eject2)
2240                 return -ENODEV;
2241
2242         while ((cmd = next_cmd(&buf))) {
2243                 if (tp_features.bay_eject && strlencmp(cmd, "eject") == 0) {
2244                         if (!acpi_evalf(bay_ej_handle, NULL, NULL, "vd", 1))
2245                                 return -EIO;
2246                 } else if (tp_features.bay_eject2 &&
2247                            strlencmp(cmd, "eject2") == 0) {
2248                         if (!acpi_evalf(bay2_ej_handle, NULL, NULL, "vd", 1))
2249                                 return -EIO;
2250                 } else
2251                         return -EINVAL;
2252         }
2253
2254         return 0;
2255 }
2256
2257 static struct tp_acpi_drv_struct ibm_bay_acpidriver = {
2258         .notify = bay_notify,
2259         .handle = &bay_handle,
2260         .type = ACPI_SYSTEM_NOTIFY,
2261 };
2262
2263 static struct ibm_struct bay_driver_data = {
2264         .name = "bay",
2265         .read = bay_read,
2266         .write = bay_write,
2267         .acpi = &ibm_bay_acpidriver,
2268 };
2269
2270 #endif /* CONFIG_THINKPAD_ACPI_BAY */
2271
2272 /*************************************************************************
2273  * CMOS subdriver
2274  */
2275
2276 /* sysfs cmos_command -------------------------------------------------- */
2277 static ssize_t cmos_command_store(struct device *dev,
2278                             struct device_attribute *attr,
2279                             const char *buf, size_t count)
2280 {
2281         unsigned long cmos_cmd;
2282         int res;
2283
2284         if (parse_strtoul(buf, 21, &cmos_cmd))
2285                 return -EINVAL;
2286
2287         res = issue_thinkpad_cmos_command(cmos_cmd);
2288         return (res)? res : count;
2289 }
2290
2291 static struct device_attribute dev_attr_cmos_command =
2292         __ATTR(cmos_command, S_IWUSR, NULL, cmos_command_store);
2293
2294 /* --------------------------------------------------------------------- */
2295
2296 static int __init cmos_init(struct ibm_init_struct *iibm)
2297 {
2298         int res;
2299
2300         vdbg_printk(TPACPI_DBG_INIT,
2301                 "initializing cmos commands subdriver\n");
2302
2303         IBM_ACPIHANDLE_INIT(cmos);
2304
2305         vdbg_printk(TPACPI_DBG_INIT, "cmos commands are %s\n",
2306                 str_supported(cmos_handle != NULL));
2307
2308         res = device_create_file(&tpacpi_pdev->dev, &dev_attr_cmos_command);
2309         if (res)
2310                 return res;
2311
2312         return (cmos_handle)? 0 : 1;
2313 }
2314
2315 static void cmos_exit(void)
2316 {
2317         device_remove_file(&tpacpi_pdev->dev, &dev_attr_cmos_command);
2318 }
2319
2320 static int cmos_read(char *p)
2321 {
2322         int len = 0;
2323
2324         /* cmos not supported on 570, 600e/x, 770e, 770x, A21e, A2xm/p,
2325            R30, R31, T20-22, X20-21 */
2326         if (!cmos_handle)
2327                 len += sprintf(p + len, "status:\t\tnot supported\n");
2328         else {
2329                 len += sprintf(p + len, "status:\t\tsupported\n");
2330                 len += sprintf(p + len, "commands:\t<cmd> (<cmd> is 0-21)\n");
2331         }
2332
2333         return len;
2334 }
2335
2336 static int cmos_write(char *buf)
2337 {
2338         char *cmd;
2339         int cmos_cmd, res;
2340
2341         while ((cmd = next_cmd(&buf))) {
2342                 if (sscanf(cmd, "%u", &cmos_cmd) == 1 &&
2343                     cmos_cmd >= 0 && cmos_cmd <= 21) {
2344                         /* cmos_cmd set */
2345                 } else
2346                         return -EINVAL;
2347
2348                 res = issue_thinkpad_cmos_command(cmos_cmd);
2349                 if (res)
2350                         return res;
2351         }
2352
2353         return 0;
2354 }
2355
2356 static struct ibm_struct cmos_driver_data = {
2357         .name = "cmos",
2358         .read = cmos_read,
2359         .write = cmos_write,
2360         .exit = cmos_exit,
2361 };
2362
2363 /*************************************************************************
2364  * LED subdriver
2365  */
2366
2367 static enum led_access_mode led_supported;
2368
2369 IBM_HANDLE(led, ec, "SLED",     /* 570 */
2370            "SYSL",              /* 600e/x, 770e, 770x, A21e, A2xm/p, T20-22, X20-21 */
2371            "LED",               /* all others */
2372            );                   /* R30, R31 */
2373
2374 static int __init led_init(struct ibm_init_struct *iibm)
2375 {
2376         vdbg_printk(TPACPI_DBG_INIT, "initializing LED subdriver\n");
2377
2378         IBM_ACPIHANDLE_INIT(led);
2379
2380         if (!led_handle)
2381                 /* led not supported on R30, R31 */
2382                 led_supported = TPACPI_LED_NONE;
2383         else if (strlencmp(led_path, "SLED") == 0)
2384                 /* 570 */
2385                 led_supported = TPACPI_LED_570;
2386         else if (strlencmp(led_path, "SYSL") == 0)
2387                 /* 600e/x, 770e, 770x, A21e, A2xm/p, T20-22, X20-21 */
2388                 led_supported = TPACPI_LED_OLD;
2389         else
2390                 /* all others */
2391                 led_supported = TPACPI_LED_NEW;
2392
2393         vdbg_printk(TPACPI_DBG_INIT, "LED commands are %s, mode %d\n",
2394                 str_supported(led_supported), led_supported);
2395
2396         return (led_supported != TPACPI_LED_NONE)? 0 : 1;
2397 }
2398
2399 #define led_status(s) ((s) == 0 ? "off" : ((s) == 1 ? "on" : "blinking"))
2400
2401 static int led_read(char *p)
2402 {
2403         int len = 0;
2404
2405         if (!led_supported) {
2406                 len += sprintf(p + len, "status:\t\tnot supported\n");
2407                 return len;
2408         }
2409         len += sprintf(p + len, "status:\t\tsupported\n");
2410
2411         if (led_supported == TPACPI_LED_570) {
2412                 /* 570 */
2413                 int i, status;
2414                 for (i = 0; i < 8; i++) {
2415                         if (!acpi_evalf(ec_handle,
2416                                         &status, "GLED", "dd", 1 << i))
2417                                 return -EIO;
2418                         len += sprintf(p + len, "%d:\t\t%s\n",
2419                                        i, led_status(status));
2420                 }
2421         }
2422
2423         len += sprintf(p + len, "commands:\t"
2424                        "<led> on, <led> off, <led> blink (<led> is 0-7)\n");
2425
2426         return len;
2427 }
2428
2429 /* off, on, blink */
2430 static const int led_sled_arg1[] = { 0, 1, 3 };
2431 static const int led_exp_hlbl[] = { 0, 0, 1 };  /* led# * */
2432 static const int led_exp_hlcl[] = { 0, 1, 1 };  /* led# * */
2433 static const int led_led_arg1[] = { 0, 0x80, 0xc0 };
2434
2435 static int led_write(char *buf)
2436 {
2437         char *cmd;
2438         int led, ind, ret;
2439
2440         if (!led_supported)
2441                 return -ENODEV;
2442
2443         while ((cmd = next_cmd(&buf))) {
2444                 if (sscanf(cmd, "%d", &led) != 1 || led < 0 || led > 7)
2445                         return -EINVAL;
2446
2447                 if (strstr(cmd, "off")) {
2448                         ind = 0;
2449                 } else if (strstr(cmd, "on")) {
2450                         ind = 1;
2451                 } else if (strstr(cmd, "blink")) {
2452                         ind = 2;
2453                 } else
2454                         return -EINVAL;
2455
2456                 if (led_supported == TPACPI_LED_570) {
2457                         /* 570 */
2458                         led = 1 << led;
2459                         if (!acpi_evalf(led_handle, NULL, NULL, "vdd",
2460                                         led, led_sled_arg1[ind]))
2461                                 return -EIO;
2462                 } else if (led_supported == TPACPI_LED_OLD) {
2463                         /* 600e/x, 770e, 770x, A21e, A2xm/p, T20-22, X20 */
2464                         led = 1 << led;
2465                         ret = ec_write(TPACPI_LED_EC_HLMS, led);
2466                         if (ret >= 0)
2467                                 ret =
2468                                     ec_write(TPACPI_LED_EC_HLBL,
2469                                              led * led_exp_hlbl[ind]);
2470                         if (ret >= 0)
2471                                 ret =
2472                                     ec_write(TPACPI_LED_EC_HLCL,
2473                                              led * led_exp_hlcl[ind]);
2474                         if (ret < 0)
2475                                 return ret;
2476                 } else {
2477                         /* all others */
2478                         if (!acpi_evalf(led_handle, NULL, NULL, "vdd",
2479                                         led, led_led_arg1[ind]))
2480                                 return -EIO;
2481                 }
2482         }
2483
2484         return 0;
2485 }
2486
2487 static struct ibm_struct led_driver_data = {
2488         .name = "led",
2489         .read = led_read,
2490         .write = led_write,
2491 };
2492
2493 /*************************************************************************
2494  * Beep subdriver
2495  */
2496
2497 IBM_HANDLE(beep, ec, "BEEP");   /* all except R30, R31 */
2498
2499 static int __init beep_init(struct ibm_init_struct *iibm)
2500 {
2501         vdbg_printk(TPACPI_DBG_INIT, "initializing beep subdriver\n");
2502
2503         IBM_ACPIHANDLE_INIT(beep);
2504
2505         vdbg_printk(TPACPI_DBG_INIT, "beep is %s\n",
2506                 str_supported(beep_handle != NULL));
2507
2508         return (beep_handle)? 0 : 1;
2509 }
2510
2511 static int beep_read(char *p)
2512 {
2513         int len = 0;
2514
2515         if (!beep_handle)
2516                 len += sprintf(p + len, "status:\t\tnot supported\n");
2517         else {
2518                 len += sprintf(p + len, "status:\t\tsupported\n");
2519                 len += sprintf(p + len, "commands:\t<cmd> (<cmd> is 0-17)\n");
2520         }
2521
2522         return len;
2523 }
2524
2525 static int beep_write(char *buf)
2526 {
2527         char *cmd;
2528         int beep_cmd;
2529
2530         if (!beep_handle)
2531                 return -ENODEV;
2532
2533         while ((cmd = next_cmd(&buf))) {
2534                 if (sscanf(cmd, "%u", &beep_cmd) == 1 &&
2535                     beep_cmd >= 0 && beep_cmd <= 17) {
2536                         /* beep_cmd set */
2537                 } else
2538                         return -EINVAL;
2539                 if (!acpi_evalf(beep_handle, NULL, NULL, "vdd", beep_cmd, 0))
2540                         return -EIO;
2541         }
2542
2543         return 0;
2544 }
2545
2546 static struct ibm_struct beep_driver_data = {
2547         .name = "beep",
2548         .read = beep_read,
2549         .write = beep_write,
2550 };
2551
2552 /*************************************************************************
2553  * Thermal subdriver
2554  */
2555
2556 static enum thermal_access_mode thermal_read_mode;
2557
2558 /* sysfs temp##_input -------------------------------------------------- */
2559
2560 static ssize_t thermal_temp_input_show(struct device *dev,
2561                            struct device_attribute *attr,
2562                            char *buf)
2563 {
2564         struct sensor_device_attribute *sensor_attr =
2565                                         to_sensor_dev_attr(attr);
2566         int idx = sensor_attr->index;
2567         s32 value;
2568         int res;
2569
2570         res = thermal_get_sensor(idx, &value);
2571         if (res)
2572                 return res;
2573         if (value == TP_EC_THERMAL_TMP_NA * 1000)
2574                 return -ENXIO;
2575
2576         return snprintf(buf, PAGE_SIZE, "%d\n", value);
2577 }
2578
2579 #define THERMAL_SENSOR_ATTR_TEMP(_idxA, _idxB) \
2580          SENSOR_ATTR(temp##_idxA##_input, S_IRUGO, thermal_temp_input_show, NULL, _idxB)
2581
2582 static struct sensor_device_attribute sensor_dev_attr_thermal_temp_input[] = {
2583         THERMAL_SENSOR_ATTR_TEMP(1, 0),
2584         THERMAL_SENSOR_ATTR_TEMP(2, 1),
2585         THERMAL_SENSOR_ATTR_TEMP(3, 2),
2586         THERMAL_SENSOR_ATTR_TEMP(4, 3),
2587         THERMAL_SENSOR_ATTR_TEMP(5, 4),
2588         THERMAL_SENSOR_ATTR_TEMP(6, 5),
2589         THERMAL_SENSOR_ATTR_TEMP(7, 6),
2590         THERMAL_SENSOR_ATTR_TEMP(8, 7),
2591         THERMAL_SENSOR_ATTR_TEMP(9, 8),
2592         THERMAL_SENSOR_ATTR_TEMP(10, 9),
2593         THERMAL_SENSOR_ATTR_TEMP(11, 10),
2594         THERMAL_SENSOR_ATTR_TEMP(12, 11),
2595         THERMAL_SENSOR_ATTR_TEMP(13, 12),
2596         THERMAL_SENSOR_ATTR_TEMP(14, 13),
2597         THERMAL_SENSOR_ATTR_TEMP(15, 14),
2598         THERMAL_SENSOR_ATTR_TEMP(16, 15),
2599 };
2600
2601 #define THERMAL_ATTRS(X) \
2602         &sensor_dev_attr_thermal_temp_input[X].dev_attr.attr
2603
2604 static struct attribute *thermal_temp_input_attr[] = {
2605         THERMAL_ATTRS(8),
2606         THERMAL_ATTRS(9),
2607         THERMAL_ATTRS(10),
2608         THERMAL_ATTRS(11),
2609         THERMAL_ATTRS(12),
2610         THERMAL_ATTRS(13),
2611         THERMAL_ATTRS(14),
2612         THERMAL_ATTRS(15),
2613         THERMAL_ATTRS(0),
2614         THERMAL_ATTRS(1),
2615         THERMAL_ATTRS(2),
2616         THERMAL_ATTRS(3),
2617         THERMAL_ATTRS(4),
2618         THERMAL_ATTRS(5),
2619         THERMAL_ATTRS(6),
2620         THERMAL_ATTRS(7),
2621         NULL
2622 };
2623
2624 static const struct attribute_group thermal_temp_input16_group = {
2625         .attrs = thermal_temp_input_attr
2626 };
2627
2628 static const struct attribute_group thermal_temp_input8_group = {
2629         .attrs = &thermal_temp_input_attr[8]
2630 };
2631
2632 #undef THERMAL_SENSOR_ATTR_TEMP
2633 #undef THERMAL_ATTRS
2634
2635 /* --------------------------------------------------------------------- */
2636
2637 static int __init thermal_init(struct ibm_init_struct *iibm)
2638 {
2639         u8 t, ta1, ta2;
2640         int i;
2641         int acpi_tmp7;
2642         int res;
2643
2644         vdbg_printk(TPACPI_DBG_INIT, "initializing thermal subdriver\n");
2645
2646         acpi_tmp7 = acpi_evalf(ec_handle, NULL, "TMP7", "qv");
2647
2648         if (ibm_thinkpad_ec_found && experimental) {
2649                 /*
2650                  * Direct EC access mode: sensors at registers
2651                  * 0x78-0x7F, 0xC0-0xC7.  Registers return 0x00 for
2652                  * non-implemented, thermal sensors return 0x80 when
2653                  * not available
2654                  */
2655
2656                 ta1 = ta2 = 0;
2657                 for (i = 0; i < 8; i++) {
2658                         if (acpi_ec_read(TP_EC_THERMAL_TMP0 + i, &t)) {
2659                                 ta1 |= t;
2660                         } else {
2661                                 ta1 = 0;
2662                                 break;
2663                         }
2664                         if (acpi_ec_read(TP_EC_THERMAL_TMP8 + i, &t)) {
2665                                 ta2 |= t;
2666                         } else {
2667                                 ta1 = 0;
2668                                 break;
2669                         }
2670                 }
2671                 if (ta1 == 0) {
2672                         /* This is sheer paranoia, but we handle it anyway */
2673                         if (acpi_tmp7) {
2674                                 printk(IBM_ERR
2675                                        "ThinkPad ACPI EC access misbehaving, "
2676                                        "falling back to ACPI TMPx access mode\n");
2677                                 thermal_read_mode = TPACPI_THERMAL_ACPI_TMP07;
2678                         } else {
2679                                 printk(IBM_ERR
2680                                        "ThinkPad ACPI EC access misbehaving, "
2681                                        "disabling thermal sensors access\n");
2682                                 thermal_read_mode = TPACPI_THERMAL_NONE;
2683                         }
2684                 } else {
2685                         thermal_read_mode =
2686                             (ta2 != 0) ?
2687                             TPACPI_THERMAL_TPEC_16 : TPACPI_THERMAL_TPEC_8;
2688                 }
2689         } else if (acpi_tmp7) {
2690                 if (acpi_evalf(ec_handle, NULL, "UPDT", "qv")) {
2691                         /* 600e/x, 770e, 770x */
2692                         thermal_read_mode = TPACPI_THERMAL_ACPI_UPDT;
2693                 } else {
2694                         /* Standard ACPI TMPx access, max 8 sensors */
2695                         thermal_read_mode = TPACPI_THERMAL_ACPI_TMP07;
2696                 }
2697         } else {
2698                 /* temperatures not supported on 570, G4x, R30, R31, R32 */
2699                 thermal_read_mode = TPACPI_THERMAL_NONE;
2700         }
2701
2702         vdbg_printk(TPACPI_DBG_INIT, "thermal is %s, mode %d\n",
2703                 str_supported(thermal_read_mode != TPACPI_THERMAL_NONE),
2704                 thermal_read_mode);
2705
2706         switch(thermal_read_mode) {
2707         case TPACPI_THERMAL_TPEC_16:
2708                 res = sysfs_create_group(&tpacpi_pdev->dev.kobj,
2709                                 &thermal_temp_input16_group);
2710                 if (res)
2711                         return res;
2712                 break;
2713         case TPACPI_THERMAL_TPEC_8:
2714         case TPACPI_THERMAL_ACPI_TMP07:
2715         case TPACPI_THERMAL_ACPI_UPDT:
2716                 res = sysfs_create_group(&tpacpi_pdev->dev.kobj,
2717                                 &thermal_temp_input8_group);
2718                 if (res)
2719                         return res;
2720                 break;
2721         case TPACPI_THERMAL_NONE:
2722         default:
2723                 return 1;
2724         }
2725
2726         return 0;
2727 }
2728
2729 static void thermal_exit(void)
2730 {
2731         switch(thermal_read_mode) {
2732         case TPACPI_THERMAL_TPEC_16:
2733                 sysfs_remove_group(&tpacpi_pdev->dev.kobj,
2734                                    &thermal_temp_input16_group);
2735                 break;
2736         case TPACPI_THERMAL_TPEC_8:
2737         case TPACPI_THERMAL_ACPI_TMP07:
2738         case TPACPI_THERMAL_ACPI_UPDT:
2739                 sysfs_remove_group(&tpacpi_pdev->dev.kobj,
2740                                    &thermal_temp_input16_group);
2741                 break;
2742         case TPACPI_THERMAL_NONE:
2743         default:
2744                 break;
2745         }
2746 }
2747
2748 /* idx is zero-based */
2749 static int thermal_get_sensor(int idx, s32 *value)
2750 {
2751         int t;
2752         s8 tmp;
2753         char tmpi[5];
2754
2755         t = TP_EC_THERMAL_TMP0;
2756
2757         switch (thermal_read_mode) {
2758 #if TPACPI_MAX_THERMAL_SENSORS >= 16
2759         case TPACPI_THERMAL_TPEC_16:
2760                 if (idx >= 8 && idx <= 15) {
2761                         t = TP_EC_THERMAL_TMP8;
2762                         idx -= 8;
2763                 }
2764                 /* fallthrough */
2765 #endif
2766         case TPACPI_THERMAL_TPEC_8:
2767                 if (idx <= 7) {
2768                         if (!acpi_ec_read(t + idx, &tmp))
2769                                 return -EIO;
2770                         *value = tmp * 1000;
2771                         return 0;
2772                 }
2773                 break;
2774
2775         case TPACPI_THERMAL_ACPI_UPDT:
2776                 if (idx <= 7) {
2777                         snprintf(tmpi, sizeof(tmpi), "TMP%c", '0' + idx);
2778                         if (!acpi_evalf(ec_handle, NULL, "UPDT", "v"))
2779                                 return -EIO;
2780                         if (!acpi_evalf(ec_handle, &t, tmpi, "d"))
2781                                 return -EIO;
2782                         *value = (t - 2732) * 100;
2783                         return 0;
2784                 }
2785                 break;
2786
2787         case TPACPI_THERMAL_ACPI_TMP07:
2788                 if (idx <= 7) {
2789                         snprintf(tmpi, sizeof(tmpi), "TMP%c", '0' + idx);
2790                         if (!acpi_evalf(ec_handle, &t, tmpi, "d"))
2791                                 return -EIO;
2792                         *value = t * 1000;
2793                         return 0;
2794                 }
2795                 break;
2796
2797         case TPACPI_THERMAL_NONE:
2798         default:
2799                 return -ENOSYS;
2800         }
2801
2802         return -EINVAL;
2803 }
2804
2805 static int thermal_get_sensors(struct ibm_thermal_sensors_struct *s)
2806 {
2807         int res, i;
2808         int n;
2809
2810         n = 8;
2811         i = 0;
2812
2813         if (!s)
2814                 return -EINVAL;
2815
2816         if (thermal_read_mode == TPACPI_THERMAL_TPEC_16)
2817                 n = 16;
2818
2819         for(i = 0 ; i < n; i++) {
2820                 res = thermal_get_sensor(i, &s->temp[i]);
2821                 if (res)
2822                         return res;
2823         }
2824
2825         return n;
2826 }
2827
2828 static int thermal_read(char *p)
2829 {
2830         int len = 0;
2831         int n, i;
2832         struct ibm_thermal_sensors_struct t;
2833
2834         n = thermal_get_sensors(&t);
2835         if (unlikely(n < 0))
2836                 return n;
2837
2838         len += sprintf(p + len, "temperatures:\t");
2839
2840         if (n > 0) {
2841                 for (i = 0; i < (n - 1); i++)
2842                         len += sprintf(p + len, "%d ", t.temp[i] / 1000);
2843                 len += sprintf(p + len, "%d\n", t.temp[i] / 1000);
2844         } else
2845                 len += sprintf(p + len, "not supported\n");
2846
2847         return len;
2848 }
2849
2850 static struct ibm_struct thermal_driver_data = {
2851         .name = "thermal",
2852         .read = thermal_read,
2853         .exit = thermal_exit,
2854 };
2855
2856 /*************************************************************************
2857  * EC Dump subdriver
2858  */
2859
2860 static u8 ecdump_regs[256];
2861
2862 static int ecdump_read(char *p)
2863 {
2864         int len = 0;
2865         int i, j;
2866         u8 v;
2867
2868         len += sprintf(p + len, "EC      "
2869                        " +00 +01 +02 +03 +04 +05 +06 +07"
2870                        " +08 +09 +0a +0b +0c +0d +0e +0f\n");
2871         for (i = 0; i < 256; i += 16) {
2872                 len += sprintf(p + len, "EC 0x%02x:", i);
2873                 for (j = 0; j < 16; j++) {
2874                         if (!acpi_ec_read(i + j, &v))
2875                                 break;
2876                         if (v != ecdump_regs[i + j])
2877                                 len += sprintf(p + len, " *%02x", v);
2878                         else
2879                                 len += sprintf(p + len, "  %02x", v);
2880                         ecdump_regs[i + j] = v;
2881                 }
2882                 len += sprintf(p + len, "\n");
2883                 if (j != 16)
2884                         break;
2885         }
2886
2887         /* These are way too dangerous to advertise openly... */
2888 #if 0
2889         len += sprintf(p + len, "commands:\t0x<offset> 0x<value>"
2890                        " (<offset> is 00-ff, <value> is 00-ff)\n");
2891         len += sprintf(p + len, "commands:\t0x<offset> <value>  "
2892                        " (<offset> is 00-ff, <value> is 0-255)\n");
2893 #endif
2894         return len;
2895 }
2896
2897 static int ecdump_write(char *buf)
2898 {
2899         char *cmd;
2900         int i, v;
2901
2902         while ((cmd = next_cmd(&buf))) {
2903                 if (sscanf(cmd, "0x%x 0x%x", &i, &v) == 2) {
2904                         /* i and v set */
2905                 } else if (sscanf(cmd, "0x%x %u", &i, &v) == 2) {
2906                         /* i and v set */
2907                 } else
2908                         return -EINVAL;
2909                 if (i >= 0 && i < 256 && v >= 0 && v < 256) {
2910                         if (!acpi_ec_write(i, v))
2911                                 return -EIO;
2912                 } else
2913                         return -EINVAL;
2914         }
2915
2916         return 0;
2917 }
2918
2919 static struct ibm_struct ecdump_driver_data = {
2920         .name = "ecdump",
2921         .read = ecdump_read,
2922         .write = ecdump_write,
2923         .flags.experimental = 1,
2924 };
2925
2926 /*************************************************************************
2927  * Backlight/brightness subdriver
2928  */
2929
2930 static struct backlight_device *ibm_backlight_device;
2931
2932 static struct backlight_ops ibm_backlight_data = {
2933         .get_brightness = brightness_get,
2934         .update_status  = brightness_update_status,
2935 };
2936
2937 static int __init brightness_init(struct ibm_init_struct *iibm)
2938 {
2939         int b;
2940
2941         vdbg_printk(TPACPI_DBG_INIT, "initializing brightness subdriver\n");
2942
2943         b = brightness_get(NULL);
2944         if (b < 0)
2945                 return b;
2946
2947         ibm_backlight_device = backlight_device_register(
2948                                         TPACPI_BACKLIGHT_DEV_NAME, NULL, NULL,
2949                                         &ibm_backlight_data);
2950         if (IS_ERR(ibm_backlight_device)) {
2951                 printk(IBM_ERR "Could not register backlight device\n");
2952                 return PTR_ERR(ibm_backlight_device);
2953         }
2954         vdbg_printk(TPACPI_DBG_INIT, "brightness is supported\n");
2955
2956         ibm_backlight_device->props.max_brightness = 7;
2957         ibm_backlight_device->props.brightness = b;
2958         backlight_update_status(ibm_backlight_device);
2959
2960         return 0;
2961 }
2962
2963 static void brightness_exit(void)
2964 {
2965         if (ibm_backlight_device) {
2966                 vdbg_printk(TPACPI_DBG_EXIT,
2967                             "calling backlight_device_unregister()\n");
2968                 backlight_device_unregister(ibm_backlight_device);
2969                 ibm_backlight_device = NULL;
2970         }
2971 }
2972
2973 static int brightness_update_status(struct backlight_device *bd)
2974 {
2975         return brightness_set(
2976                 (bd->props.fb_blank == FB_BLANK_UNBLANK &&
2977                  bd->props.power == FB_BLANK_UNBLANK) ?
2978                                 bd->props.brightness : 0);
2979 }
2980
2981 static int brightness_get(struct backlight_device *bd)
2982 {
2983         u8 level;
2984         if (!acpi_ec_read(brightness_offset, &level))
2985                 return -EIO;
2986
2987         level &= 0x7;
2988
2989         return level;
2990 }
2991
2992 static int brightness_set(int value)
2993 {
2994         int cmos_cmd, inc, i;
2995         int current_value = brightness_get(NULL);
2996
2997         value &= 7;
2998
2999         cmos_cmd = value > current_value ? TP_CMOS_BRIGHTNESS_UP : TP_CMOS_BRIGHTNESS_DOWN;
3000         inc = value > current_value ? 1 : -1;
3001         for (i = current_value; i != value; i += inc) {
3002                 if (issue_thinkpad_cmos_command(cmos_cmd))
3003                         return -EIO;
3004                 if (!acpi_ec_write(brightness_offset, i + inc))
3005                         return -EIO;
3006         }
3007
3008         return 0;
3009 }
3010
3011 static int brightness_read(char *p)
3012 {
3013         int len = 0;
3014         int level;
3015
3016         if ((level = brightness_get(NULL)) < 0) {
3017                 len += sprintf(p + len, "level:\t\tunreadable\n");
3018         } else {
3019                 len += sprintf(p + len, "level:\t\t%d\n", level & 0x7);
3020                 len += sprintf(p + len, "commands:\tup, down\n");
3021                 len += sprintf(p + len, "commands:\tlevel <level>"
3022                                " (<level> is 0-7)\n");
3023         }
3024
3025         return len;
3026 }
3027
3028 static int brightness_write(char *buf)
3029 {
3030         int level;
3031         int new_level;
3032         char *cmd;
3033
3034         while ((cmd = next_cmd(&buf))) {
3035                 if ((level = brightness_get(NULL)) < 0)
3036                         return level;
3037                 level &= 7;
3038
3039                 if (strlencmp(cmd, "up") == 0) {
3040                         new_level = level == 7 ? 7 : level + 1;
3041                 } else if (strlencmp(cmd, "down") == 0) {
3042                         new_level = level == 0 ? 0 : level - 1;
3043                 } else if (sscanf(cmd, "level %d", &new_level) == 1 &&
3044                            new_level >= 0 && new_level <= 7) {
3045                         /* new_level set */
3046                 } else
3047                         return -EINVAL;
3048
3049                 brightness_set(new_level);
3050         }
3051
3052         return 0;
3053 }
3054
3055 static struct ibm_struct brightness_driver_data = {
3056         .name = "brightness",
3057         .read = brightness_read,
3058         .write = brightness_write,
3059         .exit = brightness_exit,
3060 };
3061
3062 /*************************************************************************
3063  * Volume subdriver
3064  */
3065
3066 static int volume_read(char *p)
3067 {
3068         int len = 0;
3069         u8 level;
3070
3071         if (!acpi_ec_read(volume_offset, &level)) {
3072                 len += sprintf(p + len, "level:\t\tunreadable\n");
3073         } else {
3074                 len += sprintf(p + len, "level:\t\t%d\n", level & 0xf);
3075                 len += sprintf(p + len, "mute:\t\t%s\n", onoff(level, 6));
3076                 len += sprintf(p + len, "commands:\tup, down, mute\n");
3077                 len += sprintf(p + len, "commands:\tlevel <level>"
3078                                " (<level> is 0-15)\n");
3079         }
3080
3081         return len;
3082 }
3083
3084 static int volume_write(char *buf)
3085 {
3086         int cmos_cmd, inc, i;
3087         u8 level, mute;
3088         int new_level, new_mute;
3089         char *cmd;
3090
3091         while ((cmd = next_cmd(&buf))) {
3092                 if (!acpi_ec_read(volume_offset, &level))
3093                         return -EIO;
3094                 new_mute = mute = level & 0x40;
3095                 new_level = level = level & 0xf;
3096
3097                 if (strlencmp(cmd, "up") == 0) {
3098                         if (mute)
3099                                 new_mute = 0;
3100                         else
3101                                 new_level = level == 15 ? 15 : level + 1;
3102                 } else if (strlencmp(cmd, "down") == 0) {
3103                         if (mute)
3104                                 new_mute = 0;
3105                         else
3106                                 new_level = level == 0 ? 0 : level - 1;
3107                 } else if (sscanf(cmd, "level %d", &new_level) == 1 &&
3108                            new_level >= 0 && new_level <= 15) {
3109                         /* new_level set */
3110                 } else if (strlencmp(cmd, "mute") == 0) {
3111                         new_mute = 0x40;
3112                 } else
3113                         return -EINVAL;
3114
3115                 if (new_level != level) {       /* mute doesn't change */
3116                         cmos_cmd = new_level > level ? TP_CMOS_VOLUME_UP : TP_CMOS_VOLUME_DOWN;
3117                         inc = new_level > level ? 1 : -1;
3118
3119                         if (mute && (issue_thinkpad_cmos_command(cmos_cmd) ||
3120                                      !acpi_ec_write(volume_offset, level)))
3121                                 return -EIO;
3122
3123                         for (i = level; i != new_level; i += inc)
3124                                 if (issue_thinkpad_cmos_command(cmos_cmd) ||
3125                                     !acpi_ec_write(volume_offset, i + inc))
3126                                         return -EIO;
3127
3128                         if (mute && (issue_thinkpad_cmos_command(TP_CMOS_VOLUME_MUTE) ||
3129                                      !acpi_ec_write(volume_offset,
3130                                                     new_level + mute)))
3131                                 return -EIO;
3132                 }
3133
3134                 if (new_mute != mute) { /* level doesn't change */
3135                         cmos_cmd = new_mute ? TP_CMOS_VOLUME_MUTE : TP_CMOS_VOLUME_UP;
3136
3137                         if (issue_thinkpad_cmos_command(cmos_cmd) ||
3138                             !acpi_ec_write(volume_offset, level + new_mute))
3139                                 return -EIO;
3140                 }
3141         }
3142
3143         return 0;
3144 }
3145
3146 static struct ibm_struct volume_driver_data = {
3147         .name = "volume",
3148         .read = volume_read,
3149         .write = volume_write,
3150 };
3151
3152 /*************************************************************************
3153  * Fan subdriver
3154  */
3155
3156 /*
3157  * FAN ACCESS MODES
3158  *
3159  * TPACPI_FAN_RD_ACPI_GFAN:
3160  *      ACPI GFAN method: returns fan level
3161  *
3162  *      see TPACPI_FAN_WR_ACPI_SFAN
3163  *      EC 0x2f (HFSP) not available if GFAN exists
3164  *
3165  * TPACPI_FAN_WR_ACPI_SFAN:
3166  *      ACPI SFAN method: sets fan level, 0 (stop) to 7 (max)
3167  *
3168  *      EC 0x2f (HFSP) might be available *for reading*, but do not use
3169  *      it for writing.
3170  *
3171  * TPACPI_FAN_WR_TPEC:
3172  *      ThinkPad EC register 0x2f (HFSP): fan control loop mode
3173  *      Supported on almost all ThinkPads
3174  *
3175  *      Fan speed changes of any sort (including those caused by the
3176  *      disengaged mode) are usually done slowly by the firmware as the
3177  *      maximum ammount of fan duty cycle change per second seems to be
3178  *      limited.
3179  *
3180  *      Reading is not available if GFAN exists.
3181  *      Writing is not available if SFAN exists.
3182  *
3183  *      Bits
3184  *       7      automatic mode engaged;
3185  *              (default operation mode of the ThinkPad)
3186  *              fan level is ignored in this mode.
3187  *       6      full speed mode (takes precedence over bit 7);
3188  *              not available on all thinkpads.  May disable
3189  *              the tachometer while the fan controller ramps up
3190  *              the speed (which can take up to a few *minutes*).
3191  *              Speeds up fan to 100% duty-cycle, which is far above
3192  *              the standard RPM levels.  It is not impossible that
3193  *              it could cause hardware damage.
3194  *      5-3     unused in some models.  Extra bits for fan level
3195  *              in others, but still useless as all values above
3196  *              7 map to the same speed as level 7 in these models.
3197  *      2-0     fan level (0..7 usually)
3198  *                      0x00 = stop
3199  *                      0x07 = max (set when temperatures critical)
3200  *              Some ThinkPads may have other levels, see
3201  *              TPACPI_FAN_WR_ACPI_FANS (X31/X40/X41)
3202  *
3203  *      FIRMWARE BUG: on some models, EC 0x2f might not be initialized at
3204  *      boot. Apparently the EC does not intialize it, so unless ACPI DSDT
3205  *      does so, its initial value is meaningless (0x07).
3206  *
3207  *      For firmware bugs, refer to:
3208  *      http://thinkwiki.org/wiki/Embedded_Controller_Firmware#Firmware_Issues
3209  *
3210  *      ----
3211  *
3212  *      ThinkPad EC register 0x84 (LSB), 0x85 (MSB):
3213  *      Main fan tachometer reading (in RPM)
3214  *
3215  *      This register is present on all ThinkPads with a new-style EC, and
3216  *      it is known not to be present on the A21m/e, and T22, as there is
3217  *      something else in offset 0x84 according to the ACPI DSDT.  Other
3218  *      ThinkPads from this same time period (and earlier) probably lack the
3219  *      tachometer as well.
3220  *
3221  *      Unfortunately a lot of ThinkPads with new-style ECs but whose firwmare
3222  *      was never fixed by IBM to report the EC firmware version string
3223  *      probably support the tachometer (like the early X models), so
3224  *      detecting it is quite hard.  We need more data to know for sure.
3225  *
3226  *      FIRMWARE BUG: always read 0x84 first, otherwise incorrect readings
3227  *      might result.
3228  *
3229  *      FIRMWARE BUG: may go stale while the EC is switching to full speed
3230  *      mode.
3231  *
3232  *      For firmware bugs, refer to:
3233  *      http://thinkwiki.org/wiki/Embedded_Controller_Firmware#Firmware_Issues
3234  *
3235  * TPACPI_FAN_WR_ACPI_FANS:
3236  *      ThinkPad X31, X40, X41.  Not available in the X60.
3237  *
3238  *      FANS ACPI handle: takes three arguments: low speed, medium speed,
3239  *      high speed.  ACPI DSDT seems to map these three speeds to levels
3240  *      as follows: STOP LOW LOW MED MED HIGH HIGH HIGH HIGH
3241  *      (this map is stored on FAN0..FAN8 as "0,1,1,2,2,3,3,3,3")
3242  *
3243  *      The speeds are stored on handles
3244  *      (FANA:FAN9), (FANC:FANB), (FANE:FAND).
3245  *
3246  *      There are three default speed sets, acessible as handles:
3247  *      FS1L,FS1M,FS1H; FS2L,FS2M,FS2H; FS3L,FS3M,FS3H
3248  *
3249  *      ACPI DSDT switches which set is in use depending on various
3250  *      factors.
3251  *
3252  *      TPACPI_FAN_WR_TPEC is also available and should be used to
3253  *      command the fan.  The X31/X40/X41 seems to have 8 fan levels,
3254  *      but the ACPI tables just mention level 7.
3255  */
3256
3257 static enum fan_status_access_mode fan_status_access_mode;
3258 static enum fan_control_access_mode fan_control_access_mode;
3259 static enum fan_control_commands fan_control_commands;
3260
3261 static u8 fan_control_initial_status;
3262 static u8 fan_control_desired_level;
3263
3264 static void fan_watchdog_fire(struct work_struct *ignored);
3265 static int fan_watchdog_maxinterval;
3266 static DECLARE_DELAYED_WORK(fan_watchdog_task, fan_watchdog_fire);
3267
3268 IBM_HANDLE(fans, ec, "FANS");   /* X31, X40, X41 */
3269 IBM_HANDLE(gfan, ec, "GFAN",    /* 570 */
3270            "\\FSPD",            /* 600e/x, 770e, 770x */
3271            );                   /* all others */
3272 IBM_HANDLE(sfan, ec, "SFAN",    /* 570 */
3273            "JFNS",              /* 770x-JL */
3274            );                   /* all others */
3275
3276 /*
3277  * SYSFS fan layout: hwmon compatible (device)
3278  *
3279  * pwm*_enable:
3280  *      0: "disengaged" mode
3281  *      1: manual mode
3282  *      2: native EC "auto" mode (recommended, hardware default)
3283  *
3284  * pwm*: set speed in manual mode, ignored otherwise.
3285  *      0 is level 0; 255 is level 7. Intermediate points done with linear
3286  *      interpolation.
3287  *
3288  * fan*_input: tachometer reading, RPM
3289  *
3290  *
3291  * SYSFS fan layout: extensions
3292  *
3293  * fan_watchdog (driver):
3294  *      fan watchdog interval in seconds, 0 disables (default), max 120
3295  */
3296
3297 /* sysfs fan pwm1_enable ----------------------------------------------- */
3298 static ssize_t fan_pwm1_enable_show(struct device *dev,
3299                                     struct device_attribute *attr,
3300                                     char *buf)
3301 {
3302         int res, mode;
3303   &n