xref: /openbmc/linux/drivers/platform/x86/panasonic-laptop.c (revision b8bb76713ec50df2f11efee386e16f93d51e1076)
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 	status = acpi_evaluate_object(pcc->handle, METHOD_HKEY_SSET,
245 				      &params, NULL);
246 
247 	return status == AE_OK;
248 }
249 
250 static inline int acpi_pcc_get_sqty(struct acpi_device *device)
251 {
252 	unsigned long long s;
253 	acpi_status status;
254 
255 	status = acpi_evaluate_integer(device->handle, METHOD_HKEY_SQTY,
256 				       NULL, &s);
257 	if (ACPI_SUCCESS(status))
258 		return s;
259 	else {
260 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
261 				  "evaluation error HKEY.SQTY\n"));
262 		return -EINVAL;
263 	}
264 }
265 
266 static int acpi_pcc_retrieve_biosdata(struct pcc_acpi *pcc, u32 *sinf)
267 {
268 	acpi_status status;
269 	struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL};
270 	union acpi_object *hkey = NULL;
271 	int i;
272 
273 	status = acpi_evaluate_object(pcc->handle, METHOD_HKEY_SINF, 0,
274 				      &buffer);
275 	if (ACPI_FAILURE(status)) {
276 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
277 				  "evaluation error HKEY.SINF\n"));
278 		return 0;
279 	}
280 
281 	hkey = buffer.pointer;
282 	if (!hkey || (hkey->type != ACPI_TYPE_PACKAGE)) {
283 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid HKEY.SINF\n"));
284 		goto end;
285 	}
286 
287 	if (pcc->num_sifr < hkey->package.count) {
288 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
289 				 "SQTY reports bad SINF length\n"));
290 		status = AE_ERROR;
291 		goto end;
292 	}
293 
294 	for (i = 0; i < hkey->package.count; i++) {
295 		union acpi_object *element = &(hkey->package.elements[i]);
296 		if (likely(element->type == ACPI_TYPE_INTEGER)) {
297 			sinf[i] = element->integer.value;
298 		} else
299 			ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
300 					 "Invalid HKEY.SINF data\n"));
301 	}
302 	sinf[hkey->package.count] = -1;
303 
304 end:
305 	kfree(buffer.pointer);
306 	return status == AE_OK;
307 }
308 
309 /* backlight API interface functions */
310 
311 /* This driver currently treats AC and DC brightness identical,
312  * since we don't need to invent an interface to the core ACPI
313  * logic to receive events in case a power supply is plugged in
314  * or removed */
315 
316 static int bl_get(struct backlight_device *bd)
317 {
318 	struct pcc_acpi *pcc = bl_get_data(bd);
319 
320 	if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
321 		return -EIO;
322 
323 	return pcc->sinf[SINF_AC_CUR_BRIGHT];
324 }
325 
326 static int bl_set_status(struct backlight_device *bd)
327 {
328 	struct pcc_acpi *pcc = bl_get_data(bd);
329 	int bright = bd->props.brightness;
330 	int rc;
331 
332 	if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
333 		return -EIO;
334 
335 	if (bright < pcc->sinf[SINF_AC_MIN_BRIGHT])
336 		bright = pcc->sinf[SINF_AC_MIN_BRIGHT];
337 
338 	if (bright < pcc->sinf[SINF_DC_MIN_BRIGHT])
339 		bright = pcc->sinf[SINF_DC_MIN_BRIGHT];
340 
341 	if (bright < pcc->sinf[SINF_AC_MIN_BRIGHT] ||
342 	    bright > pcc->sinf[SINF_AC_MAX_BRIGHT])
343 		return -EINVAL;
344 
345 	rc = acpi_pcc_write_sset(pcc, SINF_AC_CUR_BRIGHT, bright);
346 	if (rc < 0)
347 		return rc;
348 
349 	return acpi_pcc_write_sset(pcc, SINF_DC_CUR_BRIGHT, bright);
350 }
351 
352 static struct backlight_ops pcc_backlight_ops = {
353 	.get_brightness	= bl_get,
354 	.update_status	= bl_set_status,
355 };
356 
357 
358 /* sysfs user interface functions */
359 
360 static ssize_t show_numbatt(struct device *dev, struct device_attribute *attr,
361 			    char *buf)
362 {
363 	struct acpi_device *acpi = to_acpi_device(dev);
364 	struct pcc_acpi *pcc = acpi_driver_data(acpi);
365 
366 	if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
367 		return -EIO;
368 
369 	return sprintf(buf, "%u\n", pcc->sinf[SINF_NUM_BATTERIES]);
370 }
371 
372 static ssize_t show_lcdtype(struct device *dev, struct device_attribute *attr,
373 			    char *buf)
374 {
375 	struct acpi_device *acpi = to_acpi_device(dev);
376 	struct pcc_acpi *pcc = acpi_driver_data(acpi);
377 
378 	if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
379 		return -EIO;
380 
381 	return sprintf(buf, "%u\n", pcc->sinf[SINF_LCD_TYPE]);
382 }
383 
384 static ssize_t show_mute(struct device *dev, struct device_attribute *attr,
385 			 char *buf)
386 {
387 	struct acpi_device *acpi = to_acpi_device(dev);
388 	struct pcc_acpi *pcc = acpi_driver_data(acpi);
389 
390 	if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
391 		return -EIO;
392 
393 	return sprintf(buf, "%u\n", pcc->sinf[SINF_MUTE]);
394 }
395 
396 static ssize_t show_sticky(struct device *dev, struct device_attribute *attr,
397 			   char *buf)
398 {
399 	struct acpi_device *acpi = to_acpi_device(dev);
400 	struct pcc_acpi *pcc = acpi_driver_data(acpi);
401 
402 	if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf))
403 		return -EIO;
404 
405 	return sprintf(buf, "%u\n", pcc->sinf[SINF_STICKY_KEY]);
406 }
407 
408 static ssize_t set_sticky(struct device *dev, struct device_attribute *attr,
409 			  const char *buf, size_t count)
410 {
411 	struct acpi_device *acpi = to_acpi_device(dev);
412 	struct pcc_acpi *pcc = acpi_driver_data(acpi);
413 	int val;
414 
415 	if (count && sscanf(buf, "%i", &val) == 1 &&
416 	    (val == 0 || val == 1)) {
417 		acpi_pcc_write_sset(pcc, SINF_STICKY_KEY, val);
418 		pcc->sticky_mode = val;
419 	}
420 
421 	return count;
422 }
423 
424 static DEVICE_ATTR(numbatt, S_IRUGO, show_numbatt, NULL);
425 static DEVICE_ATTR(lcdtype, S_IRUGO, show_lcdtype, NULL);
426 static DEVICE_ATTR(mute, S_IRUGO, show_mute, NULL);
427 static DEVICE_ATTR(sticky_key, S_IRUGO | S_IWUSR, show_sticky, set_sticky);
428 
429 static struct attribute *pcc_sysfs_entries[] = {
430 	&dev_attr_numbatt.attr,
431 	&dev_attr_lcdtype.attr,
432 	&dev_attr_mute.attr,
433 	&dev_attr_sticky_key.attr,
434 	NULL,
435 };
436 
437 static struct attribute_group pcc_attr_group = {
438 	.name	= NULL,		/* put in device directory */
439 	.attrs	= pcc_sysfs_entries,
440 };
441 
442 
443 /* hotkey input device driver */
444 
445 static int pcc_getkeycode(struct input_dev *dev, int scancode, int *keycode)
446 {
447 	struct pcc_acpi *pcc = input_get_drvdata(dev);
448 
449 	if (scancode >= ARRAY_SIZE(pcc->keymap))
450 		return -EINVAL;
451 
452 	*keycode = pcc->keymap[scancode];
453 
454 	return 0;
455 }
456 
457 static int keymap_get_by_keycode(struct pcc_acpi *pcc, int keycode)
458 {
459 	int i;
460 
461 	for (i = 0; i < ARRAY_SIZE(pcc->keymap); i++) {
462 		if (pcc->keymap[i] == keycode)
463 			return i+1;
464 	}
465 
466 	return 0;
467 }
468 
469 static int pcc_setkeycode(struct input_dev *dev, int scancode, int keycode)
470 {
471 	struct pcc_acpi *pcc = input_get_drvdata(dev);
472 	int oldkeycode;
473 
474 	if (scancode >= ARRAY_SIZE(pcc->keymap))
475 		return -EINVAL;
476 
477 	if (keycode < 0 || keycode > KEY_MAX)
478 		return -EINVAL;
479 
480 	oldkeycode = pcc->keymap[scancode];
481 	pcc->keymap[scancode] = keycode;
482 
483 	set_bit(keycode, dev->keybit);
484 
485 	if (!keymap_get_by_keycode(pcc, oldkeycode))
486 		clear_bit(oldkeycode, dev->keybit);
487 
488 	return 0;
489 }
490 
491 static void acpi_pcc_generate_keyinput(struct pcc_acpi *pcc)
492 {
493 	struct input_dev *hotk_input_dev = pcc->input_dev;
494 	int rc;
495 	int key_code, hkey_num;
496 	unsigned long long result;
497 
498 	rc = acpi_evaluate_integer(pcc->handle, METHOD_HKEY_QUERY,
499 				   NULL, &result);
500 	if (!ACPI_SUCCESS(rc)) {
501 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
502 				 "error getting hotkey status\n"));
503 		return;
504 	}
505 
506 	acpi_bus_generate_proc_event(pcc->device, HKEY_NOTIFY, result);
507 
508 	hkey_num = result & 0xf;
509 
510 	if (hkey_num < 0 || hkey_num >= ARRAY_SIZE(pcc->keymap)) {
511 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
512 				  "hotkey number out of range: %d\n",
513 				  hkey_num));
514 		return;
515 	}
516 
517 	key_code = pcc->keymap[hkey_num];
518 
519 	if (key_code != KEY_RESERVED) {
520 		int pushed = (result & 0x80) ? TRUE : FALSE;
521 
522 		input_report_key(hotk_input_dev, key_code, pushed);
523 		input_sync(hotk_input_dev);
524 	}
525 
526 	return;
527 }
528 
529 static void acpi_pcc_hotkey_notify(acpi_handle handle, u32 event, void *data)
530 {
531 	struct pcc_acpi *pcc = (struct pcc_acpi *) data;
532 
533 	switch (event) {
534 	case HKEY_NOTIFY:
535 		acpi_pcc_generate_keyinput(pcc);
536 		break;
537 	default:
538 		/* nothing to do */
539 		break;
540 	}
541 }
542 
543 static int acpi_pcc_init_input(struct pcc_acpi *pcc)
544 {
545 	int i, rc;
546 
547 	pcc->input_dev = input_allocate_device();
548 	if (!pcc->input_dev) {
549 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
550 				  "Couldn't allocate input device for hotkey"));
551 		return -ENOMEM;
552 	}
553 
554 	pcc->input_dev->evbit[0] = BIT(EV_KEY);
555 
556 	pcc->input_dev->name = ACPI_PCC_DRIVER_NAME;
557 	pcc->input_dev->phys = ACPI_PCC_INPUT_PHYS;
558 	pcc->input_dev->id.bustype = BUS_HOST;
559 	pcc->input_dev->id.vendor = 0x0001;
560 	pcc->input_dev->id.product = 0x0001;
561 	pcc->input_dev->id.version = 0x0100;
562 	pcc->input_dev->getkeycode = pcc_getkeycode;
563 	pcc->input_dev->setkeycode = pcc_setkeycode;
564 
565 	/* load initial keymap */
566 	memcpy(pcc->keymap, initial_keymap, sizeof(pcc->keymap));
567 
568 	for (i = 0; i < ARRAY_SIZE(pcc->keymap); i++)
569 		__set_bit(pcc->keymap[i], pcc->input_dev->keybit);
570 	__clear_bit(KEY_RESERVED, pcc->input_dev->keybit);
571 
572 	input_set_drvdata(pcc->input_dev, pcc);
573 
574 	rc = input_register_device(pcc->input_dev);
575 	if (rc < 0)
576 		input_free_device(pcc->input_dev);
577 
578 	return rc;
579 }
580 
581 /* kernel module interface */
582 
583 static int acpi_pcc_hotkey_resume(struct acpi_device *device)
584 {
585 	struct pcc_acpi *pcc = acpi_driver_data(device);
586 	acpi_status status = AE_OK;
587 
588 	if (device == NULL || pcc == NULL)
589 		return -EINVAL;
590 
591 	ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Sticky mode restore: %d\n",
592 			  pcc->sticky_mode));
593 
594 	status = acpi_pcc_write_sset(pcc, SINF_STICKY_KEY, pcc->sticky_mode);
595 
596 	return status == AE_OK ? 0 : -EINVAL;
597 }
598 
599 static int acpi_pcc_hotkey_add(struct acpi_device *device)
600 {
601 	acpi_status status;
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_sinf;
640 	}
641 
642 	/* initialize hotkey input device */
643 	status = acpi_install_notify_handler(pcc->handle, ACPI_DEVICE_NOTIFY,
644 					     acpi_pcc_hotkey_notify, pcc);
645 
646 	if (ACPI_FAILURE(status)) {
647 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
648 				  "Error installing notify handler\n"));
649 		result = -ENODEV;
650 		goto out_input;
651 	}
652 
653 	/* initialize backlight */
654 	pcc->backlight = backlight_device_register("panasonic", NULL, pcc,
655 						   &pcc_backlight_ops);
656 	if (IS_ERR(pcc->backlight))
657 		goto out_notify;
658 
659 	if (!acpi_pcc_retrieve_biosdata(pcc, pcc->sinf)) {
660 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
661 				 "Couldn't retrieve BIOS data\n"));
662 		goto out_backlight;
663 	}
664 
665 	/* read the initial brightness setting from the hardware */
666 	pcc->backlight->props.max_brightness =
667 					pcc->sinf[SINF_AC_MAX_BRIGHT];
668 	pcc->backlight->props.brightness = pcc->sinf[SINF_AC_CUR_BRIGHT];
669 
670 	/* read the initial sticky key mode from the hardware */
671 	pcc->sticky_mode = pcc->sinf[SINF_STICKY_KEY];
672 
673 	/* add sysfs attributes */
674 	result = sysfs_create_group(&device->dev.kobj, &pcc_attr_group);
675 	if (result)
676 		goto out_backlight;
677 
678 	return 0;
679 
680 out_backlight:
681 	backlight_device_unregister(pcc->backlight);
682 out_notify:
683 	acpi_remove_notify_handler(pcc->handle, ACPI_DEVICE_NOTIFY,
684 				   acpi_pcc_hotkey_notify);
685 out_input:
686 	input_unregister_device(pcc->input_dev);
687 	/* no need to input_free_device() since core input API refcount and
688 	 * free()s the device */
689 out_sinf:
690 	kfree(pcc->sinf);
691 out_hotkey:
692 	kfree(pcc);
693 
694 	return result;
695 }
696 
697 static int __init acpi_pcc_init(void)
698 {
699 	int result = 0;
700 
701 	if (acpi_disabled)
702 		return -ENODEV;
703 
704 	result = acpi_bus_register_driver(&acpi_pcc_driver);
705 	if (result < 0) {
706 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
707 				  "Error registering hotkey driver\n"));
708 		return -ENODEV;
709 	}
710 
711 	return 0;
712 }
713 
714 static int acpi_pcc_hotkey_remove(struct acpi_device *device, int type)
715 {
716 	struct pcc_acpi *pcc = acpi_driver_data(device);
717 
718 	if (!device || !pcc)
719 		return -EINVAL;
720 
721 	sysfs_remove_group(&device->dev.kobj, &pcc_attr_group);
722 
723 	backlight_device_unregister(pcc->backlight);
724 
725 	acpi_remove_notify_handler(pcc->handle, ACPI_DEVICE_NOTIFY,
726 				   acpi_pcc_hotkey_notify);
727 
728 	input_unregister_device(pcc->input_dev);
729 	/* no need to input_free_device() since core input API refcount and
730 	 * free()s the device */
731 
732 	kfree(pcc->sinf);
733 	kfree(pcc);
734 
735 	return 0;
736 }
737 
738 static void __exit acpi_pcc_exit(void)
739 {
740 	acpi_bus_unregister_driver(&acpi_pcc_driver);
741 }
742 
743 module_init(acpi_pcc_init);
744 module_exit(acpi_pcc_exit);
745