?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
GUI: Fix Tomato RAF theme for all builds. Compilation typo.
[tomato.git] / release / src-rt-6.x.4708 / linux / linux-2.6.36 / drivers / platform / x86 / panasonic-laptop.c
blobec01c3d8fc5a99a0f56eaed762ddf52df569ad8f
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 <linux/slab.h>
128 #include <acpi/acpi_bus.h>
129 #include <acpi/acpi_drivers.h>
130 #include <linux/input.h>
131
132
133 #ifndef ACPI_HOTKEY_COMPONENT
134 #define ACPI_HOTKEY_COMPONENT 0x10000000
135 #endif
136
137 #define _COMPONENT ACPI_HOTKEY_COMPONENT
138
139 MODULE_AUTHOR("Hiroshi Miura, David Bronaugh and Harald Welte");
140 MODULE_DESCRIPTION("ACPI HotKey driver for Panasonic Let's Note laptops");
141 MODULE_LICENSE("GPL");
142
143 #define LOGPREFIX "pcc_acpi: "
144
145 /* Define ACPI PATHs */
146 /* Lets note hotkeys */
147 #define METHOD_HKEY_QUERY "HINF"
148 #define METHOD_HKEY_SQTY "SQTY"
149 #define METHOD_HKEY_SINF "SINF"
150 #define METHOD_HKEY_SSET "SSET"
151 #define HKEY_NOTIFY 0x80
152
153 #define ACPI_PCC_DRIVER_NAME "Panasonic Laptop Support"
154 #define ACPI_PCC_DEVICE_NAME "Hotkey"
155 #define ACPI_PCC_CLASS "pcc"
156
157 #define ACPI_PCC_INPUT_PHYS "panasonic/hkey0"
158
159 /* LCD_TYPEs: 0 = Normal, 1 = Semi-transparent
160 ENV_STATEs: Normal temp=0x01, High temp=0x81, N/A=0x00
161 */
162 enum SINF_BITS { SINF_NUM_BATTERIES = 0,
163 SINF_LCD_TYPE,
164 SINF_AC_MAX_BRIGHT,
165 SINF_AC_MIN_BRIGHT,
166 SINF_AC_CUR_BRIGHT,
167 SINF_DC_MAX_BRIGHT,
168 SINF_DC_MIN_BRIGHT,
169 SINF_DC_CUR_BRIGHT,
170 SINF_MUTE,
171 SINF_RESERVED,
172 SINF_ENV_STATE,
173 SINF_STICKY_KEY = 0x80,
174 };
175 /* R1 handles SINF_AC_CUR_BRIGHT as SINF_CUR_BRIGHT, doesn't know AC state */
176
177 static int acpi_pcc_hotkey_add(struct acpi_device *device);
178 static int acpi_pcc_hotkey_remove(struct acpi_device *device, int type);
179 static int acpi_pcc_hotkey_resume(struct acpi_device *device);
180 static void acpi_pcc_hotkey_notify(struct acpi_device *device, u32 event);
181
182 static const struct acpi_device_id pcc_device_ids[] = {
183 { "MAT0012", 0},
184 { "MAT0013", 0},
185 { "MAT0018", 0},
186 { "MAT0019", 0},
187 { "", 0},
188 };
189 MODULE_DEVICE_TABLE(acpi, pcc_device_ids);
190
191 static struct acpi_driver acpi_pcc_driver = {
192 .name = ACPI_PCC_DRIVER_NAME,
193 .class = ACPI_PCC_CLASS,
194 .ids = pcc_device_ids,
195 .ops = {
196 .add = acpi_pcc_hotkey_add,
197 .remove = acpi_pcc_hotkey_remove,
198 .resume = acpi_pcc_hotkey_resume,
199 .notify = acpi_pcc_hotkey_notify,
200 },
201 };
202
203 #define KEYMAP_SIZE 11
204 static const unsigned int initial_keymap[KEYMAP_SIZE] = {
205 /* 0 */ KEY_RESERVED,
206 /* 1 */ KEY_BRIGHTNESSDOWN,
207 /* 2 */ KEY_BRIGHTNESSUP,
208 /* 3 */ KEY_DISPLAYTOGGLE,
209 /* 4 */ KEY_MUTE,
210 /* 5 */ KEY_VOLUMEDOWN,
211 /* 6 */ KEY_VOLUMEUP,
212 /* 7 */ KEY_SLEEP,
213 /* 8 */ KEY_PROG1, /* Change CPU boost */
214 /* 9 */ KEY_BATTERY,
215 /* 10 */ KEY_SUSPEND,
216 };
217
218 struct pcc_acpi {
219 acpi_handle handle;
220 unsigned long num_sifr;
221 int sticky_mode;
222 u32 *sinf;
223 struct acpi_device *device;
224 struct input_dev *input_dev;
225 struct backlight_device *backlight;
226 unsigned int keymap[KEYMAP_SIZE];
227 };
228
229 struct pcc_keyinput {
230 struct acpi_hotkey *hotkey;
231 };
232
233 /* method access functions */
234 static int acpi_pcc_write_sset(struct pcc_acpi *pcc, int func, int val)
235 {
236 union acpi_object in_objs[] = {
237 { .integer.type = ACPI_TYPE_INTEGER,
238 .integer.value = func, },
239 { .integer.type = ACPI_TYPE_INTEGER,
240 .integer.value = val, },
241 };
242 struct acpi_object_list params = {
243 .count = ARRAY_SIZE(in_objs),
244 .pointer = in_objs,
245 };
246 acpi_status status = AE_OK;
247
248 status = acpi_evaluate_object(pcc->handle, METHOD_HKEY_SSET,
249 &params, NULL);
250
251 return (status == AE_OK) ? 0 : -EIO;
252 }
253
254 static inline int acpi_pcc_get_sqty(struct acpi_device *device)
255 {
256 unsigned long long s;
257 acpi_status status;
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 status = acpi_evaluate_object(pcc->handle, METHOD_HKEY_SINF, NULL,
278 &buffer);
279 if (ACPI_FAILURE(status)) {
280 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
281 "evaluation error HKEY.SINF\n"));
282 return 0;
283 }
284
285 hkey = buffer.pointer;
286 if (!hkey || (hkey->type != ACPI_TYPE_PACKAGE)) {
287 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid HKEY.SINF\n"));
288 goto end;
289 }
290
291 if (pcc->num_sifr < hkey->package.count) {
292 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
293 "SQTY reports bad SINF length\n"));
294 status = AE_ERROR;
295 goto end;
296 }
297
298 for (i = 0; i < hkey->package.count; i++) {
299 union acpi_object *element = &(hkey->package.elements[i]);
300 if (likely(element->type == ACPI_TYPE_INTEGER)) {
301 sinf[i] = element->integer.value;
302 } else
303 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
304 "Invalid HKEY.SINF data\n"));
305 }
306 sinf[hkey->package.count] = -1;
307
308 end:
309 kfree(buffer.pointer);
310 return status == AE_OK;
311 }
312
313 /* backlight API interface functions */
314
315 /* This driver currently treats AC and DC brightness identical,
316 * since we don't need to invent an interface to the core ACPI
317 * logic to receive events in case a power supply is plugged in
318 * or removed */
319
320 static int bl_get(struct backlight_device *bd)
321 {
322 struct pcc_acpi *pcc = bl_get_data(bd);
323
324 if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
325 return -EIO;
326
327 return pcc->sinf[SINF_AC_CUR_BRIGHT];
328 }
329
330 static int bl_set_status(struct backlight_device *bd)
331 {
332 struct pcc_acpi *pcc = bl_get_data(bd);
333 int bright = bd->props.brightness;
334 int rc;
335
336 if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
337 return -EIO;
338
339 if (bright < pcc->sinf[SINF_AC_MIN_BRIGHT])
340 bright = pcc->sinf[SINF_AC_MIN_BRIGHT];
341
342 if (bright < pcc->sinf[SINF_DC_MIN_BRIGHT])
343 bright = pcc->sinf[SINF_DC_MIN_BRIGHT];
344
345 if (bright < pcc->sinf[SINF_AC_MIN_BRIGHT] ||
346 bright > pcc->sinf[SINF_AC_MAX_BRIGHT])
347 return -EINVAL;
348
349 rc = acpi_pcc_write_sset(pcc, SINF_AC_CUR_BRIGHT, bright);
350 if (rc < 0)
351 return rc;
352
353 return acpi_pcc_write_sset(pcc, SINF_DC_CUR_BRIGHT, bright);
354 }
355
356 static const struct backlight_ops pcc_backlight_ops = {
357 .get_brightness = bl_get,
358 .update_status = bl_set_status,
359 };
360
361
362 /* sysfs user interface functions */
363
364 static ssize_t show_numbatt(struct device *dev, struct device_attribute *attr,
365 char *buf)
366 {
367 struct acpi_device *acpi = to_acpi_device(dev);
368 struct pcc_acpi *pcc = acpi_driver_data(acpi);
369
370 if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
371 return -EIO;
372
373 return snprintf(buf, PAGE_SIZE, "%u\n", pcc->sinf[SINF_NUM_BATTERIES]);
374 }
375
376 static ssize_t show_lcdtype(struct device *dev, struct device_attribute *attr,
377 char *buf)
378 {
379 struct acpi_device *acpi = to_acpi_device(dev);
380 struct pcc_acpi *pcc = acpi_driver_data(acpi);
381
382 if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
383 return -EIO;
384
385 return snprintf(buf, PAGE_SIZE, "%u\n", pcc->sinf[SINF_LCD_TYPE]);
386 }
387
388 static ssize_t show_mute(struct device *dev, struct device_attribute *attr,
389 char *buf)
390 {
391 struct acpi_device *acpi = to_acpi_device(dev);
392 struct pcc_acpi *pcc = acpi_driver_data(acpi);
393
394 if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
395 return -EIO;
396
397 return snprintf(buf, PAGE_SIZE, "%u\n", pcc->sinf[SINF_MUTE]);
398 }
399
400 static ssize_t show_sticky(struct device *dev, struct device_attribute *attr,
401 char *buf)
402 {
403 struct acpi_device *acpi = to_acpi_device(dev);
404 struct pcc_acpi *pcc = acpi_driver_data(acpi);
405
406 if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
407 return -EIO;
408
409 return snprintf(buf, PAGE_SIZE, "%u\n", pcc->sinf[SINF_STICKY_KEY]);
410 }
411
412 static ssize_t set_sticky(struct device *dev, struct device_attribute *attr,
413 const char *buf, size_t count)
414 {
415 struct acpi_device *acpi = to_acpi_device(dev);
416 struct pcc_acpi *pcc = acpi_driver_data(acpi);
417 int val;
418
419 if (count && sscanf(buf, "%i", &val) == 1 &&
420 (val == 0 || val == 1)) {
421 acpi_pcc_write_sset(pcc, SINF_STICKY_KEY, val);
422 pcc->sticky_mode = val;
423 }
424
425 return count;
426 }
427
428 static DEVICE_ATTR(numbatt, S_IRUGO, show_numbatt, NULL);
429 static DEVICE_ATTR(lcdtype, S_IRUGO, show_lcdtype, NULL);
430 static DEVICE_ATTR(mute, S_IRUGO, show_mute, NULL);
431 static DEVICE_ATTR(sticky_key, S_IRUGO | S_IWUSR, show_sticky, set_sticky);
432
433 static struct attribute *pcc_sysfs_entries[] = {
434 &dev_attr_numbatt.attr,
435 &dev_attr_lcdtype.attr,
436 &dev_attr_mute.attr,
437 &dev_attr_sticky_key.attr,
438 NULL,
439 };
440
441 static struct attribute_group pcc_attr_group = {
442 .name = NULL, /* put in device directory */
443 .attrs = pcc_sysfs_entries,
444 };
445
446
447 /* hotkey input device driver */
448
449 static int pcc_getkeycode(struct input_dev *dev,
450 unsigned int scancode, unsigned int *keycode)
451 {
452 struct pcc_acpi *pcc = input_get_drvdata(dev);
453
454 if (scancode >= ARRAY_SIZE(pcc->keymap))
455 return -EINVAL;
456
457 *keycode = pcc->keymap[scancode];
458
459 return 0;
460 }
461
462 static int keymap_get_by_keycode(struct pcc_acpi *pcc, unsigned int keycode)
463 {
464 int i;
465
466 for (i = 0; i < ARRAY_SIZE(pcc->keymap); i++) {
467 if (pcc->keymap[i] == keycode)
468 return i+1;
469 }
470
471 return 0;
472 }
473
474 static int pcc_setkeycode(struct input_dev *dev,
475 unsigned int scancode, unsigned 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 oldkeycode = pcc->keymap[scancode];
484 pcc->keymap[scancode] = keycode;
485
486 set_bit(keycode, dev->keybit);
487
488 if (!keymap_get_by_keycode(pcc, oldkeycode))
489 clear_bit(oldkeycode, dev->keybit);
490
491 return 0;
492 }
493
494 static void acpi_pcc_generate_keyinput(struct pcc_acpi *pcc)
495 {
496 struct input_dev *hotk_input_dev = pcc->input_dev;
497 int rc;
498 int key_code, hkey_num;
499 unsigned long long result;
500
501 rc = acpi_evaluate_integer(pcc->handle, METHOD_HKEY_QUERY,
502 NULL, &result);
503 if (!ACPI_SUCCESS(rc)) {
504 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
505 "error getting hotkey status\n"));
506 return;
507 }
508
509 acpi_bus_generate_proc_event(pcc->device, HKEY_NOTIFY, result);
510
511 hkey_num = result & 0xf;
512
513 if (hkey_num < 0 || hkey_num >= ARRAY_SIZE(pcc->keymap)) {
514 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
515 "hotkey number out of range: %d\n",
516 hkey_num));
517 return;
518 }
519
520 key_code = pcc->keymap[hkey_num];
521
522 if (key_code != KEY_RESERVED) {
523 int pushed = (result & 0x80) ? TRUE : FALSE;
524
525 input_report_key(hotk_input_dev, key_code, pushed);
526 input_sync(hotk_input_dev);
527 }
528
529 return;
530 }
531
532 static void acpi_pcc_hotkey_notify(struct acpi_device *device, u32 event)
533 {
534 struct pcc_acpi *pcc = acpi_driver_data(device);
535
536 switch (event) {
537 case HKEY_NOTIFY:
538 acpi_pcc_generate_keyinput(pcc);
539 break;
540 default:
541 /* nothing to do */
542 break;
543 }
544 }
545
546 static int acpi_pcc_init_input(struct pcc_acpi *pcc)
547 {
548 int i, rc;
549
550 pcc->input_dev = input_allocate_device();
551 if (!pcc->input_dev) {
552 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
553 "Couldn't allocate input device for hotkey"));
554 return -ENOMEM;
555 }
556
557 pcc->input_dev->evbit[0] = BIT(EV_KEY);
558
559 pcc->input_dev->name = ACPI_PCC_DRIVER_NAME;
560 pcc->input_dev->phys = ACPI_PCC_INPUT_PHYS;
561 pcc->input_dev->id.bustype = BUS_HOST;
562 pcc->input_dev->id.vendor = 0x0001;
563 pcc->input_dev->id.product = 0x0001;
564 pcc->input_dev->id.version = 0x0100;
565 pcc->input_dev->getkeycode = pcc_getkeycode;
566 pcc->input_dev->setkeycode = pcc_setkeycode;
567
568 /* load initial keymap */
569 memcpy(pcc->keymap, initial_keymap, sizeof(pcc->keymap));
570
571 for (i = 0; i < ARRAY_SIZE(pcc->keymap); i++)
572 __set_bit(pcc->keymap[i], pcc->input_dev->keybit);
573 __clear_bit(KEY_RESERVED, pcc->input_dev->keybit);
574
575 input_set_drvdata(pcc->input_dev, pcc);
576
577 rc = input_register_device(pcc->input_dev);
578 if (rc < 0)
579 input_free_device(pcc->input_dev);
580
581 return rc;
582 }
583
584 /* kernel module interface */
585
586 static int acpi_pcc_hotkey_resume(struct acpi_device *device)
587 {
588 struct pcc_acpi *pcc = acpi_driver_data(device);
589
590 if (device == NULL || pcc == NULL)
591 return -EINVAL;
592
593 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Sticky mode restore: %d\n",
594 pcc->sticky_mode));
595
596 return acpi_pcc_write_sset(pcc, SINF_STICKY_KEY, pcc->sticky_mode);
597 }
598
599 static int acpi_pcc_hotkey_add(struct acpi_device *device)
600 {
601 struct backlight_properties props;
602 struct pcc_acpi *pcc;
603 int num_sifr, result;
604
605 if (!device)
606 return -EINVAL;
607
608 num_sifr = acpi_pcc_get_sqty(device);
609
610 if (num_sifr > 255) {
611 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "num_sifr too large"));
612 return -ENODEV;
613 }
614
615 pcc = kzalloc(sizeof(struct pcc_acpi), GFP_KERNEL);
616 if (!pcc) {
617 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
618 "Couldn't allocate mem for pcc"));
619 return -ENOMEM;
620 }
621
622 pcc->sinf = kzalloc(sizeof(u32) * (num_sifr + 1), GFP_KERNEL);
623 if (!pcc->sinf) {
624 result = -ENOMEM;
625 goto out_hotkey;
626 }
627
628 pcc->device = device;
629 pcc->handle = device->handle;
630 pcc->num_sifr = num_sifr;
631 device->driver_data = pcc;
632 strcpy(acpi_device_name(device), ACPI_PCC_DEVICE_NAME);
633 strcpy(acpi_device_class(device), ACPI_PCC_CLASS);
634
635 result = acpi_pcc_init_input(pcc);
636 if (result) {
637 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
638 "Error installing keyinput handler\n"));
639 goto out_hotkey;
640 }
641
642 if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf)) {
643 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
644 "Couldn't retrieve BIOS data\n"));
645 goto out_input;
646 }
647 /* initialize backlight */
648 memset(&props, 0, sizeof(struct backlight_properties));
649 props.max_brightness = pcc->sinf[SINF_AC_MAX_BRIGHT];
650 pcc->backlight = backlight_device_register("panasonic", NULL, pcc,
651 &pcc_backlight_ops, &props);
652 if (IS_ERR(pcc->backlight)) {
653 result = PTR_ERR(pcc->backlight);
654 goto out_sinf;
655 }
656
657 /* read the initial brightness setting from the hardware */
658 pcc->backlight->props.brightness = pcc->sinf[SINF_AC_CUR_BRIGHT];
659
660 /* read the initial sticky key mode from the hardware */
661 pcc->sticky_mode = pcc->sinf[SINF_STICKY_KEY];
662
663 /* add sysfs attributes */
664 result = sysfs_create_group(&device->dev.kobj, &pcc_attr_group);
665 if (result)
666 goto out_backlight;
667
668 return 0;
669
670 out_backlight:
671 backlight_device_unregister(pcc->backlight);
672 out_sinf:
673 kfree(pcc->sinf);
674 out_input:
675 input_unregister_device(pcc->input_dev);
676 /* no need to input_free_device() since core input API refcount and
677 * free()s the device */
678 out_hotkey:
679 kfree(pcc);
680
681 return result;
682 }
683
684 static int __init acpi_pcc_init(void)
685 {
686 int result = 0;
687
688 if (acpi_disabled)
689 return -ENODEV;
690
691 result = acpi_bus_register_driver(&acpi_pcc_driver);
692 if (result < 0) {
693 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
694 "Error registering hotkey driver\n"));
695 return -ENODEV;
696 }
697
698 return 0;
699 }
700
701 static int acpi_pcc_hotkey_remove(struct acpi_device *device, int type)
702 {
703 struct pcc_acpi *pcc = acpi_driver_data(device);
704
705 if (!device || !pcc)
706 return -EINVAL;
707
708 sysfs_remove_group(&device->dev.kobj, &pcc_attr_group);
709
710 backlight_device_unregister(pcc->backlight);
711
712 input_unregister_device(pcc->input_dev);
713 /* no need to input_free_device() since core input API refcount and
714 * free()s the device */
715
716 kfree(pcc->sinf);
717 kfree(pcc);
718
719 return 0;
720 }
721
722 static void __exit acpi_pcc_exit(void)
723 {
724 acpi_bus_unregister_driver(&acpi_pcc_driver);
725 }
726
727 module_init(acpi_pcc_init);
728 module_exit(acpi_pcc_exit);
Tomato firmware and modifications.