?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
[PATCH] fix semaphore handling in __unregister_chrdev_region
[linux/fpc-iii.git] / drivers / acpi / ibm_acpi.c
blob0fb731a470dce94ccc1db343d2fa476dc41ca2fb
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);
Linux with added FPC-III support