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 <linux/acpi.h>
129 #include <linux/input.h>
130 #include <linux/input/sparse-keymap.h>
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);
178 static void acpi_pcc_hotkey_notify(struct acpi_device *device, u32 event);
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 MODULE_DEVICE_TABLE(acpi, pcc_device_ids);
188 
189 #ifdef CONFIG_PM_SLEEP
190 static int acpi_pcc_hotkey_resume(struct device *dev);
191 #endif
192 static SIMPLE_DEV_PM_OPS(acpi_pcc_hotkey_pm, NULL, acpi_pcc_hotkey_resume);
193 
194 static struct acpi_driver acpi_pcc_driver = {
195 	.name =		ACPI_PCC_DRIVER_NAME,
196 	.class =	ACPI_PCC_CLASS,
197 	.ids =		pcc_device_ids,
198 	.ops =		{
199 				.add =		acpi_pcc_hotkey_add,
200 				.remove =	acpi_pcc_hotkey_remove,
201 				.notify =	acpi_pcc_hotkey_notify,
202 			},
203 	.drv.pm =	&acpi_pcc_hotkey_pm,
204 };
205 
206 static const struct key_entry panasonic_keymap[] = {
207 	{ KE_KEY, 0, { KEY_RESERVED } },
208 	{ KE_KEY, 1, { KEY_BRIGHTNESSDOWN } },
209 	{ KE_KEY, 2, { KEY_BRIGHTNESSUP } },
210 	{ KE_KEY, 3, { KEY_DISPLAYTOGGLE } },
211 	{ KE_KEY, 4, { KEY_MUTE } },
212 	{ KE_KEY, 5, { KEY_VOLUMEDOWN } },
213 	{ KE_KEY, 6, { KEY_VOLUMEUP } },
214 	{ KE_KEY, 7, { KEY_SLEEP } },
215 	{ KE_KEY, 8, { KEY_PROG1 } }, /* Change CPU boost */
216 	{ KE_KEY, 9, { KEY_BATTERY } },
217 	{ KE_KEY, 10, { KEY_SUSPEND } },
218 	{ KE_END, 0 }
219 };
220 
221 struct pcc_acpi {
222 	acpi_handle		handle;
223 	unsigned long		num_sifr;
224 	int			sticky_mode;
225 	u32			*sinf;
226 	struct acpi_device	*device;
227 	struct input_dev	*input_dev;
228 	struct backlight_device	*backlight;
229 };
230 
231 /* method access functions */
acpi_pcc_write_sset(struct pcc_acpi * pcc,int func,int val)232 static int acpi_pcc_write_sset(struct pcc_acpi *pcc, int func, int val)
233 {
234 	union acpi_object in_objs[] = {
235 		{ .integer.type  = ACPI_TYPE_INTEGER,
236 		  .integer.value = func, },
237 		{ .integer.type  = ACPI_TYPE_INTEGER,
238 		  .integer.value = val, },
239 	};
240 	struct acpi_object_list params = {
241 		.count   = ARRAY_SIZE(in_objs),
242 		.pointer = in_objs,
243 	};
244 	acpi_status status = AE_OK;
245 
246 	status = acpi_evaluate_object(pcc->handle, METHOD_HKEY_SSET,
247 				      &params, NULL);
248 
249 	return (status == AE_OK) ? 0 : -EIO;
250 }
251 
acpi_pcc_get_sqty(struct acpi_device * device)252 static inline int acpi_pcc_get_sqty(struct acpi_device *device)
253 {
254 	unsigned long long s;
255 	acpi_status status;
256 
257 	status = acpi_evaluate_integer(device->handle, METHOD_HKEY_SQTY,
258 				       NULL, &s);
259 	if (ACPI_SUCCESS(status))
260 		return s;
261 	else {
262 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
263 				  "evaluation error HKEY.SQTY\n"));
264 		return -EINVAL;
265 	}
266 }
267 
acpi_pcc_retrieve_biosdata(struct pcc_acpi * pcc)268 static int acpi_pcc_retrieve_biosdata(struct pcc_acpi *pcc)
269 {
270 	acpi_status status;
271 	struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL};
272 	union acpi_object *hkey = NULL;
273 	int i;
274 
275 	status = acpi_evaluate_object(pcc->handle, METHOD_HKEY_SINF, NULL,
276 				      &buffer);
277 	if (ACPI_FAILURE(status)) {
278 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
279 				  "evaluation error HKEY.SINF\n"));
280 		return 0;
281 	}
282 
283 	hkey = buffer.pointer;
284 	if (!hkey || (hkey->type != ACPI_TYPE_PACKAGE)) {
285 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid HKEY.SINF\n"));
286 		status = AE_ERROR;
287 		goto end;
288 	}
289 
290 	if (pcc->num_sifr < hkey->package.count) {
291 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
292 				 "SQTY reports bad SINF length\n"));
293 		status = AE_ERROR;
294 		goto end;
295 	}
296 
297 	for (i = 0; i < hkey->package.count; i++) {
298 		union acpi_object *element = &(hkey->package.elements[i]);
299 		if (likely(element->type == ACPI_TYPE_INTEGER)) {
300 			pcc->sinf[i] = element->integer.value;
301 		} else
302 			ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
303 					 "Invalid HKEY.SINF data\n"));
304 	}
305 	pcc->sinf[hkey->package.count] = -1;
306 
307 end:
308 	kfree(buffer.pointer);
309 	return status == AE_OK;
310 }
311 
312 /* backlight API interface functions */
313 
314 /* This driver currently treats AC and DC brightness identical,
315  * since we don't need to invent an interface to the core ACPI
316  * logic to receive events in case a power supply is plugged in
317  * or removed */
318 
bl_get(struct backlight_device * bd)319 static int bl_get(struct backlight_device *bd)
320 {
321 	struct pcc_acpi *pcc = bl_get_data(bd);
322 
323 	if (!acpi_pcc_retrieve_biosdata(pcc))
324 		return -EIO;
325 
326 	return pcc->sinf[SINF_AC_CUR_BRIGHT];
327 }
328 
bl_set_status(struct backlight_device * bd)329 static int bl_set_status(struct backlight_device *bd)
330 {
331 	struct pcc_acpi *pcc = bl_get_data(bd);
332 	int bright = bd->props.brightness;
333 	int rc;
334 
335 	if (!acpi_pcc_retrieve_biosdata(pcc))
336 		return -EIO;
337 
338 	if (bright < pcc->sinf[SINF_AC_MIN_BRIGHT])
339 		bright = pcc->sinf[SINF_AC_MIN_BRIGHT];
340 
341 	if (bright < pcc->sinf[SINF_DC_MIN_BRIGHT])
342 		bright = pcc->sinf[SINF_DC_MIN_BRIGHT];
343 
344 	if (bright < pcc->sinf[SINF_AC_MIN_BRIGHT] ||
345 	    bright > pcc->sinf[SINF_AC_MAX_BRIGHT])
346 		return -EINVAL;
347 
348 	rc = acpi_pcc_write_sset(pcc, SINF_AC_CUR_BRIGHT, bright);
349 	if (rc < 0)
350 		return rc;
351 
352 	return acpi_pcc_write_sset(pcc, SINF_DC_CUR_BRIGHT, bright);
353 }
354 
355 static const struct backlight_ops pcc_backlight_ops = {
356 	.get_brightness	= bl_get,
357 	.update_status	= bl_set_status,
358 };
359 
360 
361 /* sysfs user interface functions */
362 
show_numbatt(struct device * dev,struct device_attribute * attr,char * buf)363 static ssize_t show_numbatt(struct device *dev, struct device_attribute *attr,
364 			    char *buf)
365 {
366 	struct acpi_device *acpi = to_acpi_device(dev);
367 	struct pcc_acpi *pcc = acpi_driver_data(acpi);
368 
369 	if (!acpi_pcc_retrieve_biosdata(pcc))
370 		return -EIO;
371 
372 	return snprintf(buf, PAGE_SIZE, "%u\n", pcc->sinf[SINF_NUM_BATTERIES]);
373 }
374 
show_lcdtype(struct device * dev,struct device_attribute * attr,char * buf)375 static ssize_t show_lcdtype(struct device *dev, struct device_attribute *attr,
376 			    char *buf)
377 {
378 	struct acpi_device *acpi = to_acpi_device(dev);
379 	struct pcc_acpi *pcc = acpi_driver_data(acpi);
380 
381 	if (!acpi_pcc_retrieve_biosdata(pcc))
382 		return -EIO;
383 
384 	return snprintf(buf, PAGE_SIZE, "%u\n", pcc->sinf[SINF_LCD_TYPE]);
385 }
386 
show_mute(struct device * dev,struct device_attribute * attr,char * buf)387 static ssize_t show_mute(struct device *dev, struct device_attribute *attr,
388 			 char *buf)
389 {
390 	struct acpi_device *acpi = to_acpi_device(dev);
391 	struct pcc_acpi *pcc = acpi_driver_data(acpi);
392 
393 	if (!acpi_pcc_retrieve_biosdata(pcc))
394 		return -EIO;
395 
396 	return snprintf(buf, PAGE_SIZE, "%u\n", pcc->sinf[SINF_MUTE]);
397 }
398 
show_sticky(struct device * dev,struct device_attribute * attr,char * buf)399 static ssize_t show_sticky(struct device *dev, struct device_attribute *attr,
400 			   char *buf)
401 {
402 	struct acpi_device *acpi = to_acpi_device(dev);
403 	struct pcc_acpi *pcc = acpi_driver_data(acpi);
404 
405 	if (!acpi_pcc_retrieve_biosdata(pcc))
406 		return -EIO;
407 
408 	return snprintf(buf, PAGE_SIZE, "%u\n", pcc->sinf[SINF_STICKY_KEY]);
409 }
410 
set_sticky(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)411 static ssize_t set_sticky(struct device *dev, struct device_attribute *attr,
412 			  const char *buf, size_t count)
413 {
414 	struct acpi_device *acpi = to_acpi_device(dev);
415 	struct pcc_acpi *pcc = acpi_driver_data(acpi);
416 	int val;
417 
418 	if (count && sscanf(buf, "%i", &val) == 1 &&
419 	    (val == 0 || val == 1)) {
420 		acpi_pcc_write_sset(pcc, SINF_STICKY_KEY, val);
421 		pcc->sticky_mode = val;
422 	}
423 
424 	return count;
425 }
426 
427 static DEVICE_ATTR(numbatt, S_IRUGO, show_numbatt, NULL);
428 static DEVICE_ATTR(lcdtype, S_IRUGO, show_lcdtype, NULL);
429 static DEVICE_ATTR(mute, S_IRUGO, show_mute, NULL);
430 static DEVICE_ATTR(sticky_key, S_IRUGO | S_IWUSR, show_sticky, set_sticky);
431 
432 static struct attribute *pcc_sysfs_entries[] = {
433 	&dev_attr_numbatt.attr,
434 	&dev_attr_lcdtype.attr,
435 	&dev_attr_mute.attr,
436 	&dev_attr_sticky_key.attr,
437 	NULL,
438 };
439 
440 static const struct attribute_group pcc_attr_group = {
441 	.name	= NULL,		/* put in device directory */
442 	.attrs	= pcc_sysfs_entries,
443 };
444 
445 
446 /* hotkey input device driver */
447 
448 static int sleep_keydown_seen;
acpi_pcc_generate_keyinput(struct pcc_acpi * pcc)449 static void acpi_pcc_generate_keyinput(struct pcc_acpi *pcc)
450 {
451 	struct input_dev *hotk_input_dev = pcc->input_dev;
452 	int rc;
453 	unsigned long long result;
454 
455 	rc = acpi_evaluate_integer(pcc->handle, METHOD_HKEY_QUERY,
456 				   NULL, &result);
457 	if (ACPI_FAILURE(rc)) {
458 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
459 				 "error getting hotkey status\n"));
460 		return;
461 	}
462 
463 	/* hack: some firmware sends no key down for sleep / hibernate */
464 	if ((result & 0xf) == 0x7 || (result & 0xf) == 0xa) {
465 		if (result & 0x80)
466 			sleep_keydown_seen = 1;
467 		if (!sleep_keydown_seen)
468 			sparse_keymap_report_event(hotk_input_dev,
469 					result & 0xf, 0x80, false);
470 	}
471 
472 	if (!sparse_keymap_report_event(hotk_input_dev,
473 					result & 0xf, result & 0x80, false))
474 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
475 				  "Unknown hotkey event: %d\n", result));
476 }
477 
acpi_pcc_hotkey_notify(struct acpi_device * device,u32 event)478 static void acpi_pcc_hotkey_notify(struct acpi_device *device, u32 event)
479 {
480 	struct pcc_acpi *pcc = acpi_driver_data(device);
481 
482 	switch (event) {
483 	case HKEY_NOTIFY:
484 		acpi_pcc_generate_keyinput(pcc);
485 		break;
486 	default:
487 		/* nothing to do */
488 		break;
489 	}
490 }
491 
acpi_pcc_init_input(struct pcc_acpi * pcc)492 static int acpi_pcc_init_input(struct pcc_acpi *pcc)
493 {
494 	struct input_dev *input_dev;
495 	int error;
496 
497 	input_dev = input_allocate_device();
498 	if (!input_dev)
499 		return -ENOMEM;
500 
501 	input_dev->name = ACPI_PCC_DRIVER_NAME;
502 	input_dev->phys = ACPI_PCC_INPUT_PHYS;
503 	input_dev->id.bustype = BUS_HOST;
504 	input_dev->id.vendor = 0x0001;
505 	input_dev->id.product = 0x0001;
506 	input_dev->id.version = 0x0100;
507 
508 	error = sparse_keymap_setup(input_dev, panasonic_keymap, NULL);
509 	if (error) {
510 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
511 				  "Unable to setup input device keymap\n"));
512 		goto err_free_dev;
513 	}
514 
515 	error = input_register_device(input_dev);
516 	if (error) {
517 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
518 				  "Unable to register input device\n"));
519 		goto err_free_dev;
520 	}
521 
522 	pcc->input_dev = input_dev;
523 	return 0;
524 
525  err_free_dev:
526 	input_free_device(input_dev);
527 	return error;
528 }
529 
530 /* kernel module interface */
531 
532 #ifdef CONFIG_PM_SLEEP
acpi_pcc_hotkey_resume(struct device * dev)533 static int acpi_pcc_hotkey_resume(struct device *dev)
534 {
535 	struct pcc_acpi *pcc;
536 
537 	if (!dev)
538 		return -EINVAL;
539 
540 	pcc = acpi_driver_data(to_acpi_device(dev));
541 	if (!pcc)
542 		return -EINVAL;
543 
544 	ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Sticky mode restore: %d\n",
545 			  pcc->sticky_mode));
546 
547 	return acpi_pcc_write_sset(pcc, SINF_STICKY_KEY, pcc->sticky_mode);
548 }
549 #endif
550 
acpi_pcc_hotkey_add(struct acpi_device * device)551 static int acpi_pcc_hotkey_add(struct acpi_device *device)
552 {
553 	struct backlight_properties props;
554 	struct pcc_acpi *pcc;
555 	int num_sifr, result;
556 
557 	if (!device)
558 		return -EINVAL;
559 
560 	num_sifr = acpi_pcc_get_sqty(device);
561 
562 	if (num_sifr < 0 || num_sifr > 255) {
563 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "num_sifr out of range"));
564 		return -ENODEV;
565 	}
566 
567 	pcc = kzalloc(sizeof(struct pcc_acpi), GFP_KERNEL);
568 	if (!pcc) {
569 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
570 				  "Couldn't allocate mem for pcc"));
571 		return -ENOMEM;
572 	}
573 
574 	pcc->sinf = kcalloc(num_sifr + 1, sizeof(u32), GFP_KERNEL);
575 	if (!pcc->sinf) {
576 		result = -ENOMEM;
577 		goto out_hotkey;
578 	}
579 
580 	pcc->device = device;
581 	pcc->handle = device->handle;
582 	pcc->num_sifr = num_sifr;
583 	device->driver_data = pcc;
584 	strcpy(acpi_device_name(device), ACPI_PCC_DEVICE_NAME);
585 	strcpy(acpi_device_class(device), ACPI_PCC_CLASS);
586 
587 	result = acpi_pcc_init_input(pcc);
588 	if (result) {
589 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
590 				  "Error installing keyinput handler\n"));
591 		goto out_sinf;
592 	}
593 
594 	if (!acpi_pcc_retrieve_biosdata(pcc)) {
595 		ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
596 				 "Couldn't retrieve BIOS data\n"));
597 		result = -EIO;
598 		goto out_input;
599 	}
600 	/* initialize backlight */
601 	memset(&props, 0, sizeof(struct backlight_properties));
602 	props.type = BACKLIGHT_PLATFORM;
603 	props.max_brightness = pcc->sinf[SINF_AC_MAX_BRIGHT];
604 	pcc->backlight = backlight_device_register("panasonic", NULL, pcc,
605 						   &pcc_backlight_ops, &props);
606 	if (IS_ERR(pcc->backlight)) {
607 		result = PTR_ERR(pcc->backlight);
608 		goto out_input;
609 	}
610 
611 	/* read the initial brightness setting from the hardware */
612 	pcc->backlight->props.brightness = pcc->sinf[SINF_AC_CUR_BRIGHT];
613 
614 	/* read the initial sticky key mode from the hardware */
615 	pcc->sticky_mode = pcc->sinf[SINF_STICKY_KEY];
616 
617 	/* add sysfs attributes */
618 	result = sysfs_create_group(&device->dev.kobj, &pcc_attr_group);
619 	if (result)
620 		goto out_backlight;
621 
622 	return 0;
623 
624 out_backlight:
625 	backlight_device_unregister(pcc->backlight);
626 out_input:
627 	input_unregister_device(pcc->input_dev);
628 out_sinf:
629 	kfree(pcc->sinf);
630 out_hotkey:
631 	kfree(pcc);
632 
633 	return result;
634 }
635 
acpi_pcc_hotkey_remove(struct acpi_device * device)636 static int acpi_pcc_hotkey_remove(struct acpi_device *device)
637 {
638 	struct pcc_acpi *pcc = acpi_driver_data(device);
639 
640 	if (!device || !pcc)
641 		return -EINVAL;
642 
643 	sysfs_remove_group(&device->dev.kobj, &pcc_attr_group);
644 
645 	backlight_device_unregister(pcc->backlight);
646 
647 	input_unregister_device(pcc->input_dev);
648 
649 	kfree(pcc->sinf);
650 	kfree(pcc);
651 
652 	return 0;
653 }
654 
655 module_acpi_driver(acpi_pcc_driver);
656