Merge branch 'acpi-hotplug'
[linux-drm-fsl-dcu.git] / drivers / platform / x86 / fujitsu-laptop.c
1 /*-*-linux-c-*-*/
2
3 /*
4   Copyright (C) 2007,2008 Jonathan Woithe <jwoithe@just42.net>
5   Copyright (C) 2008 Peter Gruber <nokos@gmx.net>
6   Copyright (C) 2008 Tony Vroon <tony@linx.net>
7   Based on earlier work:
8     Copyright (C) 2003 Shane Spencer <shane@bogomip.com>
9     Adrian Yee <brewt-fujitsu@brewt.org>
10
11   Templated from msi-laptop.c and thinkpad_acpi.c which is copyright
12   by its respective authors.
13
14   This program is free software; you can redistribute it and/or modify
15   it under the terms of the GNU General Public License as published by
16   the Free Software Foundation; either version 2 of the License, or
17   (at your option) any later version.
18
19   This program is distributed in the hope that it will be useful, but
20   WITHOUT ANY WARRANTY; without even the implied warranty of
21   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
22   General Public License for more details.
23
24   You should have received a copy of the GNU General Public License
25   along with this program; if not, write to the Free Software
26   Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
27   02110-1301, USA.
28  */
29
30 /*
31  * fujitsu-laptop.c - Fujitsu laptop support, providing access to additional
32  * features made available on a range of Fujitsu laptops including the
33  * P2xxx/P5xxx/S6xxx/S7xxx series.
34  *
35  * This driver exports a few files in /sys/devices/platform/fujitsu-laptop/;
36  * others may be added at a later date.
37  *
38  *   lcd_level - Screen brightness: contains a single integer in the
39  *   range 0..7. (rw)
40  *
41  * In addition to these platform device attributes the driver
42  * registers itself in the Linux backlight control subsystem and is
43  * available to userspace under /sys/class/backlight/fujitsu-laptop/.
44  *
45  * Hotkeys present on certain Fujitsu laptops (eg: the S6xxx series) are
46  * also supported by this driver.
47  *
48  * This driver has been tested on a Fujitsu Lifebook S6410, S7020 and
49  * P8010.  It should work on most P-series and S-series Lifebooks, but
50  * YMMV.
51  *
52  * The module parameter use_alt_lcd_levels switches between different ACPI
53  * brightness controls which are used by different Fujitsu laptops.  In most
54  * cases the correct method is automatically detected. "use_alt_lcd_levels=1"
55  * is applicable for a Fujitsu Lifebook S6410 if autodetection fails.
56  *
57  */
58
59 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
60
61 #include <linux/module.h>
62 #include <linux/kernel.h>
63 #include <linux/init.h>
64 #include <linux/acpi.h>
65 #include <linux/dmi.h>
66 #include <linux/backlight.h>
67 #include <linux/input.h>
68 #include <linux/kfifo.h>
69 #include <linux/video_output.h>
70 #include <linux/platform_device.h>
71 #include <linux/slab.h>
72 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
73 #include <linux/leds.h>
74 #endif
75
76 #define FUJITSU_DRIVER_VERSION "0.6.0"
77
78 #define FUJITSU_LCD_N_LEVELS 8
79
80 #define ACPI_FUJITSU_CLASS              "fujitsu"
81 #define ACPI_FUJITSU_HID                "FUJ02B1"
82 #define ACPI_FUJITSU_DRIVER_NAME        "Fujitsu laptop FUJ02B1 ACPI brightness driver"
83 #define ACPI_FUJITSU_DEVICE_NAME        "Fujitsu FUJ02B1"
84 #define ACPI_FUJITSU_HOTKEY_HID         "FUJ02E3"
85 #define ACPI_FUJITSU_HOTKEY_DRIVER_NAME "Fujitsu laptop FUJ02E3 ACPI hotkeys driver"
86 #define ACPI_FUJITSU_HOTKEY_DEVICE_NAME "Fujitsu FUJ02E3"
87
88 #define ACPI_FUJITSU_NOTIFY_CODE1     0x80
89
90 #define ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS     0x86
91 #define ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS     0x87
92
93 /* FUNC interface - command values */
94 #define FUNC_RFKILL     0x1000
95 #define FUNC_LEDS       0x1001
96 #define FUNC_BUTTONS    0x1002
97 #define FUNC_BACKLIGHT  0x1004
98
99 /* FUNC interface - responses */
100 #define UNSUPPORTED_CMD 0x80000000
101
102 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
103 /* FUNC interface - LED control */
104 #define FUNC_LED_OFF    0x1
105 #define FUNC_LED_ON     0x30001
106 #define KEYBOARD_LAMPS  0x100
107 #define LOGOLAMP_POWERON 0x2000
108 #define LOGOLAMP_ALWAYS  0x4000
109 #endif
110
111 /* Hotkey details */
112 #define KEY1_CODE       0x410   /* codes for the keys in the GIRB register */
113 #define KEY2_CODE       0x411
114 #define KEY3_CODE       0x412
115 #define KEY4_CODE       0x413
116
117 #define MAX_HOTKEY_RINGBUFFER_SIZE 100
118 #define RINGBUFFERSIZE 40
119
120 /* Debugging */
121 #define FUJLAPTOP_LOG      ACPI_FUJITSU_HID ": "
122 #define FUJLAPTOP_ERR      KERN_ERR FUJLAPTOP_LOG
123 #define FUJLAPTOP_NOTICE   KERN_NOTICE FUJLAPTOP_LOG
124 #define FUJLAPTOP_INFO     KERN_INFO FUJLAPTOP_LOG
125 #define FUJLAPTOP_DEBUG    KERN_DEBUG FUJLAPTOP_LOG
126
127 #define FUJLAPTOP_DBG_ALL         0xffff
128 #define FUJLAPTOP_DBG_ERROR       0x0001
129 #define FUJLAPTOP_DBG_WARN        0x0002
130 #define FUJLAPTOP_DBG_INFO        0x0004
131 #define FUJLAPTOP_DBG_TRACE       0x0008
132
133 #define dbg_printk(a_dbg_level, format, arg...) \
134         do { if (dbg_level & a_dbg_level) \
135                 printk(FUJLAPTOP_DEBUG "%s: " format, __func__ , ## arg); \
136         } while (0)
137 #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
138 #define vdbg_printk(a_dbg_level, format, arg...) \
139         dbg_printk(a_dbg_level, format, ## arg)
140 #else
141 #define vdbg_printk(a_dbg_level, format, arg...)
142 #endif
143
144 /* Device controlling the backlight and associated keys */
145 struct fujitsu_t {
146         acpi_handle acpi_handle;
147         struct acpi_device *dev;
148         struct input_dev *input;
149         char phys[32];
150         struct backlight_device *bl_device;
151         struct platform_device *pf_device;
152         int keycode1, keycode2, keycode3, keycode4;
153
154         unsigned int max_brightness;
155         unsigned int brightness_changed;
156         unsigned int brightness_level;
157 };
158
159 static struct fujitsu_t *fujitsu;
160 static int use_alt_lcd_levels = -1;
161 static int disable_brightness_adjust = -1;
162
163 /* Device used to access other hotkeys on the laptop */
164 struct fujitsu_hotkey_t {
165         acpi_handle acpi_handle;
166         struct acpi_device *dev;
167         struct input_dev *input;
168         char phys[32];
169         struct platform_device *pf_device;
170         struct kfifo fifo;
171         spinlock_t fifo_lock;
172         int rfkill_supported;
173         int rfkill_state;
174         int logolamp_registered;
175         int kblamps_registered;
176 };
177
178 static struct fujitsu_hotkey_t *fujitsu_hotkey;
179
180 static void acpi_fujitsu_hotkey_notify(struct acpi_device *device, u32 event);
181
182 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
183 static enum led_brightness logolamp_get(struct led_classdev *cdev);
184 static void logolamp_set(struct led_classdev *cdev,
185                                enum led_brightness brightness);
186
187 static struct led_classdev logolamp_led = {
188  .name = "fujitsu::logolamp",
189  .brightness_get = logolamp_get,
190  .brightness_set = logolamp_set
191 };
192
193 static enum led_brightness kblamps_get(struct led_classdev *cdev);
194 static void kblamps_set(struct led_classdev *cdev,
195                                enum led_brightness brightness);
196
197 static struct led_classdev kblamps_led = {
198  .name = "fujitsu::kblamps",
199  .brightness_get = kblamps_get,
200  .brightness_set = kblamps_set
201 };
202 #endif
203
204 #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
205 static u32 dbg_level = 0x03;
206 #endif
207
208 static void acpi_fujitsu_notify(struct acpi_device *device, u32 event);
209
210 /* Fujitsu ACPI interface function */
211
212 static int call_fext_func(int cmd, int arg0, int arg1, int arg2)
213 {
214         acpi_status status = AE_OK;
215         union acpi_object params[4] = {
216         { .type = ACPI_TYPE_INTEGER },
217         { .type = ACPI_TYPE_INTEGER },
218         { .type = ACPI_TYPE_INTEGER },
219         { .type = ACPI_TYPE_INTEGER }
220         };
221         struct acpi_object_list arg_list = { 4, &params[0] };
222         unsigned long long value;
223         acpi_handle handle = NULL;
224
225         status = acpi_get_handle(fujitsu_hotkey->acpi_handle, "FUNC", &handle);
226         if (ACPI_FAILURE(status)) {
227                 vdbg_printk(FUJLAPTOP_DBG_ERROR,
228                                 "FUNC interface is not present\n");
229                 return -ENODEV;
230         }
231
232         params[0].integer.value = cmd;
233         params[1].integer.value = arg0;
234         params[2].integer.value = arg1;
235         params[3].integer.value = arg2;
236
237         status = acpi_evaluate_integer(handle, NULL, &arg_list, &value);
238         if (ACPI_FAILURE(status)) {
239                 vdbg_printk(FUJLAPTOP_DBG_WARN,
240                         "FUNC 0x%x (args 0x%x, 0x%x, 0x%x) call failed\n",
241                                 cmd, arg0, arg1, arg2);
242                 return -ENODEV;
243         }
244
245         vdbg_printk(FUJLAPTOP_DBG_TRACE,
246                 "FUNC 0x%x (args 0x%x, 0x%x, 0x%x) returned 0x%x\n",
247                         cmd, arg0, arg1, arg2, (int)value);
248         return value;
249 }
250
251 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
252 /* LED class callbacks */
253
254 static void logolamp_set(struct led_classdev *cdev,
255                                enum led_brightness brightness)
256 {
257         if (brightness >= LED_FULL) {
258                 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_ON);
259                 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_ALWAYS, FUNC_LED_ON);
260         } else if (brightness >= LED_HALF) {
261                 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_ON);
262                 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_ALWAYS, FUNC_LED_OFF);
263         } else {
264                 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_OFF);
265         }
266 }
267
268 static void kblamps_set(struct led_classdev *cdev,
269                                enum led_brightness brightness)
270 {
271         if (brightness >= LED_FULL)
272                 call_fext_func(FUNC_LEDS, 0x1, KEYBOARD_LAMPS, FUNC_LED_ON);
273         else
274                 call_fext_func(FUNC_LEDS, 0x1, KEYBOARD_LAMPS, FUNC_LED_OFF);
275 }
276
277 static enum led_brightness logolamp_get(struct led_classdev *cdev)
278 {
279         enum led_brightness brightness = LED_OFF;
280         int poweron, always;
281
282         poweron = call_fext_func(FUNC_LEDS, 0x2, LOGOLAMP_POWERON, 0x0);
283         if (poweron == FUNC_LED_ON) {
284                 brightness = LED_HALF;
285                 always = call_fext_func(FUNC_LEDS, 0x2, LOGOLAMP_ALWAYS, 0x0);
286                 if (always == FUNC_LED_ON)
287                         brightness = LED_FULL;
288         }
289         return brightness;
290 }
291
292 static enum led_brightness kblamps_get(struct led_classdev *cdev)
293 {
294         enum led_brightness brightness = LED_OFF;
295
296         if (call_fext_func(FUNC_LEDS, 0x2, KEYBOARD_LAMPS, 0x0) == FUNC_LED_ON)
297                 brightness = LED_FULL;
298
299         return brightness;
300 }
301 #endif
302
303 /* Hardware access for LCD brightness control */
304
305 static int set_lcd_level(int level)
306 {
307         acpi_status status = AE_OK;
308         acpi_handle handle = NULL;
309
310         vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBLL [%d]\n",
311                     level);
312
313         if (level < 0 || level >= fujitsu->max_brightness)
314                 return -EINVAL;
315
316         status = acpi_get_handle(fujitsu->acpi_handle, "SBLL", &handle);
317         if (ACPI_FAILURE(status)) {
318                 vdbg_printk(FUJLAPTOP_DBG_ERROR, "SBLL not present\n");
319                 return -ENODEV;
320         }
321
322
323         status = acpi_execute_simple_method(handle, NULL, level);
324         if (ACPI_FAILURE(status))
325                 return -ENODEV;
326
327         return 0;
328 }
329
330 static int set_lcd_level_alt(int level)
331 {
332         acpi_status status = AE_OK;
333         acpi_handle handle = NULL;
334
335         vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBL2 [%d]\n",
336                     level);
337
338         if (level < 0 || level >= fujitsu->max_brightness)
339                 return -EINVAL;
340
341         status = acpi_get_handle(fujitsu->acpi_handle, "SBL2", &handle);
342         if (ACPI_FAILURE(status)) {
343                 vdbg_printk(FUJLAPTOP_DBG_ERROR, "SBL2 not present\n");
344                 return -ENODEV;
345         }
346
347         status = acpi_execute_simple_method(handle, NULL, level);
348         if (ACPI_FAILURE(status))
349                 return -ENODEV;
350
351         return 0;
352 }
353
354 static int get_lcd_level(void)
355 {
356         unsigned long long state = 0;
357         acpi_status status = AE_OK;
358
359         vdbg_printk(FUJLAPTOP_DBG_TRACE, "get lcd level via GBLL\n");
360
361         status =
362             acpi_evaluate_integer(fujitsu->acpi_handle, "GBLL", NULL, &state);
363         if (ACPI_FAILURE(status))
364                 return 0;
365
366         fujitsu->brightness_level = state & 0x0fffffff;
367
368         if (state & 0x80000000)
369                 fujitsu->brightness_changed = 1;
370         else
371                 fujitsu->brightness_changed = 0;
372
373         return fujitsu->brightness_level;
374 }
375
376 static int get_max_brightness(void)
377 {
378         unsigned long long state = 0;
379         acpi_status status = AE_OK;
380
381         vdbg_printk(FUJLAPTOP_DBG_TRACE, "get max lcd level via RBLL\n");
382
383         status =
384             acpi_evaluate_integer(fujitsu->acpi_handle, "RBLL", NULL, &state);
385         if (ACPI_FAILURE(status))
386                 return -1;
387
388         fujitsu->max_brightness = state;
389
390         return fujitsu->max_brightness;
391 }
392
393 /* Backlight device stuff */
394
395 static int bl_get_brightness(struct backlight_device *b)
396 {
397         return get_lcd_level();
398 }
399
400 static int bl_update_status(struct backlight_device *b)
401 {
402         int ret;
403         if (b->props.power == 4)
404                 ret = call_fext_func(FUNC_BACKLIGHT, 0x1, 0x4, 0x3);
405         else
406                 ret = call_fext_func(FUNC_BACKLIGHT, 0x1, 0x4, 0x0);
407         if (ret != 0)
408                 vdbg_printk(FUJLAPTOP_DBG_ERROR,
409                         "Unable to adjust backlight power, error code %i\n",
410                         ret);
411
412         if (use_alt_lcd_levels)
413                 ret = set_lcd_level_alt(b->props.brightness);
414         else
415                 ret = set_lcd_level(b->props.brightness);
416         if (ret != 0)
417                 vdbg_printk(FUJLAPTOP_DBG_ERROR,
418                         "Unable to adjust LCD brightness, error code %i\n",
419                         ret);
420         return ret;
421 }
422
423 static const struct backlight_ops fujitsubl_ops = {
424         .get_brightness = bl_get_brightness,
425         .update_status = bl_update_status,
426 };
427
428 /* Platform LCD brightness device */
429
430 static ssize_t
431 show_max_brightness(struct device *dev,
432                     struct device_attribute *attr, char *buf)
433 {
434
435         int ret;
436
437         ret = get_max_brightness();
438         if (ret < 0)
439                 return ret;
440
441         return sprintf(buf, "%i\n", ret);
442 }
443
444 static ssize_t
445 show_brightness_changed(struct device *dev,
446                         struct device_attribute *attr, char *buf)
447 {
448
449         int ret;
450
451         ret = fujitsu->brightness_changed;
452         if (ret < 0)
453                 return ret;
454
455         return sprintf(buf, "%i\n", ret);
456 }
457
458 static ssize_t show_lcd_level(struct device *dev,
459                               struct device_attribute *attr, char *buf)
460 {
461
462         int ret;
463
464         ret = get_lcd_level();
465         if (ret < 0)
466                 return ret;
467
468         return sprintf(buf, "%i\n", ret);
469 }
470
471 static ssize_t store_lcd_level(struct device *dev,
472                                struct device_attribute *attr, const char *buf,
473                                size_t count)
474 {
475
476         int level, ret;
477
478         if (sscanf(buf, "%i", &level) != 1
479             || (level < 0 || level >= fujitsu->max_brightness))
480                 return -EINVAL;
481
482         if (use_alt_lcd_levels)
483                 ret = set_lcd_level_alt(level);
484         else
485                 ret = set_lcd_level(level);
486         if (ret < 0)
487                 return ret;
488
489         ret = get_lcd_level();
490         if (ret < 0)
491                 return ret;
492
493         return count;
494 }
495
496 static ssize_t
497 ignore_store(struct device *dev,
498              struct device_attribute *attr, const char *buf, size_t count)
499 {
500         return count;
501 }
502
503 static ssize_t
504 show_lid_state(struct device *dev,
505                         struct device_attribute *attr, char *buf)
506 {
507         if (!(fujitsu_hotkey->rfkill_supported & 0x100))
508                 return sprintf(buf, "unknown\n");
509         if (fujitsu_hotkey->rfkill_state & 0x100)
510                 return sprintf(buf, "open\n");
511         else
512                 return sprintf(buf, "closed\n");
513 }
514
515 static ssize_t
516 show_dock_state(struct device *dev,
517                         struct device_attribute *attr, char *buf)
518 {
519         if (!(fujitsu_hotkey->rfkill_supported & 0x200))
520                 return sprintf(buf, "unknown\n");
521         if (fujitsu_hotkey->rfkill_state & 0x200)
522                 return sprintf(buf, "docked\n");
523         else
524                 return sprintf(buf, "undocked\n");
525 }
526
527 static ssize_t
528 show_radios_state(struct device *dev,
529                         struct device_attribute *attr, char *buf)
530 {
531         if (!(fujitsu_hotkey->rfkill_supported & 0x20))
532                 return sprintf(buf, "unknown\n");
533         if (fujitsu_hotkey->rfkill_state & 0x20)
534                 return sprintf(buf, "on\n");
535         else
536                 return sprintf(buf, "killed\n");
537 }
538
539 static DEVICE_ATTR(max_brightness, 0444, show_max_brightness, ignore_store);
540 static DEVICE_ATTR(brightness_changed, 0444, show_brightness_changed,
541                    ignore_store);
542 static DEVICE_ATTR(lcd_level, 0644, show_lcd_level, store_lcd_level);
543 static DEVICE_ATTR(lid, 0444, show_lid_state, ignore_store);
544 static DEVICE_ATTR(dock, 0444, show_dock_state, ignore_store);
545 static DEVICE_ATTR(radios, 0444, show_radios_state, ignore_store);
546
547 static struct attribute *fujitsupf_attributes[] = {
548         &dev_attr_brightness_changed.attr,
549         &dev_attr_max_brightness.attr,
550         &dev_attr_lcd_level.attr,
551         &dev_attr_lid.attr,
552         &dev_attr_dock.attr,
553         &dev_attr_radios.attr,
554         NULL
555 };
556
557 static struct attribute_group fujitsupf_attribute_group = {
558         .attrs = fujitsupf_attributes
559 };
560
561 static struct platform_driver fujitsupf_driver = {
562         .driver = {
563                    .name = "fujitsu-laptop",
564                    .owner = THIS_MODULE,
565                    }
566 };
567
568 static void dmi_check_cb_common(const struct dmi_system_id *id)
569 {
570         pr_info("Identified laptop model '%s'\n", id->ident);
571         if (use_alt_lcd_levels == -1) {
572                 if (acpi_has_method(NULL,
573                                 "\\_SB.PCI0.LPCB.FJEX.SBL2"))
574                         use_alt_lcd_levels = 1;
575                 else
576                         use_alt_lcd_levels = 0;
577                 vdbg_printk(FUJLAPTOP_DBG_TRACE, "auto-detected usealt as "
578                         "%i\n", use_alt_lcd_levels);
579         }
580 }
581
582 static int dmi_check_cb_s6410(const struct dmi_system_id *id)
583 {
584         dmi_check_cb_common(id);
585         fujitsu->keycode1 = KEY_SCREENLOCK;     /* "Lock" */
586         fujitsu->keycode2 = KEY_HELP;   /* "Mobility Center" */
587         return 1;
588 }
589
590 static int dmi_check_cb_s6420(const struct dmi_system_id *id)
591 {
592         dmi_check_cb_common(id);
593         fujitsu->keycode1 = KEY_SCREENLOCK;     /* "Lock" */
594         fujitsu->keycode2 = KEY_HELP;   /* "Mobility Center" */
595         return 1;
596 }
597
598 static int dmi_check_cb_p8010(const struct dmi_system_id *id)
599 {
600         dmi_check_cb_common(id);
601         fujitsu->keycode1 = KEY_HELP;   /* "Support" */
602         fujitsu->keycode3 = KEY_SWITCHVIDEOMODE;        /* "Presentation" */
603         fujitsu->keycode4 = KEY_WWW;    /* "Internet" */
604         return 1;
605 }
606
607 static struct dmi_system_id fujitsu_dmi_table[] = {
608         {
609          .ident = "Fujitsu Siemens S6410",
610          .matches = {
611                      DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
612                      DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6410"),
613                      },
614          .callback = dmi_check_cb_s6410},
615         {
616          .ident = "Fujitsu Siemens S6420",
617          .matches = {
618                      DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
619                      DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6420"),
620                      },
621          .callback = dmi_check_cb_s6420},
622         {
623          .ident = "Fujitsu LifeBook P8010",
624          .matches = {
625                      DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"),
626                      DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook P8010"),
627                      },
628          .callback = dmi_check_cb_p8010},
629         {}
630 };
631
632 /* ACPI device for LCD brightness control */
633
634 static int acpi_fujitsu_add(struct acpi_device *device)
635 {
636         int result = 0;
637         int state = 0;
638         struct input_dev *input;
639         int error;
640
641         if (!device)
642                 return -EINVAL;
643
644         fujitsu->acpi_handle = device->handle;
645         sprintf(acpi_device_name(device), "%s", ACPI_FUJITSU_DEVICE_NAME);
646         sprintf(acpi_device_class(device), "%s", ACPI_FUJITSU_CLASS);
647         device->driver_data = fujitsu;
648
649         fujitsu->input = input = input_allocate_device();
650         if (!input) {
651                 error = -ENOMEM;
652                 goto err_stop;
653         }
654
655         snprintf(fujitsu->phys, sizeof(fujitsu->phys),
656                  "%s/video/input0", acpi_device_hid(device));
657
658         input->name = acpi_device_name(device);
659         input->phys = fujitsu->phys;
660         input->id.bustype = BUS_HOST;
661         input->id.product = 0x06;
662         input->dev.parent = &device->dev;
663         input->evbit[0] = BIT(EV_KEY);
664         set_bit(KEY_BRIGHTNESSUP, input->keybit);
665         set_bit(KEY_BRIGHTNESSDOWN, input->keybit);
666         set_bit(KEY_UNKNOWN, input->keybit);
667
668         error = input_register_device(input);
669         if (error)
670                 goto err_free_input_dev;
671
672         result = acpi_bus_update_power(fujitsu->acpi_handle, &state);
673         if (result) {
674                 pr_err("Error reading power state\n");
675                 goto err_unregister_input_dev;
676         }
677
678         pr_info("ACPI: %s [%s] (%s)\n",
679                acpi_device_name(device), acpi_device_bid(device),
680                !device->power.state ? "on" : "off");
681
682         fujitsu->dev = device;
683
684         if (acpi_has_method(device->handle, METHOD_NAME__INI)) {
685                 vdbg_printk(FUJLAPTOP_DBG_INFO, "Invoking _INI\n");
686                 if (ACPI_FAILURE
687                     (acpi_evaluate_object
688                      (device->handle, METHOD_NAME__INI, NULL, NULL)))
689                         pr_err("_INI Method failed\n");
690         }
691
692         /* do config (detect defaults) */
693         use_alt_lcd_levels = use_alt_lcd_levels == 1 ? 1 : 0;
694         disable_brightness_adjust = disable_brightness_adjust == 1 ? 1 : 0;
695         vdbg_printk(FUJLAPTOP_DBG_INFO,
696                     "config: [alt interface: %d], [adjust disable: %d]\n",
697                     use_alt_lcd_levels, disable_brightness_adjust);
698
699         if (get_max_brightness() <= 0)
700                 fujitsu->max_brightness = FUJITSU_LCD_N_LEVELS;
701         get_lcd_level();
702
703         return result;
704
705 err_unregister_input_dev:
706         input_unregister_device(input);
707         input = NULL;
708 err_free_input_dev:
709         input_free_device(input);
710 err_stop:
711         return result;
712 }
713
714 static int acpi_fujitsu_remove(struct acpi_device *device)
715 {
716         struct fujitsu_t *fujitsu = acpi_driver_data(device);
717         struct input_dev *input = fujitsu->input;
718
719         input_unregister_device(input);
720
721         fujitsu->acpi_handle = NULL;
722
723         return 0;
724 }
725
726 /* Brightness notify */
727
728 static void acpi_fujitsu_notify(struct acpi_device *device, u32 event)
729 {
730         struct input_dev *input;
731         int keycode;
732         int oldb, newb;
733
734         input = fujitsu->input;
735
736         switch (event) {
737         case ACPI_FUJITSU_NOTIFY_CODE1:
738                 keycode = 0;
739                 oldb = fujitsu->brightness_level;
740                 get_lcd_level();
741                 newb = fujitsu->brightness_level;
742
743                 vdbg_printk(FUJLAPTOP_DBG_TRACE,
744                             "brightness button event [%i -> %i (%i)]\n",
745                             oldb, newb, fujitsu->brightness_changed);
746
747                 if (oldb < newb) {
748                         if (disable_brightness_adjust != 1) {
749                                 if (use_alt_lcd_levels)
750                                         set_lcd_level_alt(newb);
751                                 else
752                                         set_lcd_level(newb);
753                         }
754                         keycode = KEY_BRIGHTNESSUP;
755                 } else if (oldb > newb) {
756                         if (disable_brightness_adjust != 1) {
757                                 if (use_alt_lcd_levels)
758                                         set_lcd_level_alt(newb);
759                                 else
760                                         set_lcd_level(newb);
761                         }
762                         keycode = KEY_BRIGHTNESSDOWN;
763                 }
764                 break;
765         default:
766                 keycode = KEY_UNKNOWN;
767                 vdbg_printk(FUJLAPTOP_DBG_WARN,
768                             "unsupported event [0x%x]\n", event);
769                 break;
770         }
771
772         if (keycode != 0) {
773                 input_report_key(input, keycode, 1);
774                 input_sync(input);
775                 input_report_key(input, keycode, 0);
776                 input_sync(input);
777         }
778 }
779
780 /* ACPI device for hotkey handling */
781
782 static int acpi_fujitsu_hotkey_add(struct acpi_device *device)
783 {
784         int result = 0;
785         int state = 0;
786         struct input_dev *input;
787         int error;
788         int i;
789
790         if (!device)
791                 return -EINVAL;
792
793         fujitsu_hotkey->acpi_handle = device->handle;
794         sprintf(acpi_device_name(device), "%s",
795                 ACPI_FUJITSU_HOTKEY_DEVICE_NAME);
796         sprintf(acpi_device_class(device), "%s", ACPI_FUJITSU_CLASS);
797         device->driver_data = fujitsu_hotkey;
798
799         /* kfifo */
800         spin_lock_init(&fujitsu_hotkey->fifo_lock);
801         error = kfifo_alloc(&fujitsu_hotkey->fifo, RINGBUFFERSIZE * sizeof(int),
802                         GFP_KERNEL);
803         if (error) {
804                 pr_err("kfifo_alloc failed\n");
805                 goto err_stop;
806         }
807
808         fujitsu_hotkey->input = input = input_allocate_device();
809         if (!input) {
810                 error = -ENOMEM;
811                 goto err_free_fifo;
812         }
813
814         snprintf(fujitsu_hotkey->phys, sizeof(fujitsu_hotkey->phys),
815                  "%s/video/input0", acpi_device_hid(device));
816
817         input->name = acpi_device_name(device);
818         input->phys = fujitsu_hotkey->phys;
819         input->id.bustype = BUS_HOST;
820         input->id.product = 0x06;
821         input->dev.parent = &device->dev;
822
823         set_bit(EV_KEY, input->evbit);
824         set_bit(fujitsu->keycode1, input->keybit);
825         set_bit(fujitsu->keycode2, input->keybit);
826         set_bit(fujitsu->keycode3, input->keybit);
827         set_bit(fujitsu->keycode4, input->keybit);
828         set_bit(KEY_UNKNOWN, input->keybit);
829
830         error = input_register_device(input);
831         if (error)
832                 goto err_free_input_dev;
833
834         result = acpi_bus_update_power(fujitsu_hotkey->acpi_handle, &state);
835         if (result) {
836                 pr_err("Error reading power state\n");
837                 goto err_unregister_input_dev;
838         }
839
840         pr_info("ACPI: %s [%s] (%s)\n",
841                 acpi_device_name(device), acpi_device_bid(device),
842                 !device->power.state ? "on" : "off");
843
844         fujitsu_hotkey->dev = device;
845
846         if (acpi_has_method(device->handle, METHOD_NAME__INI)) {
847                 vdbg_printk(FUJLAPTOP_DBG_INFO, "Invoking _INI\n");
848                 if (ACPI_FAILURE
849                     (acpi_evaluate_object
850                      (device->handle, METHOD_NAME__INI, NULL, NULL)))
851                         pr_err("_INI Method failed\n");
852         }
853
854         i = 0;
855         while (call_fext_func(FUNC_BUTTONS, 0x1, 0x0, 0x0) != 0
856                 && (i++) < MAX_HOTKEY_RINGBUFFER_SIZE)
857                 ; /* No action, result is discarded */
858         vdbg_printk(FUJLAPTOP_DBG_INFO, "Discarded %i ringbuffer entries\n", i);
859
860         fujitsu_hotkey->rfkill_supported =
861                 call_fext_func(FUNC_RFKILL, 0x0, 0x0, 0x0);
862
863         /* Make sure our bitmask of supported functions is cleared if the
864            RFKILL function block is not implemented, like on the S7020. */
865         if (fujitsu_hotkey->rfkill_supported == UNSUPPORTED_CMD)
866                 fujitsu_hotkey->rfkill_supported = 0;
867
868         if (fujitsu_hotkey->rfkill_supported)
869                 fujitsu_hotkey->rfkill_state =
870                         call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
871
872         /* Suspect this is a keymap of the application panel, print it */
873         pr_info("BTNI: [0x%x]\n", call_fext_func(FUNC_BUTTONS, 0x0, 0x0, 0x0));
874
875 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
876         if (call_fext_func(FUNC_LEDS, 0x0, 0x0, 0x0) & LOGOLAMP_POWERON) {
877                 result = led_classdev_register(&fujitsu->pf_device->dev,
878                                                 &logolamp_led);
879                 if (result == 0) {
880                         fujitsu_hotkey->logolamp_registered = 1;
881                 } else {
882                         pr_err("Could not register LED handler for logo lamp, error %i\n",
883                                result);
884                 }
885         }
886
887         if ((call_fext_func(FUNC_LEDS, 0x0, 0x0, 0x0) & KEYBOARD_LAMPS) &&
888            (call_fext_func(FUNC_BUTTONS, 0x0, 0x0, 0x0) == 0x0)) {
889                 result = led_classdev_register(&fujitsu->pf_device->dev,
890                                                 &kblamps_led);
891                 if (result == 0) {
892                         fujitsu_hotkey->kblamps_registered = 1;
893                 } else {
894                         pr_err("Could not register LED handler for keyboard lamps, error %i\n",
895                                result);
896                 }
897         }
898 #endif
899
900         return result;
901
902 err_unregister_input_dev:
903         input_unregister_device(input);
904         input = NULL;
905 err_free_input_dev:
906         input_free_device(input);
907 err_free_fifo:
908         kfifo_free(&fujitsu_hotkey->fifo);
909 err_stop:
910         return result;
911 }
912
913 static int acpi_fujitsu_hotkey_remove(struct acpi_device *device)
914 {
915         struct fujitsu_hotkey_t *fujitsu_hotkey = acpi_driver_data(device);
916         struct input_dev *input = fujitsu_hotkey->input;
917
918 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
919         if (fujitsu_hotkey->logolamp_registered)
920                 led_classdev_unregister(&logolamp_led);
921
922         if (fujitsu_hotkey->kblamps_registered)
923                 led_classdev_unregister(&kblamps_led);
924 #endif
925
926         input_unregister_device(input);
927
928         kfifo_free(&fujitsu_hotkey->fifo);
929
930         fujitsu_hotkey->acpi_handle = NULL;
931
932         return 0;
933 }
934
935 static void acpi_fujitsu_hotkey_notify(struct acpi_device *device, u32 event)
936 {
937         struct input_dev *input;
938         int keycode, keycode_r;
939         unsigned int irb = 1;
940         int i, status;
941
942         input = fujitsu_hotkey->input;
943
944         if (fujitsu_hotkey->rfkill_supported)
945                 fujitsu_hotkey->rfkill_state =
946                         call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
947
948         switch (event) {
949         case ACPI_FUJITSU_NOTIFY_CODE1:
950                 i = 0;
951                 while ((irb =
952                         call_fext_func(FUNC_BUTTONS, 0x1, 0x0, 0x0)) != 0
953                                 && (i++) < MAX_HOTKEY_RINGBUFFER_SIZE) {
954                         switch (irb & 0x4ff) {
955                         case KEY1_CODE:
956                                 keycode = fujitsu->keycode1;
957                                 break;
958                         case KEY2_CODE:
959                                 keycode = fujitsu->keycode2;
960                                 break;
961                         case KEY3_CODE:
962                                 keycode = fujitsu->keycode3;
963                                 break;
964                         case KEY4_CODE:
965                                 keycode = fujitsu->keycode4;
966                                 break;
967                         case 0:
968                                 keycode = 0;
969                                 break;
970                         default:
971                                 vdbg_printk(FUJLAPTOP_DBG_WARN,
972                                             "Unknown GIRB result [%x]\n", irb);
973                                 keycode = -1;
974                                 break;
975                         }
976                         if (keycode > 0) {
977                                 vdbg_printk(FUJLAPTOP_DBG_TRACE,
978                                         "Push keycode into ringbuffer [%d]\n",
979                                         keycode);
980                                 status = kfifo_in_locked(&fujitsu_hotkey->fifo,
981                                                    (unsigned char *)&keycode,
982                                                    sizeof(keycode),
983                                                    &fujitsu_hotkey->fifo_lock);
984                                 if (status != sizeof(keycode)) {
985                                         vdbg_printk(FUJLAPTOP_DBG_WARN,
986                                             "Could not push keycode [0x%x]\n",
987                                             keycode);
988                                 } else {
989                                         input_report_key(input, keycode, 1);
990                                         input_sync(input);
991                                 }
992                         } else if (keycode == 0) {
993                                 while ((status =
994                                         kfifo_out_locked(
995                                          &fujitsu_hotkey->fifo,
996                                          (unsigned char *) &keycode_r,
997                                          sizeof(keycode_r),
998                                          &fujitsu_hotkey->fifo_lock))
999                                          == sizeof(keycode_r)) {
1000                                         input_report_key(input, keycode_r, 0);
1001                                         input_sync(input);
1002                                         vdbg_printk(FUJLAPTOP_DBG_TRACE,
1003                                           "Pop keycode from ringbuffer [%d]\n",
1004                                           keycode_r);
1005                                 }
1006                         }
1007                 }
1008
1009                 break;
1010         default:
1011                 keycode = KEY_UNKNOWN;
1012                 vdbg_printk(FUJLAPTOP_DBG_WARN,
1013                             "Unsupported event [0x%x]\n", event);
1014                 input_report_key(input, keycode, 1);
1015                 input_sync(input);
1016                 input_report_key(input, keycode, 0);
1017                 input_sync(input);
1018                 break;
1019         }
1020 }
1021
1022 /* Initialization */
1023
1024 static const struct acpi_device_id fujitsu_device_ids[] = {
1025         {ACPI_FUJITSU_HID, 0},
1026         {"", 0},
1027 };
1028
1029 static struct acpi_driver acpi_fujitsu_driver = {
1030         .name = ACPI_FUJITSU_DRIVER_NAME,
1031         .class = ACPI_FUJITSU_CLASS,
1032         .ids = fujitsu_device_ids,
1033         .ops = {
1034                 .add = acpi_fujitsu_add,
1035                 .remove = acpi_fujitsu_remove,
1036                 .notify = acpi_fujitsu_notify,
1037                 },
1038 };
1039
1040 static const struct acpi_device_id fujitsu_hotkey_device_ids[] = {
1041         {ACPI_FUJITSU_HOTKEY_HID, 0},
1042         {"", 0},
1043 };
1044
1045 static struct acpi_driver acpi_fujitsu_hotkey_driver = {
1046         .name = ACPI_FUJITSU_HOTKEY_DRIVER_NAME,
1047         .class = ACPI_FUJITSU_CLASS,
1048         .ids = fujitsu_hotkey_device_ids,
1049         .ops = {
1050                 .add = acpi_fujitsu_hotkey_add,
1051                 .remove = acpi_fujitsu_hotkey_remove,
1052                 .notify = acpi_fujitsu_hotkey_notify,
1053                 },
1054 };
1055
1056 static int __init fujitsu_init(void)
1057 {
1058         int ret, result, max_brightness;
1059
1060         if (acpi_disabled)
1061                 return -ENODEV;
1062
1063         fujitsu = kzalloc(sizeof(struct fujitsu_t), GFP_KERNEL);
1064         if (!fujitsu)
1065                 return -ENOMEM;
1066         fujitsu->keycode1 = KEY_PROG1;
1067         fujitsu->keycode2 = KEY_PROG2;
1068         fujitsu->keycode3 = KEY_PROG3;
1069         fujitsu->keycode4 = KEY_PROG4;
1070         dmi_check_system(fujitsu_dmi_table);
1071
1072         result = acpi_bus_register_driver(&acpi_fujitsu_driver);
1073         if (result < 0) {
1074                 ret = -ENODEV;
1075                 goto fail_acpi;
1076         }
1077
1078         /* Register platform stuff */
1079
1080         fujitsu->pf_device = platform_device_alloc("fujitsu-laptop", -1);
1081         if (!fujitsu->pf_device) {
1082                 ret = -ENOMEM;
1083                 goto fail_platform_driver;
1084         }
1085
1086         ret = platform_device_add(fujitsu->pf_device);
1087         if (ret)
1088                 goto fail_platform_device1;
1089
1090         ret =
1091             sysfs_create_group(&fujitsu->pf_device->dev.kobj,
1092                                &fujitsupf_attribute_group);
1093         if (ret)
1094                 goto fail_platform_device2;
1095
1096         /* Register backlight stuff */
1097
1098         if (!acpi_video_backlight_support()) {
1099                 struct backlight_properties props;
1100
1101                 memset(&props, 0, sizeof(struct backlight_properties));
1102                 max_brightness = fujitsu->max_brightness;
1103                 props.type = BACKLIGHT_PLATFORM;
1104                 props.max_brightness = max_brightness - 1;
1105                 fujitsu->bl_device = backlight_device_register("fujitsu-laptop",
1106                                                                NULL, NULL,
1107                                                                &fujitsubl_ops,
1108                                                                &props);
1109                 if (IS_ERR(fujitsu->bl_device)) {
1110                         ret = PTR_ERR(fujitsu->bl_device);
1111                         fujitsu->bl_device = NULL;
1112                         goto fail_sysfs_group;
1113                 }
1114                 fujitsu->bl_device->props.brightness = fujitsu->brightness_level;
1115         }
1116
1117         ret = platform_driver_register(&fujitsupf_driver);
1118         if (ret)
1119                 goto fail_backlight;
1120
1121         /* Register hotkey driver */
1122
1123         fujitsu_hotkey = kzalloc(sizeof(struct fujitsu_hotkey_t), GFP_KERNEL);
1124         if (!fujitsu_hotkey) {
1125                 ret = -ENOMEM;
1126                 goto fail_hotkey;
1127         }
1128
1129         result = acpi_bus_register_driver(&acpi_fujitsu_hotkey_driver);
1130         if (result < 0) {
1131                 ret = -ENODEV;
1132                 goto fail_hotkey1;
1133         }
1134
1135         /* Sync backlight power status (needs FUJ02E3 device, hence deferred) */
1136
1137         if (!acpi_video_backlight_support()) {
1138                 if (call_fext_func(FUNC_BACKLIGHT, 0x2, 0x4, 0x0) == 3)
1139                         fujitsu->bl_device->props.power = 4;
1140                 else
1141                         fujitsu->bl_device->props.power = 0;
1142         }
1143
1144         pr_info("driver " FUJITSU_DRIVER_VERSION " successfully loaded\n");
1145
1146         return 0;
1147
1148 fail_hotkey1:
1149         kfree(fujitsu_hotkey);
1150 fail_hotkey:
1151         platform_driver_unregister(&fujitsupf_driver);
1152 fail_backlight:
1153         if (fujitsu->bl_device)
1154                 backlight_device_unregister(fujitsu->bl_device);
1155 fail_sysfs_group:
1156         sysfs_remove_group(&fujitsu->pf_device->dev.kobj,
1157                            &fujitsupf_attribute_group);
1158 fail_platform_device2:
1159         platform_device_del(fujitsu->pf_device);
1160 fail_platform_device1:
1161         platform_device_put(fujitsu->pf_device);
1162 fail_platform_driver:
1163         acpi_bus_unregister_driver(&acpi_fujitsu_driver);
1164 fail_acpi:
1165         kfree(fujitsu);
1166
1167         return ret;
1168 }
1169
1170 static void __exit fujitsu_cleanup(void)
1171 {
1172         acpi_bus_unregister_driver(&acpi_fujitsu_hotkey_driver);
1173
1174         kfree(fujitsu_hotkey);
1175
1176         platform_driver_unregister(&fujitsupf_driver);
1177
1178         if (fujitsu->bl_device)
1179                 backlight_device_unregister(fujitsu->bl_device);
1180
1181         sysfs_remove_group(&fujitsu->pf_device->dev.kobj,
1182                            &fujitsupf_attribute_group);
1183
1184         platform_device_unregister(fujitsu->pf_device);
1185
1186         acpi_bus_unregister_driver(&acpi_fujitsu_driver);
1187
1188         kfree(fujitsu);
1189
1190         pr_info("driver unloaded\n");
1191 }
1192
1193 module_init(fujitsu_init);
1194 module_exit(fujitsu_cleanup);
1195
1196 module_param(use_alt_lcd_levels, uint, 0644);
1197 MODULE_PARM_DESC(use_alt_lcd_levels,
1198                  "Use alternative interface for lcd_levels (needed for Lifebook s6410).");
1199 module_param(disable_brightness_adjust, uint, 0644);
1200 MODULE_PARM_DESC(disable_brightness_adjust, "Disable brightness adjustment .");
1201 #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
1202 module_param_named(debug, dbg_level, uint, 0644);
1203 MODULE_PARM_DESC(debug, "Sets debug level bit-mask");
1204 #endif
1205
1206 MODULE_AUTHOR("Jonathan Woithe, Peter Gruber, Tony Vroon");
1207 MODULE_DESCRIPTION("Fujitsu laptop extras support");
1208 MODULE_VERSION(FUJITSU_DRIVER_VERSION);
1209 MODULE_LICENSE("GPL");
1210
1211 MODULE_ALIAS("dmi:*:svnFUJITSUSIEMENS:*:pvr:rvnFUJITSU:rnFJNB1D3:*:cvrS6410:*");
1212 MODULE_ALIAS("dmi:*:svnFUJITSUSIEMENS:*:pvr:rvnFUJITSU:rnFJNB1E6:*:cvrS6420:*");
1213 MODULE_ALIAS("dmi:*:svnFUJITSU:*:pvr:rvnFUJITSU:rnFJNB19C:*:cvrS7020:*");
1214
1215 static struct pnp_device_id pnp_ids[] __used = {
1216         {.id = "FUJ02bf"},
1217         {.id = "FUJ02B1"},
1218         {.id = "FUJ02E3"},
1219         {.id = ""}
1220 };
1221
1222 MODULE_DEVICE_TABLE(pnp, pnp_ids);