These changes are the raw update to linux-4.4.6-rt14. Kernel sources
[kvmfornfv.git] / kernel / 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/fb.h>
68 #include <linux/input.h>
69 #include <linux/kfifo.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 #include <acpi/video.h>
76
77 #define FUJITSU_DRIVER_VERSION "0.6.0"
78
79 #define FUJITSU_LCD_N_LEVELS 8
80
81 #define ACPI_FUJITSU_CLASS              "fujitsu"
82 #define ACPI_FUJITSU_HID                "FUJ02B1"
83 #define ACPI_FUJITSU_DRIVER_NAME        "Fujitsu laptop FUJ02B1 ACPI brightness driver"
84 #define ACPI_FUJITSU_DEVICE_NAME        "Fujitsu FUJ02B1"
85 #define ACPI_FUJITSU_HOTKEY_HID         "FUJ02E3"
86 #define ACPI_FUJITSU_HOTKEY_DRIVER_NAME "Fujitsu laptop FUJ02E3 ACPI hotkeys driver"
87 #define ACPI_FUJITSU_HOTKEY_DEVICE_NAME "Fujitsu FUJ02E3"
88
89 #define ACPI_FUJITSU_NOTIFY_CODE1     0x80
90
91 #define ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS     0x86
92 #define ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS     0x87
93
94 /* FUNC interface - command values */
95 #define FUNC_RFKILL     0x1000
96 #define FUNC_LEDS       0x1001
97 #define FUNC_BUTTONS    0x1002
98 #define FUNC_BACKLIGHT  0x1004
99
100 /* FUNC interface - responses */
101 #define UNSUPPORTED_CMD 0x80000000
102
103 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
104 /* FUNC interface - LED control */
105 #define FUNC_LED_OFF    0x1
106 #define FUNC_LED_ON     0x30001
107 #define KEYBOARD_LAMPS  0x100
108 #define LOGOLAMP_POWERON 0x2000
109 #define LOGOLAMP_ALWAYS  0x4000
110 #endif
111
112 /* Hotkey details */
113 #define KEY1_CODE       0x410   /* codes for the keys in the GIRB register */
114 #define KEY2_CODE       0x411
115 #define KEY3_CODE       0x412
116 #define KEY4_CODE       0x413
117
118 #define MAX_HOTKEY_RINGBUFFER_SIZE 100
119 #define RINGBUFFERSIZE 40
120
121 /* Debugging */
122 #define FUJLAPTOP_LOG      ACPI_FUJITSU_HID ": "
123 #define FUJLAPTOP_ERR      KERN_ERR FUJLAPTOP_LOG
124 #define FUJLAPTOP_NOTICE   KERN_NOTICE FUJLAPTOP_LOG
125 #define FUJLAPTOP_INFO     KERN_INFO FUJLAPTOP_LOG
126 #define FUJLAPTOP_DEBUG    KERN_DEBUG FUJLAPTOP_LOG
127
128 #define FUJLAPTOP_DBG_ALL         0xffff
129 #define FUJLAPTOP_DBG_ERROR       0x0001
130 #define FUJLAPTOP_DBG_WARN        0x0002
131 #define FUJLAPTOP_DBG_INFO        0x0004
132 #define FUJLAPTOP_DBG_TRACE       0x0008
133
134 #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
135 #define vdbg_printk(a_dbg_level, format, arg...) \
136         do { if (dbg_level & a_dbg_level) \
137                 printk(FUJLAPTOP_DEBUG "%s: " format, __func__ , ## arg); \
138         } while (0)
139 #else
140 #define vdbg_printk(a_dbg_level, format, arg...) \
141         do { } while (0)
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 == FB_BLANK_POWERDOWN)
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                    }
565 };
566
567 static void __init dmi_check_cb_common(const struct dmi_system_id *id)
568 {
569         pr_info("Identified laptop model '%s'\n", id->ident);
570         if (use_alt_lcd_levels == -1) {
571                 if (acpi_has_method(NULL,
572                                 "\\_SB.PCI0.LPCB.FJEX.SBL2"))
573                         use_alt_lcd_levels = 1;
574                 else
575                         use_alt_lcd_levels = 0;
576                 vdbg_printk(FUJLAPTOP_DBG_TRACE, "auto-detected usealt as "
577                         "%i\n", use_alt_lcd_levels);
578         }
579 }
580
581 static int __init dmi_check_cb_s6410(const struct dmi_system_id *id)
582 {
583         dmi_check_cb_common(id);
584         fujitsu->keycode1 = KEY_SCREENLOCK;     /* "Lock" */
585         fujitsu->keycode2 = KEY_HELP;   /* "Mobility Center" */
586         return 1;
587 }
588
589 static int __init dmi_check_cb_s6420(const struct dmi_system_id *id)
590 {
591         dmi_check_cb_common(id);
592         fujitsu->keycode1 = KEY_SCREENLOCK;     /* "Lock" */
593         fujitsu->keycode2 = KEY_HELP;   /* "Mobility Center" */
594         return 1;
595 }
596
597 static int __init dmi_check_cb_p8010(const struct dmi_system_id *id)
598 {
599         dmi_check_cb_common(id);
600         fujitsu->keycode1 = KEY_HELP;   /* "Support" */
601         fujitsu->keycode3 = KEY_SWITCHVIDEOMODE;        /* "Presentation" */
602         fujitsu->keycode4 = KEY_WWW;    /* "Internet" */
603         return 1;
604 }
605
606 static const struct dmi_system_id fujitsu_dmi_table[] __initconst = {
607         {
608          .ident = "Fujitsu Siemens S6410",
609          .matches = {
610                      DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
611                      DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6410"),
612                      },
613          .callback = dmi_check_cb_s6410},
614         {
615          .ident = "Fujitsu Siemens S6420",
616          .matches = {
617                      DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
618                      DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6420"),
619                      },
620          .callback = dmi_check_cb_s6420},
621         {
622          .ident = "Fujitsu LifeBook P8010",
623          .matches = {
624                      DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"),
625                      DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook P8010"),
626                      },
627          .callback = dmi_check_cb_p8010},
628         {}
629 };
630
631 /* ACPI device for LCD brightness control */
632
633 static int acpi_fujitsu_add(struct acpi_device *device)
634 {
635         int state = 0;
636         struct input_dev *input;
637         int error;
638
639         if (!device)
640                 return -EINVAL;
641
642         fujitsu->acpi_handle = device->handle;
643         sprintf(acpi_device_name(device), "%s", ACPI_FUJITSU_DEVICE_NAME);
644         sprintf(acpi_device_class(device), "%s", ACPI_FUJITSU_CLASS);
645         device->driver_data = fujitsu;
646
647         fujitsu->input = input = input_allocate_device();
648         if (!input) {
649                 error = -ENOMEM;
650                 goto err_stop;
651         }
652
653         snprintf(fujitsu->phys, sizeof(fujitsu->phys),
654                  "%s/video/input0", acpi_device_hid(device));
655
656         input->name = acpi_device_name(device);
657         input->phys = fujitsu->phys;
658         input->id.bustype = BUS_HOST;
659         input->id.product = 0x06;
660         input->dev.parent = &device->dev;
661         input->evbit[0] = BIT(EV_KEY);
662         set_bit(KEY_BRIGHTNESSUP, input->keybit);
663         set_bit(KEY_BRIGHTNESSDOWN, input->keybit);
664         set_bit(KEY_UNKNOWN, input->keybit);
665
666         error = input_register_device(input);
667         if (error)
668                 goto err_free_input_dev;
669
670         error = acpi_bus_update_power(fujitsu->acpi_handle, &state);
671         if (error) {
672                 pr_err("Error reading power state\n");
673                 goto err_unregister_input_dev;
674         }
675
676         pr_info("ACPI: %s [%s] (%s)\n",
677                acpi_device_name(device), acpi_device_bid(device),
678                !device->power.state ? "on" : "off");
679
680         fujitsu->dev = device;
681
682         if (acpi_has_method(device->handle, METHOD_NAME__INI)) {
683                 vdbg_printk(FUJLAPTOP_DBG_INFO, "Invoking _INI\n");
684                 if (ACPI_FAILURE
685                     (acpi_evaluate_object
686                      (device->handle, METHOD_NAME__INI, NULL, NULL)))
687                         pr_err("_INI Method failed\n");
688         }
689
690         /* do config (detect defaults) */
691         use_alt_lcd_levels = use_alt_lcd_levels == 1 ? 1 : 0;
692         disable_brightness_adjust = disable_brightness_adjust == 1 ? 1 : 0;
693         vdbg_printk(FUJLAPTOP_DBG_INFO,
694                     "config: [alt interface: %d], [adjust disable: %d]\n",
695                     use_alt_lcd_levels, disable_brightness_adjust);
696
697         if (get_max_brightness() <= 0)
698                 fujitsu->max_brightness = FUJITSU_LCD_N_LEVELS;
699         get_lcd_level();
700
701         return 0;
702
703 err_unregister_input_dev:
704         input_unregister_device(input);
705         input = NULL;
706 err_free_input_dev:
707         input_free_device(input);
708 err_stop:
709         return error;
710 }
711
712 static int acpi_fujitsu_remove(struct acpi_device *device)
713 {
714         struct fujitsu_t *fujitsu = acpi_driver_data(device);
715         struct input_dev *input = fujitsu->input;
716
717         input_unregister_device(input);
718
719         fujitsu->acpi_handle = NULL;
720
721         return 0;
722 }
723
724 /* Brightness notify */
725
726 static void acpi_fujitsu_notify(struct acpi_device *device, u32 event)
727 {
728         struct input_dev *input;
729         int keycode;
730         int oldb, newb;
731
732         input = fujitsu->input;
733
734         switch (event) {
735         case ACPI_FUJITSU_NOTIFY_CODE1:
736                 keycode = 0;
737                 oldb = fujitsu->brightness_level;
738                 get_lcd_level();
739                 newb = fujitsu->brightness_level;
740
741                 vdbg_printk(FUJLAPTOP_DBG_TRACE,
742                             "brightness button event [%i -> %i (%i)]\n",
743                             oldb, newb, fujitsu->brightness_changed);
744
745                 if (oldb < newb) {
746                         if (disable_brightness_adjust != 1) {
747                                 if (use_alt_lcd_levels)
748                                         set_lcd_level_alt(newb);
749                                 else
750                                         set_lcd_level(newb);
751                         }
752                         keycode = KEY_BRIGHTNESSUP;
753                 } else if (oldb > newb) {
754                         if (disable_brightness_adjust != 1) {
755                                 if (use_alt_lcd_levels)
756                                         set_lcd_level_alt(newb);
757                                 else
758                                         set_lcd_level(newb);
759                         }
760                         keycode = KEY_BRIGHTNESSDOWN;
761                 }
762                 break;
763         default:
764                 keycode = KEY_UNKNOWN;
765                 vdbg_printk(FUJLAPTOP_DBG_WARN,
766                             "unsupported event [0x%x]\n", event);
767                 break;
768         }
769
770         if (keycode != 0) {
771                 input_report_key(input, keycode, 1);
772                 input_sync(input);
773                 input_report_key(input, keycode, 0);
774                 input_sync(input);
775         }
776 }
777
778 /* ACPI device for hotkey handling */
779
780 static int acpi_fujitsu_hotkey_add(struct acpi_device *device)
781 {
782         int result = 0;
783         int state = 0;
784         struct input_dev *input;
785         int error;
786         int i;
787
788         if (!device)
789                 return -EINVAL;
790
791         fujitsu_hotkey->acpi_handle = device->handle;
792         sprintf(acpi_device_name(device), "%s",
793                 ACPI_FUJITSU_HOTKEY_DEVICE_NAME);
794         sprintf(acpi_device_class(device), "%s", ACPI_FUJITSU_CLASS);
795         device->driver_data = fujitsu_hotkey;
796
797         /* kfifo */
798         spin_lock_init(&fujitsu_hotkey->fifo_lock);
799         error = kfifo_alloc(&fujitsu_hotkey->fifo, RINGBUFFERSIZE * sizeof(int),
800                         GFP_KERNEL);
801         if (error) {
802                 pr_err("kfifo_alloc failed\n");
803                 goto err_stop;
804         }
805
806         fujitsu_hotkey->input = input = input_allocate_device();
807         if (!input) {
808                 error = -ENOMEM;
809                 goto err_free_fifo;
810         }
811
812         snprintf(fujitsu_hotkey->phys, sizeof(fujitsu_hotkey->phys),
813                  "%s/video/input0", acpi_device_hid(device));
814
815         input->name = acpi_device_name(device);
816         input->phys = fujitsu_hotkey->phys;
817         input->id.bustype = BUS_HOST;
818         input->id.product = 0x06;
819         input->dev.parent = &device->dev;
820
821         set_bit(EV_KEY, input->evbit);
822         set_bit(fujitsu->keycode1, input->keybit);
823         set_bit(fujitsu->keycode2, input->keybit);
824         set_bit(fujitsu->keycode3, input->keybit);
825         set_bit(fujitsu->keycode4, input->keybit);
826         set_bit(KEY_UNKNOWN, input->keybit);
827
828         error = input_register_device(input);
829         if (error)
830                 goto err_free_input_dev;
831
832         error = acpi_bus_update_power(fujitsu_hotkey->acpi_handle, &state);
833         if (error) {
834                 pr_err("Error reading power state\n");
835                 goto err_unregister_input_dev;
836         }
837
838         pr_info("ACPI: %s [%s] (%s)\n",
839                 acpi_device_name(device), acpi_device_bid(device),
840                 !device->power.state ? "on" : "off");
841
842         fujitsu_hotkey->dev = device;
843
844         if (acpi_has_method(device->handle, METHOD_NAME__INI)) {
845                 vdbg_printk(FUJLAPTOP_DBG_INFO, "Invoking _INI\n");
846                 if (ACPI_FAILURE
847                     (acpi_evaluate_object
848                      (device->handle, METHOD_NAME__INI, NULL, NULL)))
849                         pr_err("_INI Method failed\n");
850         }
851
852         i = 0;
853         while (call_fext_func(FUNC_BUTTONS, 0x1, 0x0, 0x0) != 0
854                 && (i++) < MAX_HOTKEY_RINGBUFFER_SIZE)
855                 ; /* No action, result is discarded */
856         vdbg_printk(FUJLAPTOP_DBG_INFO, "Discarded %i ringbuffer entries\n", i);
857
858         fujitsu_hotkey->rfkill_supported =
859                 call_fext_func(FUNC_RFKILL, 0x0, 0x0, 0x0);
860
861         /* Make sure our bitmask of supported functions is cleared if the
862            RFKILL function block is not implemented, like on the S7020. */
863         if (fujitsu_hotkey->rfkill_supported == UNSUPPORTED_CMD)
864                 fujitsu_hotkey->rfkill_supported = 0;
865
866         if (fujitsu_hotkey->rfkill_supported)
867                 fujitsu_hotkey->rfkill_state =
868                         call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
869
870         /* Suspect this is a keymap of the application panel, print it */
871         pr_info("BTNI: [0x%x]\n", call_fext_func(FUNC_BUTTONS, 0x0, 0x0, 0x0));
872
873 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
874         if (call_fext_func(FUNC_LEDS, 0x0, 0x0, 0x0) & LOGOLAMP_POWERON) {
875                 result = led_classdev_register(&fujitsu->pf_device->dev,
876                                                 &logolamp_led);
877                 if (result == 0) {
878                         fujitsu_hotkey->logolamp_registered = 1;
879                 } else {
880                         pr_err("Could not register LED handler for logo lamp, error %i\n",
881                                result);
882                 }
883         }
884
885         if ((call_fext_func(FUNC_LEDS, 0x0, 0x0, 0x0) & KEYBOARD_LAMPS) &&
886            (call_fext_func(FUNC_BUTTONS, 0x0, 0x0, 0x0) == 0x0)) {
887                 result = led_classdev_register(&fujitsu->pf_device->dev,
888                                                 &kblamps_led);
889                 if (result == 0) {
890                         fujitsu_hotkey->kblamps_registered = 1;
891                 } else {
892                         pr_err("Could not register LED handler for keyboard lamps, error %i\n",
893                                result);
894                 }
895         }
896 #endif
897
898         return result;
899
900 err_unregister_input_dev:
901         input_unregister_device(input);
902         input = NULL;
903 err_free_input_dev:
904         input_free_device(input);
905 err_free_fifo:
906         kfifo_free(&fujitsu_hotkey->fifo);
907 err_stop:
908         return error;
909 }
910
911 static int acpi_fujitsu_hotkey_remove(struct acpi_device *device)
912 {
913         struct fujitsu_hotkey_t *fujitsu_hotkey = acpi_driver_data(device);
914         struct input_dev *input = fujitsu_hotkey->input;
915
916 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
917         if (fujitsu_hotkey->logolamp_registered)
918                 led_classdev_unregister(&logolamp_led);
919
920         if (fujitsu_hotkey->kblamps_registered)
921                 led_classdev_unregister(&kblamps_led);
922 #endif
923
924         input_unregister_device(input);
925
926         kfifo_free(&fujitsu_hotkey->fifo);
927
928         fujitsu_hotkey->acpi_handle = NULL;
929
930         return 0;
931 }
932
933 static void acpi_fujitsu_hotkey_notify(struct acpi_device *device, u32 event)
934 {
935         struct input_dev *input;
936         int keycode, keycode_r;
937         unsigned int irb = 1;
938         int i, status;
939
940         input = fujitsu_hotkey->input;
941
942         if (fujitsu_hotkey->rfkill_supported)
943                 fujitsu_hotkey->rfkill_state =
944                         call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
945
946         switch (event) {
947         case ACPI_FUJITSU_NOTIFY_CODE1:
948                 i = 0;
949                 while ((irb =
950                         call_fext_func(FUNC_BUTTONS, 0x1, 0x0, 0x0)) != 0
951                                 && (i++) < MAX_HOTKEY_RINGBUFFER_SIZE) {
952                         switch (irb & 0x4ff) {
953                         case KEY1_CODE:
954                                 keycode = fujitsu->keycode1;
955                                 break;
956                         case KEY2_CODE:
957                                 keycode = fujitsu->keycode2;
958                                 break;
959                         case KEY3_CODE:
960                                 keycode = fujitsu->keycode3;
961                                 break;
962                         case KEY4_CODE:
963                                 keycode = fujitsu->keycode4;
964                                 break;
965                         case 0:
966                                 keycode = 0;
967                                 break;
968                         default:
969                                 vdbg_printk(FUJLAPTOP_DBG_WARN,
970                                             "Unknown GIRB result [%x]\n", irb);
971                                 keycode = -1;
972                                 break;
973                         }
974                         if (keycode > 0) {
975                                 vdbg_printk(FUJLAPTOP_DBG_TRACE,
976                                         "Push keycode into ringbuffer [%d]\n",
977                                         keycode);
978                                 status = kfifo_in_locked(&fujitsu_hotkey->fifo,
979                                                    (unsigned char *)&keycode,
980                                                    sizeof(keycode),
981                                                    &fujitsu_hotkey->fifo_lock);
982                                 if (status != sizeof(keycode)) {
983                                         vdbg_printk(FUJLAPTOP_DBG_WARN,
984                                             "Could not push keycode [0x%x]\n",
985                                             keycode);
986                                 } else {
987                                         input_report_key(input, keycode, 1);
988                                         input_sync(input);
989                                 }
990                         } else if (keycode == 0) {
991                                 while ((status =
992                                         kfifo_out_locked(
993                                          &fujitsu_hotkey->fifo,
994                                          (unsigned char *) &keycode_r,
995                                          sizeof(keycode_r),
996                                          &fujitsu_hotkey->fifo_lock))
997                                          == sizeof(keycode_r)) {
998                                         input_report_key(input, keycode_r, 0);
999                                         input_sync(input);
1000                                         vdbg_printk(FUJLAPTOP_DBG_TRACE,
1001                                           "Pop keycode from ringbuffer [%d]\n",
1002                                           keycode_r);
1003                                 }
1004                         }
1005                 }
1006
1007                 break;
1008         default:
1009                 keycode = KEY_UNKNOWN;
1010                 vdbg_printk(FUJLAPTOP_DBG_WARN,
1011                             "Unsupported event [0x%x]\n", event);
1012                 input_report_key(input, keycode, 1);
1013                 input_sync(input);
1014                 input_report_key(input, keycode, 0);
1015                 input_sync(input);
1016                 break;
1017         }
1018 }
1019
1020 /* Initialization */
1021
1022 static const struct acpi_device_id fujitsu_device_ids[] = {
1023         {ACPI_FUJITSU_HID, 0},
1024         {"", 0},
1025 };
1026
1027 static struct acpi_driver acpi_fujitsu_driver = {
1028         .name = ACPI_FUJITSU_DRIVER_NAME,
1029         .class = ACPI_FUJITSU_CLASS,
1030         .ids = fujitsu_device_ids,
1031         .ops = {
1032                 .add = acpi_fujitsu_add,
1033                 .remove = acpi_fujitsu_remove,
1034                 .notify = acpi_fujitsu_notify,
1035                 },
1036 };
1037
1038 static const struct acpi_device_id fujitsu_hotkey_device_ids[] = {
1039         {ACPI_FUJITSU_HOTKEY_HID, 0},
1040         {"", 0},
1041 };
1042
1043 static struct acpi_driver acpi_fujitsu_hotkey_driver = {
1044         .name = ACPI_FUJITSU_HOTKEY_DRIVER_NAME,
1045         .class = ACPI_FUJITSU_CLASS,
1046         .ids = fujitsu_hotkey_device_ids,
1047         .ops = {
1048                 .add = acpi_fujitsu_hotkey_add,
1049                 .remove = acpi_fujitsu_hotkey_remove,
1050                 .notify = acpi_fujitsu_hotkey_notify,
1051                 },
1052 };
1053
1054 static const struct acpi_device_id fujitsu_ids[] __used = {
1055         {ACPI_FUJITSU_HID, 0},
1056         {ACPI_FUJITSU_HOTKEY_HID, 0},
1057         {"", 0}
1058 };
1059 MODULE_DEVICE_TABLE(acpi, fujitsu_ids);
1060
1061 static int __init fujitsu_init(void)
1062 {
1063         int ret, result, max_brightness;
1064
1065         if (acpi_disabled)
1066                 return -ENODEV;
1067
1068         fujitsu = kzalloc(sizeof(struct fujitsu_t), GFP_KERNEL);
1069         if (!fujitsu)
1070                 return -ENOMEM;
1071         fujitsu->keycode1 = KEY_PROG1;
1072         fujitsu->keycode2 = KEY_PROG2;
1073         fujitsu->keycode3 = KEY_PROG3;
1074         fujitsu->keycode4 = KEY_PROG4;
1075         dmi_check_system(fujitsu_dmi_table);
1076
1077         result = acpi_bus_register_driver(&acpi_fujitsu_driver);
1078         if (result < 0) {
1079                 ret = -ENODEV;
1080                 goto fail_acpi;
1081         }
1082
1083         /* Register platform stuff */
1084
1085         fujitsu->pf_device = platform_device_alloc("fujitsu-laptop", -1);
1086         if (!fujitsu->pf_device) {
1087                 ret = -ENOMEM;
1088                 goto fail_platform_driver;
1089         }
1090
1091         ret = platform_device_add(fujitsu->pf_device);
1092         if (ret)
1093                 goto fail_platform_device1;
1094
1095         ret =
1096             sysfs_create_group(&fujitsu->pf_device->dev.kobj,
1097                                &fujitsupf_attribute_group);
1098         if (ret)
1099                 goto fail_platform_device2;
1100
1101         /* Register backlight stuff */
1102
1103         if (acpi_video_get_backlight_type() == acpi_backlight_vendor) {
1104                 struct backlight_properties props;
1105
1106                 memset(&props, 0, sizeof(struct backlight_properties));
1107                 max_brightness = fujitsu->max_brightness;
1108                 props.type = BACKLIGHT_PLATFORM;
1109                 props.max_brightness = max_brightness - 1;
1110                 fujitsu->bl_device = backlight_device_register("fujitsu-laptop",
1111                                                                NULL, NULL,
1112                                                                &fujitsubl_ops,
1113                                                                &props);
1114                 if (IS_ERR(fujitsu->bl_device)) {
1115                         ret = PTR_ERR(fujitsu->bl_device);
1116                         fujitsu->bl_device = NULL;
1117                         goto fail_sysfs_group;
1118                 }
1119                 fujitsu->bl_device->props.brightness = fujitsu->brightness_level;
1120         }
1121
1122         ret = platform_driver_register(&fujitsupf_driver);
1123         if (ret)
1124                 goto fail_backlight;
1125
1126         /* Register hotkey driver */
1127
1128         fujitsu_hotkey = kzalloc(sizeof(struct fujitsu_hotkey_t), GFP_KERNEL);
1129         if (!fujitsu_hotkey) {
1130                 ret = -ENOMEM;
1131                 goto fail_hotkey;
1132         }
1133
1134         result = acpi_bus_register_driver(&acpi_fujitsu_hotkey_driver);
1135         if (result < 0) {
1136                 ret = -ENODEV;
1137                 goto fail_hotkey1;
1138         }
1139
1140         /* Sync backlight power status (needs FUJ02E3 device, hence deferred) */
1141         if (acpi_video_get_backlight_type() == acpi_backlight_vendor) {
1142                 if (call_fext_func(FUNC_BACKLIGHT, 0x2, 0x4, 0x0) == 3)
1143                         fujitsu->bl_device->props.power = FB_BLANK_POWERDOWN;
1144                 else
1145                         fujitsu->bl_device->props.power = FB_BLANK_UNBLANK;
1146         }
1147
1148         pr_info("driver " FUJITSU_DRIVER_VERSION " successfully loaded\n");
1149
1150         return 0;
1151
1152 fail_hotkey1:
1153         kfree(fujitsu_hotkey);
1154 fail_hotkey:
1155         platform_driver_unregister(&fujitsupf_driver);
1156 fail_backlight:
1157         backlight_device_unregister(fujitsu->bl_device);
1158 fail_sysfs_group:
1159         sysfs_remove_group(&fujitsu->pf_device->dev.kobj,
1160                            &fujitsupf_attribute_group);
1161 fail_platform_device2:
1162         platform_device_del(fujitsu->pf_device);
1163 fail_platform_device1:
1164         platform_device_put(fujitsu->pf_device);
1165 fail_platform_driver:
1166         acpi_bus_unregister_driver(&acpi_fujitsu_driver);
1167 fail_acpi:
1168         kfree(fujitsu);
1169
1170         return ret;
1171 }
1172
1173 static void __exit fujitsu_cleanup(void)
1174 {
1175         acpi_bus_unregister_driver(&acpi_fujitsu_hotkey_driver);
1176
1177         kfree(fujitsu_hotkey);
1178
1179         platform_driver_unregister(&fujitsupf_driver);
1180
1181         backlight_device_unregister(fujitsu->bl_device);
1182
1183         sysfs_remove_group(&fujitsu->pf_device->dev.kobj,
1184                            &fujitsupf_attribute_group);
1185
1186         platform_device_unregister(fujitsu->pf_device);
1187
1188         acpi_bus_unregister_driver(&acpi_fujitsu_driver);
1189
1190         kfree(fujitsu);
1191
1192         pr_info("driver unloaded\n");
1193 }
1194
1195 module_init(fujitsu_init);
1196 module_exit(fujitsu_cleanup);
1197
1198 module_param(use_alt_lcd_levels, uint, 0644);
1199 MODULE_PARM_DESC(use_alt_lcd_levels,
1200                  "Use alternative interface for lcd_levels (needed for Lifebook s6410).");
1201 module_param(disable_brightness_adjust, uint, 0644);
1202 MODULE_PARM_DESC(disable_brightness_adjust, "Disable brightness adjustment .");
1203 #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
1204 module_param_named(debug, dbg_level, uint, 0644);
1205 MODULE_PARM_DESC(debug, "Sets debug level bit-mask");
1206 #endif
1207
1208 MODULE_AUTHOR("Jonathan Woithe, Peter Gruber, Tony Vroon");
1209 MODULE_DESCRIPTION("Fujitsu laptop extras support");
1210 MODULE_VERSION(FUJITSU_DRIVER_VERSION);
1211 MODULE_LICENSE("GPL");
1212
1213 MODULE_ALIAS("dmi:*:svnFUJITSUSIEMENS:*:pvr:rvnFUJITSU:rnFJNB1D3:*:cvrS6410:*");
1214 MODULE_ALIAS("dmi:*:svnFUJITSUSIEMENS:*:pvr:rvnFUJITSU:rnFJNB1E6:*:cvrS6420:*");
1215 MODULE_ALIAS("dmi:*:svnFUJITSU:*:pvr:rvnFUJITSU:rnFJNB19C:*:cvrS7020:*");