?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Staging: poch: Rx control register init
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / misc / panasonic-laptop.c
blob4a1bc64485d5a61523a2eaee5975555c843ac859
1 /*
2 * Panasonic HotKey and LCD brightness control driver
3 * (C) 2004 Hiroshi Miura <miura@da-cha.org>
4 * (C) 2004 NTT DATA Intellilink Co. http://www.intellilink.co.jp/
5 * (C) YOKOTA Hiroshi <yokota (at) netlab. is. tsukuba. ac. jp>
6 * (C) 2004 David Bronaugh <dbronaugh>
7 * (C) 2006-2008 Harald Welte <laforge@gnumonks.org>
8 *
9 * derived from toshiba_acpi.c, Copyright (C) 2002-2004 John Belmonte
10 *
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License version 2 as
13 * publicshed by the Free Software Foundation.
14 *
15 * This program is distributed in the hope that it will be useful,
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
19 *
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
23 *
24 *---------------------------------------------------------------------------
25 *
26 * ChangeLog:
27 * Sep.23, 2008 Harald Welte <laforge@gnumonks.org>
28 * -v0.95 rename driver from drivers/acpi/pcc_acpi.c to
29 * drivers/misc/panasonic-laptop.c
30 *
31 * Jul.04, 2008 Harald Welte <laforge@gnumonks.org>
32 * -v0.94 replace /proc interface with device attributes
33 * support {set,get}keycode on th input device
34 *
35 * Jun.27, 2008 Harald Welte <laforge@gnumonks.org>
36 * -v0.92 merge with 2.6.26-rc6 input API changes
37 * remove broken <= 2.6.15 kernel support
38 * resolve all compiler warnings
39 * various coding style fixes (checkpatch.pl)
40 * add support for backlight api
41 * major code restructuring
42 *
43 * Dac.28, 2007 Harald Welte <laforge@gnumonks.org>
44 * -v0.91 merge with 2.6.24-rc6 ACPI changes
45 *
46 * Nov.04, 2006 Hiroshi Miura <miura@da-cha.org>
47 * -v0.9 remove warning about section reference.
48 * remove acpi_os_free
49 * add /proc/acpi/pcc/brightness interface for HAL access
50 * merge dbronaugh's enhancement
51 * Aug.17, 2004 David Bronaugh (dbronaugh)
52 * - Added screen brightness setting interface
53 * Thanks to FreeBSD crew (acpi_panasonic.c)
54 * for the ideas I needed to accomplish it
55 *
56 * May.29, 2006 Hiroshi Miura <miura@da-cha.org>
57 * -v0.8.4 follow to change keyinput structure
58 * thanks Fabian Yamaguchi <fabs@cs.tu-berlin.de>,
59 * Jacob Bower <jacob.bower@ic.ac.uk> and
60 * Hiroshi Yokota for providing solutions.
61 *
62 * Oct.02, 2004 Hiroshi Miura <miura@da-cha.org>
63 * -v0.8.2 merge code of YOKOTA Hiroshi
64 * <yokota@netlab.is.tsukuba.ac.jp>.
65 * Add sticky key mode interface.
66 * Refactoring acpi_pcc_generate_keyinput().
67 *
68 * Sep.15, 2004 Hiroshi Miura <miura@da-cha.org>
69 * -v0.8 Generate key input event on input subsystem.
70 * This is based on yet another driver written by
71 * Ryuta Nakanishi.
72 *
73 * Sep.10, 2004 Hiroshi Miura <miura@da-cha.org>
74 * -v0.7 Change proc interface functions using seq_file
75 * facility as same as other ACPI drivers.
76 *
77 * Aug.28, 2004 Hiroshi Miura <miura@da-cha.org>
78 * -v0.6.4 Fix a silly error with status checking
79 *
80 * Aug.25, 2004 Hiroshi Miura <miura@da-cha.org>
81 * -v0.6.3 replace read_acpi_int by standard function
82 * acpi_evaluate_integer
83 * some clean up and make smart copyright notice.
84 * fix return value of pcc_acpi_get_key()
85 * fix checking return value of acpi_bus_register_driver()
86 *
87 * Aug.22, 2004 David Bronaugh <dbronaugh@linuxboxen.org>
88 * -v0.6.2 Add check on ACPI data (num_sifr)
89 * Coding style cleanups, better error messages/handling
90 * Fixed an off-by-one error in memory allocation
91 *
92 * Aug.21, 2004 David Bronaugh <dbronaugh@linuxboxen.org>
93 * -v0.6.1 Fix a silly error with status checking
94 *
95 * Aug.20, 2004 David Bronaugh <dbronaugh@linuxboxen.org>
96 * - v0.6 Correct brightness controls to reflect reality
97 * based on information gleaned by Hiroshi Miura
98 * and discussions with Hiroshi Miura
99 *
100 * Aug.10, 2004 Hiroshi Miura <miura@da-cha.org>
101 * - v0.5 support LCD brightness control
102 * based on the disclosed information by MEI.
103 *
104 * Jul.25, 2004 Hiroshi Miura <miura@da-cha.org>
105 * - v0.4 first post version
106 * add function to retrive SIFR
107 *
108 * Jul.24, 2004 Hiroshi Miura <miura@da-cha.org>
109 * - v0.3 get proper status of hotkey
110 *
111 * Jul.22, 2004 Hiroshi Miura <miura@da-cha.org>
112 * - v0.2 add HotKey handler
113 *
114 * Jul.17, 2004 Hiroshi Miura <miura@da-cha.org>
115 * - v0.1 start from toshiba_acpi driver written by John Belmonte
116 *
117 */
118
119 #include <linux/kernel.h>
120 #include <linux/module.h>
121 #include <linux/init.h>
122 #include <linux/types.h>
123 #include <linux/backlight.h>
124 #include <linux/ctype.h>
125 #include <linux/seq_file.h>
126 #include <linux/uaccess.h>
127 #include <acpi/acpi_bus.h>
128 #include <acpi/acpi_drivers.h>
129 #include <linux/input.h>
130
131
132 #ifndef ACPI_HOTKEY_COMPONENT
133 #define ACPI_HOTKEY_COMPONENT 0x10000000
134 #endif
135
136 #define _COMPONENT ACPI_HOTKEY_COMPONENT
137
138 MODULE_AUTHOR("Hiroshi Miura, David Bronaugh and Harald Welte");
139 MODULE_DESCRIPTION("ACPI HotKey driver for Panasonic Let's Note laptops");
140 MODULE_LICENSE("GPL");
141
142 #define LOGPREFIX "pcc_acpi: "
143
144 /* Define ACPI PATHs */
145 /* Lets note hotkeys */
146 #define METHOD_HKEY_QUERY "HINF"
147 #define METHOD_HKEY_SQTY "SQTY"
148 #define METHOD_HKEY_SINF "SINF"
149 #define METHOD_HKEY_SSET "SSET"
150 #define HKEY_NOTIFY 0x80
151
152 #define ACPI_PCC_DRIVER_NAME "Panasonic Laptop Support"
153 #define ACPI_PCC_DEVICE_NAME "Hotkey"
154 #define ACPI_PCC_CLASS "pcc"
155
156 #define ACPI_PCC_INPUT_PHYS "panasonic/hkey0"
157
158 /* LCD_TYPEs: 0 = Normal, 1 = Semi-transparent
159 ENV_STATEs: Normal temp=0x01, High temp=0x81, N/A=0x00
160 */
161 enum SINF_BITS { SINF_NUM_BATTERIES = 0,
162 SINF_LCD_TYPE,
163 SINF_AC_MAX_BRIGHT,
164 SINF_AC_MIN_BRIGHT,
165 SINF_AC_CUR_BRIGHT,
166 SINF_DC_MAX_BRIGHT,
167 SINF_DC_MIN_BRIGHT,
168 SINF_DC_CUR_BRIGHT,
169 SINF_MUTE,
170 SINF_RESERVED,
171 SINF_ENV_STATE,
172 SINF_STICKY_KEY = 0x80,
173 };
174 /* R1 handles SINF_AC_CUR_BRIGHT as SINF_CUR_BRIGHT, doesn't know AC state */
175
176 static int acpi_pcc_hotkey_add(struct acpi_device *device);
177 static int acpi_pcc_hotkey_remove(struct acpi_device *device, int type);
178 static int acpi_pcc_hotkey_resume(struct acpi_device *device);
179
180 static const struct acpi_device_id pcc_device_ids[] = {
181 { "MAT0012", 0},
182 { "MAT0013", 0},
183 { "MAT0018", 0},
184 { "MAT0019", 0},
185 { "", 0},
186 };
187
188 static struct acpi_driver acpi_pcc_driver = {
189 .name = ACPI_PCC_DRIVER_NAME,
190 .class = ACPI_PCC_CLASS,
191 .ids = pcc_device_ids,
192 .ops = {
193 .add = acpi_pcc_hotkey_add,
194 .remove = acpi_pcc_hotkey_remove,
195 .resume = acpi_pcc_hotkey_resume,
196 },
197 };
198
199 #define KEYMAP_SIZE 11
200 static const int initial_keymap[KEYMAP_SIZE] = {
201 /* 0 */ KEY_RESERVED,
202 /* 1 */ KEY_BRIGHTNESSDOWN,
203 /* 2 */ KEY_BRIGHTNESSUP,
204 /* 3 */ KEY_DISPLAYTOGGLE,
205 /* 4 */ KEY_MUTE,
206 /* 5 */ KEY_VOLUMEDOWN,
207 /* 6 */ KEY_VOLUMEUP,
208 /* 7 */ KEY_SLEEP,
209 /* 8 */ KEY_PROG1, /* Change CPU boost */
210 /* 9 */ KEY_BATTERY,
211 /* 10 */ KEY_SUSPEND,
212 };
213
214 struct pcc_acpi {
215 acpi_handle handle;
216 unsigned long num_sifr;
217 int sticky_mode;
218 u32 *sinf;
219 struct acpi_device *device;
220 struct input_dev *input_dev;
221 struct backlight_device *backlight;
222 int keymap[KEYMAP_SIZE];
223 };
224
225 struct pcc_keyinput {
226 struct acpi_hotkey *hotkey;
227 };
228
229 /* method access functions */
230 static int acpi_pcc_write_sset(struct pcc_acpi *pcc, int func, int val)
231 {
232 union acpi_object in_objs[] = {
233 { .integer.type = ACPI_TYPE_INTEGER,
234 .integer.value = func, },
235 { .integer.type = ACPI_TYPE_INTEGER,
236 .integer.value = val, },
237 };
238 struct acpi_object_list params = {
239 .count = ARRAY_SIZE(in_objs),
240 .pointer = in_objs,
241 };
242 acpi_status status = AE_OK;
243
244 ACPI_FUNCTION_TRACE("acpi_pcc_write_sset");
245
246 status = acpi_evaluate_object(pcc->handle, METHOD_HKEY_SSET,
247 &params, NULL);
248
249 return status == AE_OK;
250 }
251
252 static inline int acpi_pcc_get_sqty(struct acpi_device *device)
253 {
254 unsigned long long s;
255 acpi_status status;
256
257 ACPI_FUNCTION_TRACE("acpi_pcc_get_sqty");
258
259 status = acpi_evaluate_integer(device->handle, METHOD_HKEY_SQTY,
260 NULL, &s);
261 if (ACPI_SUCCESS(status))
262 return s;
263 else {
264 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
265 "evaluation error HKEY.SQTY\n"));
266 return -EINVAL;
267 }
268 }
269
270 static int acpi_pcc_retrieve_biosdata(struct pcc_acpi *pcc, u32 *sinf)
271 {
272 acpi_status status;
273 struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL};
274 union acpi_object *hkey = NULL;
275 int i;
276
277 ACPI_FUNCTION_TRACE("acpi_pcc_retrieve_biosdata");
278
279 status = acpi_evaluate_object(pcc->handle, METHOD_HKEY_SINF, 0,
280 &buffer);
281 if (ACPI_FAILURE(status)) {
282 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
283 "evaluation error HKEY.SINF\n"));
284 return 0;
285 }
286
287 hkey = buffer.pointer;
288 if (!hkey || (hkey->type != ACPI_TYPE_PACKAGE)) {
289 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid HKEY.SINF\n"));
290 goto end;
291 }
292
293 if (pcc->num_sifr < hkey->package.count) {
294 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
295 "SQTY reports bad SINF length\n"));
296 status = AE_ERROR;
297 goto end;
298 }
299
300 for (i = 0; i < hkey->package.count; i++) {
301 union acpi_object *element = &(hkey->package.elements[i]);
302 if (likely(element->type == ACPI_TYPE_INTEGER)) {
303 sinf[i] = element->integer.value;
304 } else
305 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
306 "Invalid HKEY.SINF data\n"));
307 }
308 sinf[hkey->package.count] = -1;
309
310 end:
311 kfree(buffer.pointer);
312 return status == AE_OK;
313 }
314
315 /* backlight API interface functions */
316
317 /* This driver currently treats AC and DC brightness identical,
318 * since we don't need to invent an interface to the core ACPI
319 * logic to receive events in case a power supply is plugged in
320 * or removed */
321
322 static int bl_get(struct backlight_device *bd)
323 {
324 struct pcc_acpi *pcc = bl_get_data(bd);
325
326 if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
327 return -EIO;
328
329 return pcc->sinf[SINF_AC_CUR_BRIGHT];
330 }
331
332 static int bl_set_status(struct backlight_device *bd)
333 {
334 struct pcc_acpi *pcc = bl_get_data(bd);
335 int bright = bd->props.brightness;
336 int rc;
337
338 if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
339 return -EIO;
340
341 if (bright < pcc->sinf[SINF_AC_MIN_BRIGHT])
342 bright = pcc->sinf[SINF_AC_MIN_BRIGHT];
343
344 if (bright < pcc->sinf[SINF_DC_MIN_BRIGHT])
345 bright = pcc->sinf[SINF_DC_MIN_BRIGHT];
346
347 if (bright < pcc->sinf[SINF_AC_MIN_BRIGHT] ||
348 bright > pcc->sinf[SINF_AC_MAX_BRIGHT])
349 return -EINVAL;
350
351 rc = acpi_pcc_write_sset(pcc, SINF_AC_CUR_BRIGHT, bright);
352 if (rc < 0)
353 return rc;
354
355 return acpi_pcc_write_sset(pcc, SINF_DC_CUR_BRIGHT, bright);
356 }
357
358 static struct backlight_ops pcc_backlight_ops = {
359 .get_brightness = bl_get,
360 .update_status = bl_set_status,
361 };
362
363
364 /* sysfs user interface functions */
365
366 static ssize_t show_numbatt(struct device *dev, struct device_attribute *attr,
367 char *buf)
368 {
369 struct acpi_device *acpi = to_acpi_device(dev);
370 struct pcc_acpi *pcc = acpi_driver_data(acpi);
371
372 if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
373 return -EIO;
374
375 return sprintf(buf, "%u\n", pcc->sinf[SINF_NUM_BATTERIES]);
376 }
377
378 static ssize_t show_lcdtype(struct device *dev, struct device_attribute *attr,
379 char *buf)
380 {
381 struct acpi_device *acpi = to_acpi_device(dev);
382 struct pcc_acpi *pcc = acpi_driver_data(acpi);
383
384 if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
385 return -EIO;
386
387 return sprintf(buf, "%u\n", pcc->sinf[SINF_LCD_TYPE]);
388 }
389
390 static ssize_t show_mute(struct device *dev, struct device_attribute *attr,
391 char *buf)
392 {
393 struct acpi_device *acpi = to_acpi_device(dev);
394 struct pcc_acpi *pcc = acpi_driver_data(acpi);
395
396 if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
397 return -EIO;
398
399 return sprintf(buf, "%u\n", pcc->sinf[SINF_MUTE]);
400 }
401
402 static ssize_t show_sticky(struct device *dev, struct device_attribute *attr,
403 char *buf)
404 {
405 struct acpi_device *acpi = to_acpi_device(dev);
406 struct pcc_acpi *pcc = acpi_driver_data(acpi);
407
408 if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
409 return -EIO;
410
411 return sprintf(buf, "%u\n", pcc->sinf[SINF_STICKY_KEY]);
412 }
413
414 static ssize_t set_sticky(struct device *dev, struct device_attribute *attr,
415 const char *buf, size_t count)
416 {
417 struct acpi_device *acpi = to_acpi_device(dev);
418 struct pcc_acpi *pcc = acpi_driver_data(acpi);
419 int val;
420
421 if (count && sscanf(buf, "%i", &val) == 1 &&
422 (val == 0 || val == 1)) {
423 acpi_pcc_write_sset(pcc, SINF_STICKY_KEY, val);
424 pcc->sticky_mode = val;
425 }
426
427 return count;
428 }
429
430 static DEVICE_ATTR(numbatt, S_IRUGO, show_numbatt, NULL);
431 static DEVICE_ATTR(lcdtype, S_IRUGO, show_lcdtype, NULL);
432 static DEVICE_ATTR(mute, S_IRUGO, show_mute, NULL);
433 static DEVICE_ATTR(sticky_key, S_IRUGO | S_IWUSR, show_sticky, set_sticky);
434
435 static struct attribute *pcc_sysfs_entries[] = {
436 &dev_attr_numbatt.attr,
437 &dev_attr_lcdtype.attr,
438 &dev_attr_mute.attr,
439 &dev_attr_sticky_key.attr,
440 NULL,
441 };
442
443 static struct attribute_group pcc_attr_group = {
444 .name = NULL, /* put in device directory */
445 .attrs = pcc_sysfs_entries,
446 };
447
448
449 /* hotkey input device driver */
450
451 static int pcc_getkeycode(struct input_dev *dev, int scancode, int *keycode)
452 {
453 struct pcc_acpi *pcc = input_get_drvdata(dev);
454
455 if (scancode >= ARRAY_SIZE(pcc->keymap))
456 return -EINVAL;
457
458 *keycode = pcc->keymap[scancode];
459
460 return 0;
461 }
462
463 static int keymap_get_by_keycode(struct pcc_acpi *pcc, int keycode)
464 {
465 int i;
466
467 for (i = 0; i < ARRAY_SIZE(pcc->keymap); i++) {
468 if (pcc->keymap[i] == keycode)
469 return i+1;
470 }
471
472 return 0;
473 }
474
475 static int pcc_setkeycode(struct input_dev *dev, int scancode, int keycode)
476 {
477 struct pcc_acpi *pcc = input_get_drvdata(dev);
478 int oldkeycode;
479
480 if (scancode >= ARRAY_SIZE(pcc->keymap))
481 return -EINVAL;
482
483 if (keycode < 0 || keycode > KEY_MAX)
484 return -EINVAL;
485
486 oldkeycode = pcc->keymap[scancode];
487 pcc->keymap[scancode] = keycode;
488
489 set_bit(keycode, dev->keybit);
490
491 if (!keymap_get_by_keycode(pcc, oldkeycode))
492 clear_bit(oldkeycode, dev->keybit);
493
494 return 0;
495 }
496
497 static void acpi_pcc_generate_keyinput(struct pcc_acpi *pcc)
498 {
499 struct input_dev *hotk_input_dev = pcc->input_dev;
500 int rc;
501 int key_code, hkey_num;
502 unsigned long long result;
503
504 ACPI_FUNCTION_TRACE("acpi_pcc_generate_keyinput");
505
506 rc = acpi_evaluate_integer(pcc->handle, METHOD_HKEY_QUERY,
507 NULL, &result);
508 if (!ACPI_SUCCESS(rc)) {
509 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
510 "error getting hotkey status\n"));
511 return;
512 }
513
514 acpi_bus_generate_proc_event(pcc->device, HKEY_NOTIFY, result);
515
516 hkey_num = result & 0xf;
517
518 if (hkey_num < 0 || hkey_num > ARRAY_SIZE(pcc->keymap)) {
519 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
520 "hotkey number out of range: %d\n",
521 hkey_num));
522 return;
523 }
524
525 key_code = pcc->keymap[hkey_num];
526
527 if (key_code != KEY_RESERVED) {
528 int pushed = (result & 0x80) ? TRUE : FALSE;
529
530 input_report_key(hotk_input_dev, key_code, pushed);
531 input_sync(hotk_input_dev);
532 }
533
534 return;
535 }
536
537 static void acpi_pcc_hotkey_notify(acpi_handle handle, u32 event, void *data)
538 {
539 struct pcc_acpi *pcc = (struct pcc_acpi *) data;
540
541 ACPI_FUNCTION_TRACE("acpi_pcc_hotkey_notify");
542
543 switch (event) {
544 case HKEY_NOTIFY:
545 acpi_pcc_generate_keyinput(pcc);
546 break;
547 default:
548 /* nothing to do */
549 break;
550 }
551 }
552
553 static int acpi_pcc_init_input(struct pcc_acpi *pcc)
554 {
555 int i, rc;
556
557 ACPI_FUNCTION_TRACE("acpi_pcc_init_input");
558
559 pcc->input_dev = input_allocate_device();
560 if (!pcc->input_dev) {
561 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
562 "Couldn't allocate input device for hotkey"));
563 return -ENOMEM;
564 }
565
566 pcc->input_dev->evbit[0] = BIT(EV_KEY);
567
568 pcc->input_dev->name = ACPI_PCC_DRIVER_NAME;
569 pcc->input_dev->phys = ACPI_PCC_INPUT_PHYS;
570 pcc->input_dev->id.bustype = BUS_HOST;
571 pcc->input_dev->id.vendor = 0x0001;
572 pcc->input_dev->id.product = 0x0001;
573 pcc->input_dev->id.version = 0x0100;
574 pcc->input_dev->getkeycode = pcc_getkeycode;
575 pcc->input_dev->setkeycode = pcc_setkeycode;
576
577 /* load initial keymap */
578 memcpy(pcc->keymap, initial_keymap, sizeof(pcc->keymap));
579
580 for (i = 0; i < ARRAY_SIZE(pcc->keymap); i++)
581 __set_bit(pcc->keymap[i], pcc->input_dev->keybit);
582 __clear_bit(KEY_RESERVED, pcc->input_dev->keybit);
583
584 input_set_drvdata(pcc->input_dev, pcc);
585
586 rc = input_register_device(pcc->input_dev);
587 if (rc < 0)
588 input_free_device(pcc->input_dev);
589
590 return rc;
591 }
592
593 /* kernel module interface */
594
595 static int acpi_pcc_hotkey_resume(struct acpi_device *device)
596 {
597 struct pcc_acpi *pcc = acpi_driver_data(device);
598 acpi_status status = AE_OK;
599
600 ACPI_FUNCTION_TRACE("acpi_pcc_hotkey_resume");
601
602 if (device == NULL || pcc == NULL)
603 return -EINVAL;
604
605 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Sticky mode restore: %d\n",
606 pcc->sticky_mode));
607
608 status = acpi_pcc_write_sset(pcc, SINF_STICKY_KEY, pcc->sticky_mode);
609
610 return status == AE_OK ? 0 : -EINVAL;
611 }
612
613 static int acpi_pcc_hotkey_add(struct acpi_device *device)
614 {
615 acpi_status status;
616 struct pcc_acpi *pcc;
617 int num_sifr, result;
618
619 ACPI_FUNCTION_TRACE("acpi_pcc_hotkey_add");
620
621 if (!device)
622 return -EINVAL;
623
624 num_sifr = acpi_pcc_get_sqty(device);
625
626 if (num_sifr > 255) {
627 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "num_sifr too large"));
628 return -ENODEV;
629 }
630
631 pcc = kzalloc(sizeof(struct pcc_acpi), GFP_KERNEL);
632 if (!pcc) {
633 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
634 "Couldn't allocate mem for pcc"));
635 return -ENOMEM;
636 }
637
638 pcc->sinf = kzalloc(sizeof(u32) * (num_sifr + 1), GFP_KERNEL);
639 if (!pcc->sinf) {
640 result = -ENOMEM;
641 goto out_hotkey;
642 }
643
644 pcc->device = device;
645 pcc->handle = device->handle;
646 pcc->num_sifr = num_sifr;
647 device->driver_data = pcc;
648 strcpy(acpi_device_name(device), ACPI_PCC_DEVICE_NAME);
649 strcpy(acpi_device_class(device), ACPI_PCC_CLASS);
650
651 result = acpi_pcc_init_input(pcc);
652 if (result) {
653 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
654 "Error installing keyinput handler\n"));
655 goto out_sinf;
656 }
657
658 /* initialize hotkey input device */
659 status = acpi_install_notify_handler(pcc->handle, ACPI_DEVICE_NOTIFY,
660 acpi_pcc_hotkey_notify, pcc);
661
662 if (ACPI_FAILURE(status)) {
663 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
664 "Error installing notify handler\n"));
665 result = -ENODEV;
666 goto out_input;
667 }
668
669 /* initialize backlight */
670 pcc->backlight = backlight_device_register("panasonic", NULL, pcc,
671 &pcc_backlight_ops);
672 if (IS_ERR(pcc->backlight))
673 goto out_notify;
674
675 if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf)) {
676 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
677 "Couldn't retrieve BIOS data\n"));
678 goto out_backlight;
679 }
680
681 /* read the initial brightness setting from the hardware */
682 pcc->backlight->props.max_brightness =
683 pcc->sinf[SINF_AC_MAX_BRIGHT];
684 pcc->backlight->props.brightness = pcc->sinf[SINF_AC_CUR_BRIGHT];
685
686 /* read the initial sticky key mode from the hardware */
687 pcc->sticky_mode = pcc->sinf[SINF_STICKY_KEY];
688
689 /* add sysfs attributes */
690 result = sysfs_create_group(&device->dev.kobj, &pcc_attr_group);
691 if (result)
692 goto out_backlight;
693
694 return 0;
695
696 out_backlight:
697 backlight_device_unregister(pcc->backlight);
698 out_notify:
699 acpi_remove_notify_handler(pcc->handle, ACPI_DEVICE_NOTIFY,
700 acpi_pcc_hotkey_notify);
701 out_input:
702 input_unregister_device(pcc->input_dev);
703 /* no need to input_free_device() since core input API refcount and
704 * free()s the device */
705 out_sinf:
706 kfree(pcc->sinf);
707 out_hotkey:
708 kfree(pcc);
709
710 return result;
711 }
712
713 static int __init acpi_pcc_init(void)
714 {
715 int result = 0;
716
717 ACPI_FUNCTION_TRACE("acpi_pcc_init");
718
719 if (acpi_disabled)
720 return -ENODEV;
721
722 result = acpi_bus_register_driver(&acpi_pcc_driver);
723 if (result < 0) {
724 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
725 "Error registering hotkey driver\n"));
726 return -ENODEV;
727 }
728
729 return 0;
730 }
731
732 static int acpi_pcc_hotkey_remove(struct acpi_device *device, int type)
733 {
734 struct pcc_acpi *pcc = acpi_driver_data(device);
735
736 ACPI_FUNCTION_TRACE("acpi_pcc_hotkey_remove");
737
738 if (!device || !pcc)
739 return -EINVAL;
740
741 sysfs_remove_group(&device->dev.kobj, &pcc_attr_group);
742
743 backlight_device_unregister(pcc->backlight);
744
745 acpi_remove_notify_handler(pcc->handle, ACPI_DEVICE_NOTIFY,
746 acpi_pcc_hotkey_notify);
747
748 input_unregister_device(pcc->input_dev);
749 /* no need to input_free_device() since core input API refcount and
750 * free()s the device */
751
752 kfree(pcc->sinf);
753 kfree(pcc);
754
755 return 0;
756 }
757
758 static void __exit acpi_pcc_exit(void)
759 {
760 ACPI_FUNCTION_TRACE("acpi_pcc_exit");
761
762 acpi_bus_unregister_driver(&acpi_pcc_driver);
763 }
764
765 module_init(acpi_pcc_init);
766 module_exit(acpi_pcc_exit);
Linux 2.6 ibm-acpi/thinkpad-acpi driver git tree