Automatic merge of /spare/repo/netdev-2.6 branch iff-running
[linux-2.6] / drivers / acpi / ibm_acpi.c
1 /*
2  *  ibm_acpi.c - IBM ThinkPad ACPI Extras
3  *
4  *
5  *  Copyright (C) 2004 Borislav Deianov
6  *
7  *  This program is free software; you can redistribute it and/or modify
8  *  it under the terms of the GNU General Public License as published by
9  *  the Free Software Foundation; either version 2 of the License, or
10  *  (at your option) any later version.
11  *
12  *  This program is distributed in the hope that it will be useful,
13  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
14  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15  *  GNU General Public License for more details.
16  *
17  *  You should have received a copy of the GNU General Public License
18  *  along with this program; if not, write to the Free Software
19  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
20  *
21  *  Changelog:
22  *
23  *  2004-08-09  0.1     initial release, support for X series
24  *  2004-08-14  0.2     support for T series, X20
25  *                      bluetooth enable/disable
26  *                      hotkey events disabled by default
27  *                      removed fan control, currently useless
28  *  2004-08-17  0.3     support for R40
29  *                      lcd off, brightness control
30  *                      thinklight on/off
31  *  2004-09-16  0.4     support for module parameters
32  *                      hotkey mask can be prefixed by 0x
33  *                      video output switching
34  *                      video expansion control
35  *                      ultrabay eject support
36  *                      removed lcd brightness/on/off control, didn't work
37  *  2004-10-18  0.5     thinklight support on A21e, G40, R32, T20, T21, X20
38  *                      proc file format changed
39  *                      video_switch command
40  *                      experimental cmos control
41  *                      experimental led control
42  *                      experimental acpi sounds
43  *  2004-10-19  0.6     use acpi_bus_register_driver() to claim HKEY device
44  *  2004-10-23  0.7     fix module loading on A21e, A22p, T20, T21, X20
45  *                      fix LED control on A21e
46  *  2004-11-08  0.8     fix init error case, don't return from a macro
47  *                              thanks to Chris Wright <chrisw@osdl.org>
48  */
49
50 #define IBM_VERSION "0.8"
51
52 #include <linux/kernel.h>
53 #include <linux/module.h>
54 #include <linux/init.h>
55 #include <linux/types.h>
56 #include <linux/proc_fs.h>
57 #include <asm/uaccess.h>
58
59 #include <acpi/acpi_drivers.h>
60 #include <acpi/acnamesp.h>
61
62 #define IBM_NAME "ibm"
63 #define IBM_DESC "IBM ThinkPad ACPI Extras"
64 #define IBM_FILE "ibm_acpi"
65 #define IBM_URL "http://ibm-acpi.sf.net/"
66
67 #define IBM_DIR IBM_NAME
68
69 #define IBM_LOG IBM_FILE ": "
70 #define IBM_ERR    KERN_ERR    IBM_LOG
71 #define IBM_NOTICE KERN_NOTICE IBM_LOG
72 #define IBM_INFO   KERN_INFO   IBM_LOG
73 #define IBM_DEBUG  KERN_DEBUG  IBM_LOG
74
75 #define IBM_MAX_ACPI_ARGS 3
76
77 #define __unused __attribute__ ((unused))
78
79 static int experimental;
80 module_param(experimental, int, 0);
81
82 static acpi_handle root_handle = NULL;
83
84 #define IBM_HANDLE(object, parent, paths...)                    \
85         static acpi_handle  object##_handle;                    \
86         static acpi_handle *object##_parent = &parent##_handle; \
87         static char        *object##_paths[] = { paths }
88
89 IBM_HANDLE(ec, root,
90            "\\_SB.PCI0.ISA.EC",    /* A21e, A22p, T20, T21, X20 */
91            "\\_SB.PCI0.LPC.EC",    /* all others */
92 );
93
94 IBM_HANDLE(vid, root, 
95            "\\_SB.PCI0.VID",       /* A21e, G40, X30, X40 */
96            "\\_SB.PCI0.AGP.VID",   /* all others */
97 );
98
99 IBM_HANDLE(cmos, root,
100            "\\UCMS",               /* R50, R50p, R51, T4x, X31, X40 */
101            "\\CMOS",               /* A3x, G40, R32, T23, T30, X22, X24, X30 */
102            "\\CMS",                /* R40, R40e */
103 );                                 /* A21e, A22p, T20, T21, X20 */
104
105 IBM_HANDLE(dock, root,
106            "\\_SB.GDCK",           /* X30, X31, X40 */
107            "\\_SB.PCI0.DOCK",      /* A22p, T20, T21, X20 */
108            "\\_SB.PCI0.PCI1.DOCK", /* all others */
109 );                                 /* A21e, G40, R32, R40, R40e */
110
111 IBM_HANDLE(bay, root,
112            "\\_SB.PCI0.IDE0.SCND.MSTR");      /* all except A21e */
113 IBM_HANDLE(bayej, root,
114            "\\_SB.PCI0.IDE0.SCND.MSTR._EJ0"); /* all except A2x, A3x */
115
116 IBM_HANDLE(lght, root, "\\LGHT");  /* A21e, A22p, T20, T21, X20 */
117 IBM_HANDLE(hkey, ec,   "HKEY");    /* all */
118 IBM_HANDLE(led,  ec,   "LED");     /* all except A21e, A22p, T20, T21, X20 */
119 IBM_HANDLE(sysl, ec,   "SYSL");    /* A21e, A22p, T20, T21, X20 */
120 IBM_HANDLE(bled, ec,   "BLED");    /* A22p, T20, T21, X20 */
121 IBM_HANDLE(beep, ec,   "BEEP");    /* all models */
122
123 struct ibm_struct {
124         char *name;
125
126         char *hid;
127         struct acpi_driver *driver;
128         
129         int  (*init)   (struct ibm_struct *);
130         int  (*read)   (struct ibm_struct *, char *);
131         int  (*write)  (struct ibm_struct *, char *);
132         void (*exit)   (struct ibm_struct *);
133
134         void (*notify) (struct ibm_struct *, u32);      
135         acpi_handle *handle;
136         int type;
137         struct acpi_device *device;
138
139         int driver_registered;
140         int proc_created;
141         int init_called;
142         int notify_installed;
143
144         int supported;
145         union {
146                 struct {
147                         int status;
148                         int mask;
149                 } hotkey;
150                 struct {
151                         int autoswitch;
152                 } video;
153         } state;
154
155         int experimental;
156 };
157
158 static struct proc_dir_entry *proc_dir = NULL;
159
160 #define onoff(status,bit) ((status) & (1 << (bit)) ? "on" : "off")
161 #define enabled(status,bit) ((status) & (1 << (bit)) ? "enabled" : "disabled")
162 #define strlencmp(a,b) (strncmp((a), (b), strlen(b)))
163
164 static int acpi_evalf(acpi_handle handle,
165                       void *res, char *method, char *fmt, ...)
166 {
167         char *fmt0 = fmt;
168         struct acpi_object_list params;
169         union acpi_object       in_objs[IBM_MAX_ACPI_ARGS];
170         struct acpi_buffer      result;
171         union acpi_object       out_obj;
172         acpi_status             status;
173         va_list                 ap;
174         char                    res_type;
175         int                     success;
176         int                     quiet;
177
178         if (!*fmt) {
179                 printk(IBM_ERR "acpi_evalf() called with empty format\n");
180                 return 0;
181         }
182
183         if (*fmt == 'q') {
184                 quiet = 1;
185                 fmt++;
186         } else
187                 quiet = 0;
188
189         res_type = *(fmt++);
190
191         params.count = 0;
192         params.pointer = &in_objs[0];
193
194         va_start(ap, fmt);
195         while (*fmt) {
196                 char c = *(fmt++);
197                 switch (c) {
198                 case 'd':       /* int */
199                         in_objs[params.count].integer.value = va_arg(ap, int);
200                         in_objs[params.count++].type = ACPI_TYPE_INTEGER;
201                         break;
202                 /* add more types as needed */
203                 default:
204                         printk(IBM_ERR "acpi_evalf() called "
205                                "with invalid format character '%c'\n", c);
206                         return 0;
207                 }
208         }
209         va_end(ap);
210
211         result.length = sizeof(out_obj);
212         result.pointer = &out_obj;
213
214         status = acpi_evaluate_object(handle, method, &params, &result);
215
216         switch (res_type) {
217         case 'd':       /* int */
218                 if (res)
219                         *(int *)res = out_obj.integer.value;
220                 success = status == AE_OK && out_obj.type == ACPI_TYPE_INTEGER;
221                 break;
222         case 'v':       /* void */
223                 success = status == AE_OK;
224                 break;
225         /* add more types as needed */
226         default:
227                 printk(IBM_ERR "acpi_evalf() called "
228                        "with invalid format character '%c'\n", res_type);
229                 return 0;
230         }
231
232         if (!success && !quiet)
233                 printk(IBM_ERR "acpi_evalf(%s, %s, ...) failed: %d\n",
234                        method, fmt0, status);
235
236         return success;
237 }
238
239 static void __unused acpi_print_int(acpi_handle handle, char *method)
240 {
241         int i;
242
243         if (acpi_evalf(handle, &i, method, "d"))
244                 printk(IBM_INFO "%s = 0x%x\n", method, i);
245         else
246                 printk(IBM_ERR "error calling %s\n", method);
247 }
248
249 static char *next_cmd(char **cmds)
250 {
251         char *start = *cmds;
252         char *end;
253
254         while ((end = strchr(start, ',')) && end == start)
255                 start = end + 1;
256
257         if (!end)
258                 return NULL;
259
260         *end = 0;
261         *cmds = end + 1;
262         return start;
263 }
264
265 static int driver_init(struct ibm_struct *ibm)
266 {
267         printk(IBM_INFO "%s v%s\n", IBM_DESC, IBM_VERSION);
268         printk(IBM_INFO "%s\n", IBM_URL);
269
270         return 0;
271 }
272
273 static int driver_read(struct ibm_struct *ibm, char *p)
274 {
275         int len = 0;
276
277         len += sprintf(p + len, "driver:\t\t%s\n", IBM_DESC);
278         len += sprintf(p + len, "version:\t%s\n", IBM_VERSION);
279
280         return len;
281 }
282
283 static int hotkey_get(struct ibm_struct *ibm, int *status, int *mask)
284 {
285         if (!acpi_evalf(hkey_handle, status, "DHKC", "d"))
286                 return -EIO;
287         if (ibm->supported) {
288                 if (!acpi_evalf(hkey_handle, mask, "DHKN", "qd"))
289                         return -EIO;
290         } else {
291                 *mask = ibm->state.hotkey.mask;
292         }
293         return 0;
294 }
295
296 static int hotkey_set(struct ibm_struct *ibm, int status, int mask)
297 {
298         int i;
299
300         if (!acpi_evalf(hkey_handle, NULL, "MHKC", "vd", status))
301                 return -EIO;
302
303         if (!ibm->supported)
304                 return 0;
305
306         for (i=0; i<32; i++) {
307                 int bit = ((1 << i) & mask) != 0;
308                 if (!acpi_evalf(hkey_handle, NULL, "MHKM", "vdd", i+1, bit))
309                         return -EIO;
310         }
311
312         return 0;
313 }
314
315 static int hotkey_init(struct ibm_struct *ibm)
316 {
317         int ret;
318
319         ibm->supported = 1;
320         ret = hotkey_get(ibm,
321                          &ibm->state.hotkey.status,
322                          &ibm->state.hotkey.mask);
323         if (ret < 0) {
324                 /* mask not supported on A21e, A22p, T20, T21, X20, X22, X24 */
325                 ibm->supported = 0;
326                 ret = hotkey_get(ibm,
327                                  &ibm->state.hotkey.status,
328                                  &ibm->state.hotkey.mask);
329         }
330
331         return ret;
332 }       
333
334 static int hotkey_read(struct ibm_struct *ibm, char *p)
335 {
336         int status, mask;
337         int len = 0;
338
339         if (hotkey_get(ibm, &status, &mask) < 0)
340                 return -EIO;
341
342         len += sprintf(p + len, "status:\t\t%s\n", enabled(status, 0));
343         if (ibm->supported) {
344                 len += sprintf(p + len, "mask:\t\t0x%04x\n", mask);
345                 len += sprintf(p + len,
346                                "commands:\tenable, disable, reset, <mask>\n");
347         } else {
348                 len += sprintf(p + len, "mask:\t\tnot supported\n");
349                 len += sprintf(p + len, "commands:\tenable, disable, reset\n");
350         }
351
352         return len;
353 }
354
355 static int hotkey_write(struct ibm_struct *ibm, char *buf)
356 {
357         int status, mask;
358         char *cmd;
359         int do_cmd = 0;
360
361         if (hotkey_get(ibm, &status, &mask) < 0)
362                 return -ENODEV;
363
364         while ((cmd = next_cmd(&buf))) {
365                 if (strlencmp(cmd, "enable") == 0) {
366                         status = 1;
367                 } else if (strlencmp(cmd, "disable") == 0) {
368                         status = 0;
369                 } else if (strlencmp(cmd, "reset") == 0) {
370                         status = ibm->state.hotkey.status;
371                         mask   = ibm->state.hotkey.mask;
372                 } else if (sscanf(cmd, "0x%x", &mask) == 1) {
373                         /* mask set */
374                 } else if (sscanf(cmd, "%x", &mask) == 1) {
375                         /* mask set */
376                 } else
377                         return -EINVAL;
378                 do_cmd = 1;
379         }
380
381         if (do_cmd && hotkey_set(ibm, status, mask) < 0)
382                 return -EIO;
383
384         return 0;
385 }       
386
387 static void hotkey_exit(struct ibm_struct *ibm)
388 {
389         hotkey_set(ibm, ibm->state.hotkey.status, ibm->state.hotkey.mask);
390 }
391
392 static void hotkey_notify(struct ibm_struct *ibm, u32 event)
393 {
394         int hkey;
395
396         if (acpi_evalf(hkey_handle, &hkey, "MHKP", "d"))
397                 acpi_bus_generate_event(ibm->device, event, hkey);
398         else {
399                 printk(IBM_ERR "unknown hotkey event %d\n", event);
400                 acpi_bus_generate_event(ibm->device, event, 0);
401         }       
402 }
403
404 static int bluetooth_init(struct ibm_struct *ibm)
405 {
406         /* bluetooth not supported on A21e, G40, T20, T21, X20 */
407         ibm->supported = acpi_evalf(hkey_handle, NULL, "GBDC", "qv");
408
409         return 0;
410 }
411
412 static int bluetooth_status(struct ibm_struct *ibm)
413 {
414         int status;
415
416         if (!ibm->supported || !acpi_evalf(hkey_handle, &status, "GBDC", "d"))
417                 status = 0;
418
419         return status;
420 }
421
422 static int bluetooth_read(struct ibm_struct *ibm, char *p)
423 {
424         int len = 0;
425         int status = bluetooth_status(ibm);
426
427         if (!ibm->supported)
428                 len += sprintf(p + len, "status:\t\tnot supported\n");
429         else if (!(status & 1))
430                 len += sprintf(p + len, "status:\t\tnot installed\n");
431         else {
432                 len += sprintf(p + len, "status:\t\t%s\n", enabled(status, 1));
433                 len += sprintf(p + len, "commands:\tenable, disable\n");
434         }
435
436         return len;
437 }
438
439 static int bluetooth_write(struct ibm_struct *ibm, char *buf)
440 {
441         int status = bluetooth_status(ibm);
442         char *cmd;
443         int do_cmd = 0;
444
445         if (!ibm->supported)
446                 return -EINVAL;
447
448         while ((cmd = next_cmd(&buf))) {
449                 if (strlencmp(cmd, "enable") == 0) {
450                         status |= 2;
451                 } else if (strlencmp(cmd, "disable") == 0) {
452                         status &= ~2;
453                 } else
454                         return -EINVAL;
455                 do_cmd = 1;
456         }
457
458         if (do_cmd && !acpi_evalf(hkey_handle, NULL, "SBDC", "vd", status))
459             return -EIO;
460
461         return 0;
462 }
463
464 static int video_init(struct ibm_struct *ibm)
465 {
466         if (!acpi_evalf(vid_handle,
467                         &ibm->state.video.autoswitch, "^VDEE", "d"))
468                 return -ENODEV;
469
470         return 0;
471 }
472
473 static int video_status(struct ibm_struct *ibm)
474 {
475         int status = 0;
476         int i;
477
478         acpi_evalf(NULL, NULL, "\\VUPS", "vd", 1);
479         if (acpi_evalf(NULL, &i, "\\VCDC", "d"))
480                 status |= 0x02 * i;
481
482         acpi_evalf(NULL, NULL, "\\VUPS", "vd", 0);
483         if (acpi_evalf(NULL, &i, "\\VCDL", "d"))
484                 status |= 0x01 * i;
485         if (acpi_evalf(NULL, &i, "\\VCDD", "d"))
486                 status |= 0x08 * i;
487
488         if (acpi_evalf(vid_handle, &i, "^VDEE", "d"))
489                 status |= 0x10 * (i & 1);
490
491         return status;
492 }
493
494 static int video_read(struct ibm_struct *ibm, char *p)
495 {
496         int status = video_status(ibm);
497         int len = 0;
498
499         len += sprintf(p + len, "lcd:\t\t%s\n", enabled(status, 0));
500         len += sprintf(p + len, "crt:\t\t%s\n", enabled(status, 1));
501         len += sprintf(p + len, "dvi:\t\t%s\n", enabled(status, 3));
502         len += sprintf(p + len, "auto:\t\t%s\n", enabled(status, 4));
503         len += sprintf(p + len, "commands:\tlcd_enable, lcd_disable, "
504                        "crt_enable, crt_disable\n");
505         len += sprintf(p + len, "commands:\tdvi_enable, dvi_disable, "
506                        "auto_enable, auto_disable\n");
507         len += sprintf(p + len, "commands:\tvideo_switch, expand_toggle\n");
508
509         return len;
510 }
511
512 static int video_write(struct ibm_struct *ibm, char *buf)
513 {
514         char *cmd;
515         int enable, disable, status;
516
517         enable = disable = 0;
518
519         while ((cmd = next_cmd(&buf))) {
520                 if (strlencmp(cmd, "lcd_enable") == 0) {
521                         enable |= 0x01;
522                 } else if (strlencmp(cmd, "lcd_disable") == 0) {
523                         disable |= 0x01;
524                 } else if (strlencmp(cmd, "crt_enable") == 0) {
525                         enable |= 0x02;
526                 } else if (strlencmp(cmd, "crt_disable") == 0) {
527                         disable |= 0x02;
528                 } else if (strlencmp(cmd, "dvi_enable") == 0) {
529                         enable |= 0x08;
530                 } else if (strlencmp(cmd, "dvi_disable") == 0) {
531                         disable |= 0x08;
532                 } else if (strlencmp(cmd, "auto_enable") == 0) {
533                         if (!acpi_evalf(vid_handle, NULL, "_DOS", "vd", 1))
534                                 return -EIO;
535                 } else if (strlencmp(cmd, "auto_disable") == 0) {
536                         if (!acpi_evalf(vid_handle, NULL, "_DOS", "vd", 0))
537                                 return -EIO;
538                 } else if (strlencmp(cmd, "video_switch") == 0) {
539                         int autoswitch;
540                         if (!acpi_evalf(vid_handle, &autoswitch, "^VDEE", "d"))
541                                 return -EIO;
542                         if (!acpi_evalf(vid_handle, NULL, "_DOS", "vd", 1))
543                                 return -EIO;
544                         if (!acpi_evalf(vid_handle, NULL, "VSWT", "v"))
545                                 return -EIO;
546                         if (!acpi_evalf(vid_handle, NULL, "_DOS", "vd",
547                                         autoswitch))
548                                 return -EIO;
549                 } else if (strlencmp(cmd, "expand_toggle") == 0) {
550                         if (!acpi_evalf(NULL, NULL, "\\VEXP", "v"))
551                                 return -EIO;
552                 } else
553                         return -EINVAL;
554         }
555
556         if (enable || disable) {
557                 status = (video_status(ibm) & 0x0f & ~disable) | enable;
558                 if (!acpi_evalf(NULL, NULL, "\\VUPS", "vd", 0x80))
559                         return -EIO;
560                 if (!acpi_evalf(NULL, NULL, "\\VSDS", "vdd", status, 1))
561                         return -EIO;
562         }
563
564         return 0;
565 }
566
567 static void video_exit(struct ibm_struct *ibm)
568 {
569         acpi_evalf(vid_handle, NULL, "_DOS", "vd",
570                    ibm->state.video.autoswitch);
571 }
572
573 static int light_init(struct ibm_struct *ibm)
574 {
575         /* kblt not supported on G40, R32, X20 */
576         ibm->supported = acpi_evalf(ec_handle, NULL, "KBLT", "qv");
577
578         return 0;
579 }
580
581 static int light_read(struct ibm_struct *ibm, char *p)
582 {
583         int len = 0;
584         int status = 0;
585
586         if (ibm->supported) {
587                 if (!acpi_evalf(ec_handle, &status, "KBLT", "d"))
588                         return -EIO;
589                 len += sprintf(p + len, "status:\t\t%s\n", onoff(status, 0));
590         } else
591                 len += sprintf(p + len, "status:\t\tunknown\n");
592
593         len += sprintf(p + len, "commands:\ton, off\n");
594
595         return len;
596 }
597
598 static int light_write(struct ibm_struct *ibm, char *buf)
599 {
600         int cmos_cmd, lght_cmd;
601         char *cmd;
602         int success;
603         
604         while ((cmd = next_cmd(&buf))) {
605                 if (strlencmp(cmd, "on") == 0) {
606                         cmos_cmd = 0x0c;
607                         lght_cmd = 1;
608                 } else if (strlencmp(cmd, "off") == 0) {
609                         cmos_cmd = 0x0d;
610                         lght_cmd = 0;
611                 } else
612                         return -EINVAL;
613                 
614                 success = cmos_handle ?
615                         acpi_evalf(cmos_handle, NULL, NULL, "vd", cmos_cmd) :
616                         acpi_evalf(lght_handle, NULL, NULL, "vd", lght_cmd);
617                 if (!success)
618                         return -EIO;
619         }
620
621         return 0;
622 }
623
624 static int _sta(acpi_handle handle)
625 {
626         int status;
627
628         if (!handle || !acpi_evalf(handle, &status, "_STA", "d"))
629                 status = 0;
630
631         return status;
632 }
633
634 #define dock_docked() (_sta(dock_handle) & 1)
635
636 static int dock_read(struct ibm_struct *ibm, char *p)
637 {
638         int len = 0;
639         int docked = dock_docked();
640
641         if (!dock_handle)
642                 len += sprintf(p + len, "status:\t\tnot supported\n");
643         else if (!docked)
644                 len += sprintf(p + len, "status:\t\tundocked\n");
645         else {
646                 len += sprintf(p + len, "status:\t\tdocked\n");
647                 len += sprintf(p + len, "commands:\tdock, undock\n");
648         }
649
650         return len;
651 }
652
653 static int dock_write(struct ibm_struct *ibm, char *buf)
654 {
655         char *cmd;
656
657         if (!dock_docked())
658                 return -EINVAL;
659
660         while ((cmd = next_cmd(&buf))) {
661                 if (strlencmp(cmd, "undock") == 0) {
662                         if (!acpi_evalf(dock_handle, NULL, "_DCK", "vd", 0))
663                                 return -EIO;
664                         if (!acpi_evalf(dock_handle, NULL, "_EJ0", "vd", 1))
665                                 return -EIO;
666                 } else if (strlencmp(cmd, "dock") == 0) {
667                         if (!acpi_evalf(dock_handle, NULL, "_DCK", "vd", 1))
668                                 return -EIO;
669                 } else
670                         return -EINVAL;
671         }
672
673         return 0;
674 }       
675
676 static void dock_notify(struct ibm_struct *ibm, u32 event)
677 {
678         int docked = dock_docked();
679
680         if (event == 3 && docked)
681                 acpi_bus_generate_event(ibm->device, event, 1); /* button */
682         else if (event == 3 && !docked)
683                 acpi_bus_generate_event(ibm->device, event, 2); /* undock */
684         else if (event == 0 && docked)
685                 acpi_bus_generate_event(ibm->device, event, 3); /* dock */
686         else {
687                 printk(IBM_ERR "unknown dock event %d, status %d\n",
688                        event, _sta(dock_handle));
689                 acpi_bus_generate_event(ibm->device, event, 0); /* unknown */
690         }
691 }
692
693 #define bay_occupied() (_sta(bay_handle) & 1)
694
695 static int bay_init(struct ibm_struct *ibm)
696 {
697         /* bay not supported on A21e, A22p, A31, A31p, G40, R32, R40e */
698         ibm->supported = bay_handle && bayej_handle &&
699                 acpi_evalf(bay_handle, NULL, "_STA", "qv");
700
701         return 0;
702 }
703
704 static int bay_read(struct ibm_struct *ibm, char *p)
705 {
706         int len = 0;
707         int occupied = bay_occupied();
708         
709         if (!ibm->supported)
710                 len += sprintf(p + len, "status:\t\tnot supported\n");
711         else if (!occupied)
712                 len += sprintf(p + len, "status:\t\tunoccupied\n");
713         else {
714                 len += sprintf(p + len, "status:\t\toccupied\n");
715                 len += sprintf(p + len, "commands:\teject\n");
716         }
717
718         return len;
719 }
720
721 static int bay_write(struct ibm_struct *ibm, char *buf)
722 {
723         char *cmd;
724
725         while ((cmd = next_cmd(&buf))) {
726                 if (strlencmp(cmd, "eject") == 0) {
727                         if (!ibm->supported ||
728                             !acpi_evalf(bay_handle, NULL, "_EJ0", "vd", 1))
729                                 return -EIO;
730                 } else
731                         return -EINVAL;
732         }
733
734         return 0;
735 }       
736
737 static void bay_notify(struct ibm_struct *ibm, u32 event)
738 {
739         acpi_bus_generate_event(ibm->device, event, 0);
740 }
741
742 static int cmos_read(struct ibm_struct *ibm, char *p)
743 {
744         int len = 0;
745
746         /* cmos not supported on A21e, A22p, T20, T21, X20 */
747         if (!cmos_handle)
748                 len += sprintf(p + len, "status:\t\tnot supported\n");
749         else {
750                 len += sprintf(p + len, "status:\t\tsupported\n");
751                 len += sprintf(p + len, "commands:\t<int>\n");
752         }
753
754         return len;
755 }
756
757 static int cmos_write(struct ibm_struct *ibm, char *buf)
758 {
759         char *cmd;
760         int cmos_cmd;
761
762         if (!cmos_handle)
763                 return -EINVAL;
764
765         while ((cmd = next_cmd(&buf))) {
766                 if (sscanf(cmd, "%u", &cmos_cmd) == 1) {
767                         /* cmos_cmd set */
768                 } else
769                         return -EINVAL;
770
771                 if (!acpi_evalf(cmos_handle, NULL, NULL, "vd", cmos_cmd))
772                         return -EIO;
773         }
774
775         return 0;
776 }       
777                 
778 static int led_read(struct ibm_struct *ibm, char *p)
779 {
780         int len = 0;
781
782         len += sprintf(p + len, "commands:\t"
783                        "<int> on, <int> off, <int> blink\n");
784
785         return len;
786 }
787
788 static int led_write(struct ibm_struct *ibm, char *buf)
789 {
790         char *cmd;
791         unsigned int led;
792         int led_cmd, sysl_cmd, bled_a, bled_b;
793
794         while ((cmd = next_cmd(&buf))) {
795                 if (sscanf(cmd, "%u", &led) != 1)
796                         return -EINVAL;
797
798                 if (strstr(cmd, "blink")) {
799                         led_cmd = 0xc0;
800                         sysl_cmd = 2;
801                         bled_a = 2;
802                         bled_b = 1;
803                 } else if (strstr(cmd, "on")) {
804                         led_cmd = 0x80;
805                         sysl_cmd = 1;
806                         bled_a = 2;
807                         bled_b = 0;
808                 } else if (strstr(cmd, "off")) {
809                         led_cmd = sysl_cmd = bled_a = bled_b = 0;
810                 } else
811                         return -EINVAL;
812                 
813                 if (led_handle) {
814                         if (!acpi_evalf(led_handle, NULL, NULL, "vdd",
815                                         led, led_cmd))
816                                 return -EIO;
817                 } else if (led < 2) {
818                         if (acpi_evalf(sysl_handle, NULL, NULL, "vdd",
819                                        led, sysl_cmd))
820                                 return -EIO;
821                 } else if (led == 2 && bled_handle) {
822                         if (acpi_evalf(bled_handle, NULL, NULL, "vdd",
823                                        bled_a, bled_b))
824                                 return -EIO;
825                 } else
826                         return -EINVAL;
827         }
828
829         return 0;
830 }       
831                 
832 static int beep_read(struct ibm_struct *ibm, char *p)
833 {
834         int len = 0;
835
836         len += sprintf(p + len, "commands:\t<int>\n");
837
838         return len;
839 }
840
841 static int beep_write(struct ibm_struct *ibm, char *buf)
842 {
843         char *cmd;
844         int beep_cmd;
845
846         while ((cmd = next_cmd(&buf))) {
847                 if (sscanf(cmd, "%u", &beep_cmd) == 1) {
848                         /* beep_cmd set */
849                 } else
850                         return -EINVAL;
851
852                 if (!acpi_evalf(beep_handle, NULL, NULL, "vd", beep_cmd))
853                         return -EIO;
854         }
855
856         return 0;
857 }       
858                 
859 static struct ibm_struct ibms[] = {
860         {
861                 .name   = "driver",
862                 .init   = driver_init,
863                 .read   = driver_read,
864         },
865         {
866                 .name   = "hotkey",
867                 .hid    = "IBM0068",
868                 .init   = hotkey_init,
869                 .read   = hotkey_read,
870                 .write  = hotkey_write,
871                 .exit   = hotkey_exit,
872                 .notify = hotkey_notify,
873                 .handle = &hkey_handle,
874                 .type   = ACPI_DEVICE_NOTIFY,
875         },
876         {
877                 .name   = "bluetooth",
878                 .init   = bluetooth_init,
879                 .read   = bluetooth_read,
880                 .write  = bluetooth_write,
881         },
882         {
883                 .name   = "video",
884                 .init   = video_init,
885                 .read   = video_read,
886                 .write  = video_write,
887                 .exit   = video_exit,
888         },
889         {
890                 .name   = "light",
891                 .init   = light_init,
892                 .read   = light_read,
893                 .write  = light_write,
894         },
895         {
896                 .name   = "dock",
897                 .read   = dock_read,
898                 .write  = dock_write,
899                 .notify = dock_notify,
900                 .handle = &dock_handle,
901                 .type   = ACPI_SYSTEM_NOTIFY,
902         },
903         {
904                 .name   = "bay",
905                 .init   = bay_init,
906                 .read   = bay_read,
907                 .write  = bay_write,
908                 .notify = bay_notify,
909                 .handle = &bay_handle,
910                 .type   = ACPI_SYSTEM_NOTIFY,
911         },
912         {
913                 .name   = "cmos",
914                 .read   = cmos_read,
915                 .write  = cmos_write,
916                 .experimental = 1,
917         },
918         {
919                 .name   = "led",
920                 .read   = led_read,
921                 .write  = led_write,
922                 .experimental = 1,
923         },
924         {
925                 .name   = "beep",
926                 .read   = beep_read,
927                 .write  = beep_write,
928                 .experimental = 1,
929         },
930 };
931 #define NUM_IBMS (sizeof(ibms)/sizeof(ibms[0]))
932
933 static int dispatch_read(char *page, char **start, off_t off, int count,
934                          int *eof, void *data)
935 {
936         struct ibm_struct *ibm = (struct ibm_struct *)data;
937         int len;
938         
939         if (!ibm || !ibm->read)
940                 return -EINVAL;
941
942         len = ibm->read(ibm, page);
943         if (len < 0)
944                 return len;
945
946         if (len <= off + count)
947                 *eof = 1;
948         *start = page + off;
949         len -= off;
950         if (len > count)
951                 len = count;
952         if (len < 0)
953                 len = 0;
954
955         return len;
956 }
957
958 static int dispatch_write(struct file *file, const char __user *userbuf,
959                           unsigned long count, void *data)
960 {
961         struct ibm_struct *ibm = (struct ibm_struct *)data;
962         char *kernbuf;
963         int ret;
964
965         if (!ibm || !ibm->write)
966                 return -EINVAL;
967
968         kernbuf = kmalloc(count + 2, GFP_KERNEL);
969         if (!kernbuf)
970                 return -ENOMEM;
971
972         if (copy_from_user(kernbuf, userbuf, count)) {
973                 kfree(kernbuf);
974                 return -EFAULT;
975         }
976
977         kernbuf[count] = 0;
978         strcat(kernbuf, ",");
979         ret = ibm->write(ibm, kernbuf);
980         if (ret == 0)
981                 ret = count;
982
983         kfree(kernbuf);
984
985         return ret;
986 }
987
988 static void dispatch_notify(acpi_handle handle, u32 event, void *data)
989 {
990         struct ibm_struct *ibm = (struct ibm_struct *)data;
991
992         if (!ibm || !ibm->notify)
993                 return;
994
995         ibm->notify(ibm, event);
996 }
997
998 static int setup_notify(struct ibm_struct *ibm)
999 {
1000         acpi_status status;
1001         int ret;
1002
1003         if (!*ibm->handle)
1004                 return 0;
1005
1006         ret = acpi_bus_get_device(*ibm->handle, &ibm->device);
1007         if (ret < 0) {
1008                 printk(IBM_ERR "%s device not present\n", ibm->name);
1009                 return 0;
1010         }
1011
1012         acpi_driver_data(ibm->device) = ibm;
1013         sprintf(acpi_device_class(ibm->device), "%s/%s", IBM_NAME, ibm->name);
1014
1015         status = acpi_install_notify_handler(*ibm->handle, ibm->type,
1016                                              dispatch_notify, ibm);
1017         if (ACPI_FAILURE(status)) {
1018                 printk(IBM_ERR "acpi_install_notify_handler(%s) failed: %d\n",
1019                        ibm->name, status);
1020                 return -ENODEV;
1021         }
1022
1023         ibm->notify_installed = 1;
1024
1025         return 0;
1026 }
1027
1028 static int device_add(struct acpi_device *device)
1029 {
1030         return 0;
1031 }
1032
1033 static int register_driver(struct ibm_struct *ibm)
1034 {
1035         int ret;
1036
1037         ibm->driver = kmalloc(sizeof(struct acpi_driver), GFP_KERNEL);
1038         if (!ibm->driver) {
1039                 printk(IBM_ERR "kmalloc(ibm->driver) failed\n");
1040                 return -1;
1041         }
1042
1043         memset(ibm->driver, 0, sizeof(struct acpi_driver));
1044         sprintf(ibm->driver->name, "%s/%s", IBM_NAME, ibm->name);
1045         ibm->driver->ids = ibm->hid;
1046         ibm->driver->ops.add = &device_add;
1047
1048         ret = acpi_bus_register_driver(ibm->driver);
1049         if (ret < 0) {
1050                 printk(IBM_ERR "acpi_bus_register_driver(%s) failed: %d\n",
1051                        ibm->hid, ret);
1052                 kfree(ibm->driver);
1053         }
1054
1055         return ret;
1056 }
1057
1058 static int ibm_init(struct ibm_struct *ibm)
1059 {
1060         int ret;
1061         struct proc_dir_entry *entry;
1062
1063         if (ibm->experimental && !experimental)
1064                 return 0;
1065
1066         if (ibm->hid) {
1067                 ret = register_driver(ibm);
1068                 if (ret < 0)
1069                         return ret;
1070                 ibm->driver_registered = 1;
1071         }
1072
1073         if (ibm->init) {
1074                 ret = ibm->init(ibm);
1075                 if (ret != 0)
1076                         return ret;
1077                 ibm->init_called = 1;
1078         }
1079
1080         entry = create_proc_entry(ibm->name, S_IFREG | S_IRUGO | S_IWUSR,
1081                                   proc_dir);
1082         if (!entry) {
1083                 printk(IBM_ERR "unable to create proc entry %s\n", ibm->name);
1084                 return -ENODEV;
1085         }
1086         entry->owner = THIS_MODULE;
1087         ibm->proc_created = 1;
1088         
1089         entry->data = ibm;
1090         if (ibm->read)
1091                 entry->read_proc = &dispatch_read;
1092         if (ibm->write)
1093                 entry->write_proc = &dispatch_write;
1094
1095         if (ibm->notify) {
1096                 ret = setup_notify(ibm);
1097                 if (ret < 0)
1098                         return ret;
1099         }
1100
1101         return 0;
1102 }
1103
1104 static void ibm_exit(struct ibm_struct *ibm)
1105 {
1106         if (ibm->notify_installed)
1107                 acpi_remove_notify_handler(*ibm->handle, ibm->type,
1108                                            dispatch_notify);
1109
1110         if (ibm->proc_created)
1111                 remove_proc_entry(ibm->name, proc_dir);
1112
1113         if (ibm->init_called && ibm->exit)
1114                 ibm->exit(ibm);
1115
1116         if (ibm->driver_registered) {
1117                 acpi_bus_unregister_driver(ibm->driver);
1118                 kfree(ibm->driver);
1119         }
1120 }
1121
1122 static int ibm_handle_init(char *name,
1123                            acpi_handle *handle, acpi_handle parent,
1124                            char **paths, int num_paths, int required)
1125 {
1126         int i;
1127         acpi_status status;
1128
1129         for (i=0; i<num_paths; i++) {
1130                 status = acpi_get_handle(parent, paths[i], handle);
1131                 if (ACPI_SUCCESS(status))
1132                         return 0;
1133         }
1134         
1135         *handle = NULL;
1136
1137         if (required) {
1138                 printk(IBM_ERR "%s object not found\n", name);
1139                 return -1;
1140         }
1141
1142         return 0;
1143 }
1144
1145 #define IBM_HANDLE_INIT(object, required)                               \
1146         ibm_handle_init(#object, &object##_handle, *object##_parent,    \
1147                 object##_paths, sizeof(object##_paths)/sizeof(char*), required)
1148
1149
1150 static int set_ibm_param(const char *val, struct kernel_param *kp)
1151 {
1152         unsigned int i;
1153         char arg_with_comma[32];
1154
1155         if (strlen(val) > 30)
1156                 return -ENOSPC;
1157
1158         strcpy(arg_with_comma, val);
1159         strcat(arg_with_comma, ",");
1160
1161         for (i=0; i<NUM_IBMS; i++)
1162                 if (strcmp(ibms[i].name, kp->name) == 0)
1163                         return ibms[i].write(&ibms[i], arg_with_comma);
1164         BUG();
1165         return -EINVAL;
1166 }
1167
1168 #define IBM_PARAM(feature) \
1169         module_param_call(feature, set_ibm_param, NULL, NULL, 0)
1170
1171 static void acpi_ibm_exit(void)
1172 {
1173         int i;
1174
1175         for (i=NUM_IBMS-1; i>=0; i--)
1176                 ibm_exit(&ibms[i]);
1177
1178         remove_proc_entry(IBM_DIR, acpi_root_dir);
1179 }
1180
1181 static int __init acpi_ibm_init(void)
1182 {
1183         int ret, i;
1184
1185         if (acpi_disabled)
1186                 return -ENODEV;
1187
1188         /* these handles are required */
1189         if (IBM_HANDLE_INIT(ec,   1) < 0 ||
1190             IBM_HANDLE_INIT(hkey, 1) < 0 ||
1191             IBM_HANDLE_INIT(vid,  1) < 0 ||
1192             IBM_HANDLE_INIT(beep, 1) < 0)
1193                 return -ENODEV;
1194
1195         /* these handles have alternatives */
1196         IBM_HANDLE_INIT(lght, 0);
1197         if (IBM_HANDLE_INIT(cmos, !lght_handle) < 0)
1198                 return -ENODEV;
1199         IBM_HANDLE_INIT(sysl, 0);
1200         if (IBM_HANDLE_INIT(led, !sysl_handle) < 0)
1201                 return -ENODEV;
1202
1203         /* these handles are not required */
1204         IBM_HANDLE_INIT(dock,  0);
1205         IBM_HANDLE_INIT(bay,   0);
1206         IBM_HANDLE_INIT(bayej, 0);
1207         IBM_HANDLE_INIT(bled,  0);
1208
1209         proc_dir = proc_mkdir(IBM_DIR, acpi_root_dir);
1210         if (!proc_dir) {
1211                 printk(IBM_ERR "unable to create proc dir %s", IBM_DIR);
1212                 return -ENODEV;
1213         }
1214         proc_dir->owner = THIS_MODULE;
1215         
1216         for (i=0; i<NUM_IBMS; i++) {
1217                 ret = ibm_init(&ibms[i]);
1218                 if (ret < 0) {
1219                         acpi_ibm_exit();
1220                         return ret;
1221                 }
1222         }
1223
1224         return 0;
1225 }
1226
1227 module_init(acpi_ibm_init);
1228 module_exit(acpi_ibm_exit);
1229
1230 MODULE_AUTHOR("Borislav Deianov");
1231 MODULE_DESCRIPTION(IBM_DESC);
1232 MODULE_LICENSE("GPL");
1233
1234 IBM_PARAM(hotkey);
1235 IBM_PARAM(bluetooth);
1236 IBM_PARAM(video);
1237 IBM_PARAM(light);
1238 IBM_PARAM(dock);
1239 IBM_PARAM(bay);
1240 IBM_PARAM(cmos);
1241 IBM_PARAM(led);
1242 IBM_PARAM(beep);