[PATCH] fix semaphore handling in __unregister_chrdev_region
[linux/fpc-iii.git] / drivers / acpi / toshiba_acpi.c
blobc84997c9f9640b6b472541af060d547c92eeaba5
1 /*
2 * toshiba_acpi.c - Toshiba Laptop ACPI Extras
5 * Copyright (C) 2002-2004 John Belmonte
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.
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.
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
22 * The devolpment page for this driver is located at
23 * http://memebeam.org/toys/ToshibaAcpiDriver.
25 * Credits:
26 * Jonathan A. Buzzard - Toshiba HCI info, and critical tips on reverse
27 * engineering the Windows drivers
28 * Yasushi Nagato - changes for linux kernel 2.4 -> 2.5
29 * Rob Miller - TV out and hotkeys help
32 * TODO
36 #define TOSHIBA_ACPI_VERSION "0.18"
37 #define PROC_INTERFACE_VERSION 1
39 #include <linux/kernel.h>
40 #include <linux/module.h>
41 #include <linux/init.h>
42 #include <linux/types.h>
43 #include <linux/proc_fs.h>
44 #include <asm/uaccess.h>
46 #include <acpi/acpi_drivers.h>
48 MODULE_AUTHOR("John Belmonte");
49 MODULE_DESCRIPTION("Toshiba Laptop ACPI Extras Driver");
50 MODULE_LICENSE("GPL");
52 #define MY_LOGPREFIX "toshiba_acpi: "
53 #define MY_ERR KERN_ERR MY_LOGPREFIX
54 #define MY_NOTICE KERN_NOTICE MY_LOGPREFIX
55 #define MY_INFO KERN_INFO MY_LOGPREFIX
57 /* Toshiba ACPI method paths */
58 #define METHOD_LCD_BRIGHTNESS "\\_SB_.PCI0.VGA_.LCD_._BCM"
59 #define METHOD_HCI_1 "\\_SB_.VALD.GHCI"
60 #define METHOD_HCI_2 "\\_SB_.VALZ.GHCI"
61 #define METHOD_VIDEO_OUT "\\_SB_.VALX.DSSX"
63 /* Toshiba HCI interface definitions
65 * HCI is Toshiba's "Hardware Control Interface" which is supposed to
66 * be uniform across all their models. Ideally we would just call
67 * dedicated ACPI methods instead of using this primitive interface.
68 * However the ACPI methods seem to be incomplete in some areas (for
69 * example they allow setting, but not reading, the LCD brightness value),
70 * so this is still useful.
73 #define HCI_WORDS 6
75 /* operations */
76 #define HCI_SET 0xff00
77 #define HCI_GET 0xfe00
79 /* return codes */
80 #define HCI_SUCCESS 0x0000
81 #define HCI_FAILURE 0x1000
82 #define HCI_NOT_SUPPORTED 0x8000
83 #define HCI_EMPTY 0x8c00
85 /* registers */
86 #define HCI_FAN 0x0004
87 #define HCI_SYSTEM_EVENT 0x0016
88 #define HCI_VIDEO_OUT 0x001c
89 #define HCI_HOTKEY_EVENT 0x001e
90 #define HCI_LCD_BRIGHTNESS 0x002a
92 /* field definitions */
93 #define HCI_LCD_BRIGHTNESS_BITS 3
94 #define HCI_LCD_BRIGHTNESS_SHIFT (16-HCI_LCD_BRIGHTNESS_BITS)
95 #define HCI_LCD_BRIGHTNESS_LEVELS (1 << HCI_LCD_BRIGHTNESS_BITS)
96 #define HCI_VIDEO_OUT_LCD 0x1
97 #define HCI_VIDEO_OUT_CRT 0x2
98 #define HCI_VIDEO_OUT_TV 0x4
100 /* utility
103 static __inline__ void
104 _set_bit(u32* word, u32 mask, int value)
106 *word = (*word & ~mask) | (mask * value);
109 /* acpi interface wrappers
112 static int
113 is_valid_acpi_path(const char* methodName)
115 acpi_handle handle;
116 acpi_status status;
118 status = acpi_get_handle(NULL, (char*)methodName, &handle);
119 return !ACPI_FAILURE(status);
122 static int
123 write_acpi_int(const char* methodName, int val)
125 struct acpi_object_list params;
126 union acpi_object in_objs[1];
127 acpi_status status;
129 params.count = sizeof(in_objs)/sizeof(in_objs[0]);
130 params.pointer = in_objs;
131 in_objs[0].type = ACPI_TYPE_INTEGER;
132 in_objs[0].integer.value = val;
134 status = acpi_evaluate_object(NULL, (char*)methodName, &params, NULL);
135 return (status == AE_OK);
138 #if 0
139 static int
140 read_acpi_int(const char* methodName, int* pVal)
142 struct acpi_buffer results;
143 union acpi_object out_objs[1];
144 acpi_status status;
146 results.length = sizeof(out_objs);
147 results.pointer = out_objs;
149 status = acpi_evaluate_object(0, (char*)methodName, 0, &results);
150 *pVal = out_objs[0].integer.value;
152 return (status == AE_OK) && (out_objs[0].type == ACPI_TYPE_INTEGER);
154 #endif
156 static const char* method_hci /*= 0*/;
158 /* Perform a raw HCI call. Here we don't care about input or output buffer
159 * format.
161 static acpi_status
162 hci_raw(const u32 in[HCI_WORDS], u32 out[HCI_WORDS])
164 struct acpi_object_list params;
165 union acpi_object in_objs[HCI_WORDS];
166 struct acpi_buffer results;
167 union acpi_object out_objs[HCI_WORDS+1];
168 acpi_status status;
169 int i;
171 params.count = HCI_WORDS;
172 params.pointer = in_objs;
173 for (i = 0; i < HCI_WORDS; ++i) {
174 in_objs[i].type = ACPI_TYPE_INTEGER;
175 in_objs[i].integer.value = in[i];
178 results.length = sizeof(out_objs);
179 results.pointer = out_objs;
181 status = acpi_evaluate_object(NULL, (char*)method_hci, &params,
182 &results);
183 if ((status == AE_OK) && (out_objs->package.count <= HCI_WORDS)) {
184 for (i = 0; i < out_objs->package.count; ++i) {
185 out[i] = out_objs->package.elements[i].integer.value;
189 return status;
192 /* common hci tasks (get or set one value)
194 * In addition to the ACPI status, the HCI system returns a result which
195 * may be useful (such as "not supported").
198 static acpi_status
199 hci_write1(u32 reg, u32 in1, u32* result)
201 u32 in[HCI_WORDS] = { HCI_SET, reg, in1, 0, 0, 0 };
202 u32 out[HCI_WORDS];
203 acpi_status status = hci_raw(in, out);
204 *result = (status == AE_OK) ? out[0] : HCI_FAILURE;
205 return status;
208 static acpi_status
209 hci_read1(u32 reg, u32* out1, u32* result)
211 u32 in[HCI_WORDS] = { HCI_GET, reg, 0, 0, 0, 0 };
212 u32 out[HCI_WORDS];
213 acpi_status status = hci_raw(in, out);
214 *out1 = out[2];
215 *result = (status == AE_OK) ? out[0] : HCI_FAILURE;
216 return status;
219 static struct proc_dir_entry* toshiba_proc_dir /*= 0*/;
220 static int force_fan;
221 static int last_key_event;
222 static int key_event_valid;
224 typedef struct _ProcItem
226 const char* name;
227 char* (*read_func)(char*);
228 unsigned long (*write_func)(const char*, unsigned long);
229 } ProcItem;
231 /* proc file handlers
234 static int
235 dispatch_read(char* page, char** start, off_t off, int count, int* eof,
236 ProcItem* item)
238 char* p = page;
239 int len;
241 if (off == 0)
242 p = item->read_func(p);
244 /* ISSUE: I don't understand this code */
245 len = (p - page);
246 if (len <= off+count) *eof = 1;
247 *start = page + off;
248 len -= off;
249 if (len>count) len = count;
250 if (len<0) len = 0;
251 return len;
254 static int
255 dispatch_write(struct file* file, const char __user * buffer,
256 unsigned long count, ProcItem* item)
258 int result;
259 char* tmp_buffer;
261 /* Arg buffer points to userspace memory, which can't be accessed
262 * directly. Since we're making a copy, zero-terminate the
263 * destination so that sscanf can be used on it safely.
265 tmp_buffer = kmalloc(count + 1, GFP_KERNEL);
266 if (copy_from_user(tmp_buffer, buffer, count)) {
267 result = -EFAULT;
269 else {
270 tmp_buffer[count] = 0;
271 result = item->write_func(tmp_buffer, count);
273 kfree(tmp_buffer);
274 return result;
277 static char*
278 read_lcd(char* p)
280 u32 hci_result;
281 u32 value;
283 hci_read1(HCI_LCD_BRIGHTNESS, &value, &hci_result);
284 if (hci_result == HCI_SUCCESS) {
285 value = value >> HCI_LCD_BRIGHTNESS_SHIFT;
286 p += sprintf(p, "brightness: %d\n", value);
287 p += sprintf(p, "brightness_levels: %d\n",
288 HCI_LCD_BRIGHTNESS_LEVELS);
289 } else {
290 printk(MY_ERR "Error reading LCD brightness\n");
293 return p;
296 static unsigned long
297 write_lcd(const char* buffer, unsigned long count)
299 int value;
300 u32 hci_result;
302 if (sscanf(buffer, " brightness : %i", &value) == 1 &&
303 value >= 0 && value < HCI_LCD_BRIGHTNESS_LEVELS) {
304 value = value << HCI_LCD_BRIGHTNESS_SHIFT;
305 hci_write1(HCI_LCD_BRIGHTNESS, value, &hci_result);
306 if (hci_result != HCI_SUCCESS)
307 return -EFAULT;
308 } else {
309 return -EINVAL;
312 return count;
315 static char*
316 read_video(char* p)
318 u32 hci_result;
319 u32 value;
321 hci_read1(HCI_VIDEO_OUT, &value, &hci_result);
322 if (hci_result == HCI_SUCCESS) {
323 int is_lcd = (value & HCI_VIDEO_OUT_LCD) ? 1 : 0;
324 int is_crt = (value & HCI_VIDEO_OUT_CRT) ? 1 : 0;
325 int is_tv = (value & HCI_VIDEO_OUT_TV ) ? 1 : 0;
326 p += sprintf(p, "lcd_out: %d\n", is_lcd);
327 p += sprintf(p, "crt_out: %d\n", is_crt);
328 p += sprintf(p, "tv_out: %d\n", is_tv);
329 } else {
330 printk(MY_ERR "Error reading video out status\n");
333 return p;
336 static unsigned long
337 write_video(const char* buffer, unsigned long count)
339 int value;
340 int remain = count;
341 int lcd_out = -1;
342 int crt_out = -1;
343 int tv_out = -1;
344 u32 hci_result;
345 int video_out;
347 /* scan expression. Multiple expressions may be delimited with ;
349 * NOTE: to keep scanning simple, invalid fields are ignored
351 while (remain) {
352 if (sscanf(buffer, " lcd_out : %i", &value) == 1)
353 lcd_out = value & 1;
354 else if (sscanf(buffer, " crt_out : %i", &value) == 1)
355 crt_out = value & 1;
356 else if (sscanf(buffer, " tv_out : %i", &value) == 1)
357 tv_out = value & 1;
358 /* advance to one character past the next ; */
359 do {
360 ++buffer;
361 --remain;
363 while (remain && *(buffer-1) != ';');
366 hci_read1(HCI_VIDEO_OUT, &video_out, &hci_result);
367 if (hci_result == HCI_SUCCESS) {
368 int new_video_out = video_out;
369 if (lcd_out != -1)
370 _set_bit(&new_video_out, HCI_VIDEO_OUT_LCD, lcd_out);
371 if (crt_out != -1)
372 _set_bit(&new_video_out, HCI_VIDEO_OUT_CRT, crt_out);
373 if (tv_out != -1)
374 _set_bit(&new_video_out, HCI_VIDEO_OUT_TV, tv_out);
375 /* To avoid unnecessary video disruption, only write the new
376 * video setting if something changed. */
377 if (new_video_out != video_out)
378 write_acpi_int(METHOD_VIDEO_OUT, new_video_out);
379 } else {
380 return -EFAULT;
383 return count;
386 static char*
387 read_fan(char* p)
389 u32 hci_result;
390 u32 value;
392 hci_read1(HCI_FAN, &value, &hci_result);
393 if (hci_result == HCI_SUCCESS) {
394 p += sprintf(p, "running: %d\n", (value > 0));
395 p += sprintf(p, "force_on: %d\n", force_fan);
396 } else {
397 printk(MY_ERR "Error reading fan status\n");
400 return p;
403 static unsigned long
404 write_fan(const char* buffer, unsigned long count)
406 int value;
407 u32 hci_result;
409 if (sscanf(buffer, " force_on : %i", &value) == 1 &&
410 value >= 0 && value <= 1) {
411 hci_write1(HCI_FAN, value, &hci_result);
412 if (hci_result != HCI_SUCCESS)
413 return -EFAULT;
414 else
415 force_fan = value;
416 } else {
417 return -EINVAL;
420 return count;
423 static char*
424 read_keys(char* p)
426 u32 hci_result;
427 u32 value;
429 if (!key_event_valid) {
430 hci_read1(HCI_SYSTEM_EVENT, &value, &hci_result);
431 if (hci_result == HCI_SUCCESS) {
432 key_event_valid = 1;
433 last_key_event = value;
434 } else if (hci_result == HCI_EMPTY) {
435 /* better luck next time */
436 } else if (hci_result == HCI_NOT_SUPPORTED) {
437 /* This is a workaround for an unresolved issue on
438 * some machines where system events sporadically
439 * become disabled. */
440 hci_write1(HCI_SYSTEM_EVENT, 1, &hci_result);
441 printk(MY_NOTICE "Re-enabled hotkeys\n");
442 } else {
443 printk(MY_ERR "Error reading hotkey status\n");
444 goto end;
448 p += sprintf(p, "hotkey_ready: %d\n", key_event_valid);
449 p += sprintf(p, "hotkey: 0x%04x\n", last_key_event);
451 end:
452 return p;
455 static unsigned long
456 write_keys(const char* buffer, unsigned long count)
458 int value;
460 if (sscanf(buffer, " hotkey_ready : %i", &value) == 1 &&
461 value == 0) {
462 key_event_valid = 0;
463 } else {
464 return -EINVAL;
467 return count;
470 static char*
471 read_version(char* p)
473 p += sprintf(p, "driver: %s\n", TOSHIBA_ACPI_VERSION);
474 p += sprintf(p, "proc_interface: %d\n",
475 PROC_INTERFACE_VERSION);
476 return p;
479 /* proc and module init
482 #define PROC_TOSHIBA "toshiba"
484 static ProcItem proc_items[] =
486 { "lcd" , read_lcd , write_lcd },
487 { "video" , read_video , write_video },
488 { "fan" , read_fan , write_fan },
489 { "keys" , read_keys , write_keys },
490 { "version" , read_version , NULL },
491 { NULL }
494 static acpi_status __init
495 add_device(void)
497 struct proc_dir_entry* proc;
498 ProcItem* item;
500 for (item = proc_items; item->name; ++item)
502 proc = create_proc_read_entry(item->name,
503 S_IFREG | S_IRUGO | S_IWUSR,
504 toshiba_proc_dir, (read_proc_t*)dispatch_read, item);
505 if (proc)
506 proc->owner = THIS_MODULE;
507 if (proc && item->write_func)
508 proc->write_proc = (write_proc_t*)dispatch_write;
511 return AE_OK;
514 static acpi_status __exit
515 remove_device(void)
517 ProcItem* item;
519 for (item = proc_items; item->name; ++item)
520 remove_proc_entry(item->name, toshiba_proc_dir);
521 return AE_OK;
524 static int __init
525 toshiba_acpi_init(void)
527 acpi_status status = AE_OK;
528 u32 hci_result;
530 if (acpi_disabled)
531 return -ENODEV;
532 /* simple device detection: look for HCI method */
533 if (is_valid_acpi_path(METHOD_HCI_1))
534 method_hci = METHOD_HCI_1;
535 else if (is_valid_acpi_path(METHOD_HCI_2))
536 method_hci = METHOD_HCI_2;
537 else
538 return -ENODEV;
540 printk(MY_INFO "Toshiba Laptop ACPI Extras version %s\n",
541 TOSHIBA_ACPI_VERSION);
542 printk(MY_INFO " HCI method: %s\n", method_hci);
544 force_fan = 0;
545 key_event_valid = 0;
547 /* enable event fifo */
548 hci_write1(HCI_SYSTEM_EVENT, 1, &hci_result);
550 toshiba_proc_dir = proc_mkdir(PROC_TOSHIBA, acpi_root_dir);
551 if (!toshiba_proc_dir) {
552 status = AE_ERROR;
553 } else {
554 toshiba_proc_dir->owner = THIS_MODULE;
555 status = add_device();
556 if (ACPI_FAILURE(status))
557 remove_proc_entry(PROC_TOSHIBA, acpi_root_dir);
560 return (ACPI_SUCCESS(status)) ? 0 : -ENODEV;
563 static void __exit
564 toshiba_acpi_exit(void)
566 remove_device();
568 if (toshiba_proc_dir)
569 remove_proc_entry(PROC_TOSHIBA, acpi_root_dir);
571 return;
574 module_init(toshiba_acpi_init);
575 module_exit(toshiba_acpi_exit);