Add the rt linux 4.1.3-rt3 as base
[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
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 #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
134 #define vdbg_printk(a_dbg_level, format, arg...) \
135         do { if (dbg_level & a_dbg_level) \
136                 printk(FUJLAPTOP_DEBUG "%s: " format, __func__ , ## arg); \
137         } while (0)
138 #else
139 #define vdbg_printk(a_dbg_level, format, arg...) \
140         do { } while (0)
141 #endif
142
143 /* Device controlling the backlight and associated keys */
144 struct fujitsu_t {
145         acpi_handle acpi_handle;
146         struct acpi_device *dev;
147         struct input_dev *input;
148         char phys[32];
149         struct backlight_device *bl_device;
150         struct platform_device *pf_device;
151         int keycode1, keycode2, keycode3, keycode4;
152
153         unsigned int max_brightness;
154         unsigned int brightness_changed;
155         unsigned int brightness_level;
156 };
157
158 static struct fujitsu_t *fujitsu;
159 static int use_alt_lcd_levels = -1;
160 static int disable_brightness_adjust = -1;
161
162 /* Device used to access other hotkeys on the laptop */
163 struct fujitsu_hotkey_t {
164         acpi_handle acpi_handle;
165         struct acpi_device *dev;
166         struct input_dev *input;
167         char phys[32];
168         struct platform_device *pf_device;
169         struct kfifo fifo;
170         spinlock_t fifo_lock;
171         int rfkill_supported;
172         int rfkill_state;
173         int logolamp_registered;
174         int kblamps_registered;
175 };
176
177 static struct fujitsu_hotkey_t *fujitsu_hotkey;
178
179 static void acpi_fujitsu_hotkey_notify(struct acpi_device *device, u32 event);
180
181 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
182 static enum led_brightness logolamp_get(struct led_classdev *cdev);
183 static void logolamp_set(struct led_classdev *cdev,
184                                enum led_brightness brightness);
185
186 static struct led_classdev logolamp_led = {
187  .name = "fujitsu::logolamp",
188  .brightness_get = logolamp_get,
189  .brightness_set = logolamp_set
190 };
191
192 static enum led_brightness kblamps_get(struct led_classdev *cdev);
193 static void kblamps_set(struct led_classdev *cdev,
194                                enum led_brightness brightness);
195
196 static struct led_classdev kblamps_led = {
197  .name = "fujitsu::kblamps",
198  .brightness_get = kblamps_get,
199  .brightness_set = kblamps_set
200 };
201 #endif
202
203 #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
204 static u32 dbg_level = 0x03;
205 #endif
206
207 static void acpi_fujitsu_notify(struct acpi_device *device, u32 event);
208
209 /* Fujitsu ACPI interface function */
210
211 static int call_fext_func(int cmd, int arg0, int arg1, int arg2)
212 {
213         acpi_status status = AE_OK;
214         union acpi_object params[4] = {
215         { .type = ACPI_TYPE_INTEGER },
216         { .type = ACPI_TYPE_INTEGER },
217         { .type = ACPI_TYPE_INTEGER },
218         { .type = ACPI_TYPE_INTEGER }
219         };
220         struct acpi_object_list arg_list = { 4, &params[0] };
221         unsigned long long value;
222         acpi_handle handle = NULL;
223
224         status = acpi_get_handle(fujitsu_hotkey->acpi_handle, "FUNC", &handle);
225         if (ACPI_FAILURE(status)) {
226                 vdbg_printk(FUJLAPTOP_DBG_ERROR,
227                                 "FUNC interface is not present\n");
228                 return -ENODEV;
229         }
230
231         params[0].integer.value = cmd;
232         params[1].integer.value = arg0;
233         params[2].integer.value = arg1;
234         params[3].integer.value = arg2;
235
236         status = acpi_evaluate_integer(handle, NULL, &arg_list, &value);
237         if (ACPI_FAILURE(status)) {
238                 vdbg_printk(FUJLAPTOP_DBG_WARN,
239                         "FUNC 0x%x (args 0x%x, 0x%x, 0x%x) call failed\n",
240                                 cmd, arg0, arg1, arg2);
241                 return -ENODEV;
242         }
243
244         vdbg_printk(FUJLAPTOP_DBG_TRACE,
245                 "FUNC 0x%x (args 0x%x, 0x%x, 0x%x) returned 0x%x\n",
246                         cmd, arg0, arg1, arg2, (int)value);
247         return value;
248 }
249
250 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
251 /* LED class callbacks */
252
253 static void logolamp_set(struct led_classdev *cdev,
254                                enum led_brightness brightness)
255 {
256         if (brightness >= LED_FULL) {
257                 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_ON);
258                 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_ALWAYS, FUNC_LED_ON);
259         } else if (brightness >= LED_HALF) {
260                 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_ON);
261                 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_ALWAYS, FUNC_LED_OFF);
262         } else {
263                 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_OFF);
264         }
265 }
266
267 static void kblamps_set(struct led_classdev *cdev,
268                                enum led_brightness brightness)
269 {
270         if (brightness >= LED_FULL)
271                 call_fext_func(FUNC_LEDS, 0x1, KEYBOARD_LAMPS, FUNC_LED_ON);
272         else
273                 call_fext_func(FUNC_LEDS, 0x1, KEYBOARD_LAMPS, FUNC_LED_OFF);
274 }
275
276 static enum led_brightness logolamp_get(struct led_classdev *cdev)
277 {
278         enum led_brightness brightness = LED_OFF;
279         int poweron, always;
280
281         poweron = call_fext_func(FUNC_LEDS, 0x2, LOGOLAMP_POWERON, 0x0);
282         if (poweron == FUNC_LED_ON) {
283                 brightness = LED_HALF;
284                 always = call_fext_func(FUNC_LEDS, 0x2, LOGOLAMP_ALWAYS, 0x0);
285                 if (always == FUNC_LED_ON)
286                         brightness = LED_FULL;
287         }
288         return brightness;
289 }
290
291 static enum led_brightness kblamps_get(struct led_classdev *cdev)
292 {
293         enum led_brightness brightness = LED_OFF;
294
295         if (call_fext_func(FUNC_LEDS, 0x2, KEYBOARD_LAMPS, 0x0) == FUNC_LED_ON)
296                 brightness = LED_FULL;
297
298         return brightness;
299 }
300 #endif
301
302 /* Hardware access for LCD brightness control */
303
304 static int set_lcd_level(int level)
305 {
306         acpi_status status = AE_OK;
307         acpi_handle handle = NULL;
308
309         vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBLL [%d]\n",
310                     level);
311
312         if (level < 0 || level >= fujitsu->max_brightness)
313                 return -EINVAL;
314
315         status = acpi_get_handle(fujitsu->acpi_handle, "SBLL", &handle);
316         if (ACPI_FAILURE(status)) {
317                 vdbg_printk(FUJLAPTOP_DBG_ERROR, "SBLL not present\n");
318                 return -ENODEV;
319         }
320
321
322         status = acpi_execute_simple_method(handle, NULL, level);
323         if (ACPI_FAILURE(status))
324                 return -ENODEV;
325
326         return 0;
327 }
328
329 static int set_lcd_level_alt(int level)
330 {
331         acpi_status status = AE_OK;
332         acpi_handle handle = NULL;
333
334         vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBL2 [%d]\n",
335                     level);
336
337         if (level < 0 || level >= fujitsu->max_brightness)
338                 return -EINVAL;
339
340         status = acpi_get_handle(fujitsu->acpi_handle, "SBL2", &handle);
341         if (ACPI_FAILURE(status)) {
342                 vdbg_printk(FUJLAPTOP_DBG_ERROR, "SBL2 not present\n");
343                 return -ENODEV;
344         }
345
346         status = acpi_execute_simple_method(handle, NULL, level);
347         if (ACPI_FAILURE(status))
348                 return -ENODEV;
349
350         return 0;
351 }
352
353 static int get_lcd_level(void)
354 {
355         unsigned long long state = 0;
356         acpi_status status = AE_OK;
357
358         vdbg_printk(FUJLAPTOP_DBG_TRACE, "get lcd level via GBLL\n");
359
360         status =
361             acpi_evaluate_integer(fujitsu->acpi_handle, "GBLL", NULL, &state);
362         if (ACPI_FAILURE(status))
363                 return 0;
364
365         fujitsu->brightness_level = state & 0x0fffffff;
366
367         if (state & 0x80000000)
368                 fujitsu->brightness_changed = 1;
369         else
370                 fujitsu->brightness_changed = 0;
371
372         return fujitsu->brightness_level;
373 }
374
375 static int get_max_brightness(void)
376 {
377         unsigned long long state = 0;
378         acpi_status status = AE_OK;
379
380         vdbg_printk(FUJLAPTOP_DBG_TRACE, "get max lcd level via RBLL\n");
381
382         status =
383             acpi_evaluate_integer(fujitsu->acpi_handle, "RBLL", NULL, &state);
384         if (ACPI_FAILURE(status))
385                 return -1;
386
387         fujitsu->max_brightness = state;
388
389         return fujitsu->max_brightness;
390 }
391
392 /* Backlight device stuff */
393
394 static int bl_get_brightness(struct backlight_device *b)
395 {
396         return get_lcd_level();
397 }
398
399 static int bl_update_status(struct backlight_device *b)
400 {
401         int ret;
402         if (b->props.power == FB_BLANK_POWERDOWN)
403                 ret = call_fext_func(FUNC_BACKLIGHT, 0x1, 0x4, 0x3);
404         else
405                 ret = call_fext_func(FUNC_BACKLIGHT, 0x1, 0x4, 0x0);
406         if (ret != 0)
407                 vdbg_printk(FUJLAPTOP_DBG_ERROR,
408                         "Unable to adjust backlight power, error code %i\n",
409                         ret);
410
411         if (use_alt_lcd_levels)
412                 ret = set_lcd_level_alt(b->props.brightness);
413         else
414                 ret = set_lcd_level(b->props.brightness);
415         if (ret != 0)
416                 vdbg_printk(FUJLAPTOP_DBG_ERROR,
417                         "Unable to adjust LCD brightness, error code %i\n",
418                         ret);
419         return ret;
420 }
421
422 static const struct backlight_ops fujitsubl_ops = {
423         .get_brightness = bl_get_brightness,
424         .update_status = bl_update_status,
425 };
426
427 /* Platform LCD brightness device */
428
429 static ssize_t
430 show_max_brightness(struct device *dev,
431                     struct device_attribute *attr, char *buf)
432 {
433
434         int ret;
435
436         ret = get_max_brightness();
437         if (ret < 0)
438                 return ret;
439
440         return sprintf(buf, "%i\n", ret);
441 }
442
443 static ssize_t
444 show_brightness_changed(struct device *dev,
445                         struct device_attribute *attr, char *buf)
446 {
447
448         int ret;
449
450         ret = fujitsu->brightness_changed;
451         if (ret < 0)
452                 return ret;
453
454         return sprintf(buf, "%i\n", ret);
455 }
456
457 static ssize_t show_lcd_level(struct device *dev,
458                               struct device_attribute *attr, char *buf)
459 {
460
461         int ret;
462
463         ret = get_lcd_level();
464         if (ret < 0)
465                 return ret;
466
467         return sprintf(buf, "%i\n", ret);
468 }
469
470 static ssize_t store_lcd_level(struct device *dev,
471                                struct device_attribute *attr, const char *buf,
472                                size_t count)
473 {
474
475         int level, ret;
476
477         if (sscanf(buf, "%i", &level) != 1
478             || (level < 0 || level >= fujitsu->max_brightness))
479                 return -EINVAL;
480
481         if (use_alt_lcd_levels)
482                 ret = set_lcd_level_alt(level);
483         else
484                 ret = set_lcd_level(level);
485         if (ret < 0)
486                 return ret;
487
488         ret = get_lcd_level();
489         if (ret < 0)
490                 return ret;
491
492         return count;
493 }
494
495 static ssize_t
496 ignore_store(struct device *dev,
497              struct device_attribute *attr, const char *buf, size_t count)
498 {
499         return count;
500 }
501
502 static ssize_t
503 show_lid_state(struct device *dev,
504                         struct device_attribute *attr, char *buf)
505 {
506         if (!(fujitsu_hotkey->rfkill_supported & 0x100))
507                 return sprintf(buf, "unknown\n");
508         if (fujitsu_hotkey->rfkill_state & 0x100)
509                 return sprintf(buf, "open\n");
510         else
511                 return sprintf(buf, "closed\n");
512 }
513
514 static ssize_t
515 show_dock_state(struct device *dev,
516                         struct device_attribute *attr, char *buf)
517 {
518         if (!(fujitsu_hotkey->rfkill_supported & 0x200))
519                 return sprintf(buf, "unknown\n");
520         if (fujitsu_hotkey->rfkill_state & 0x200)
521                 return sprintf(buf, "docked\n");
522         else
523                 return sprintf(buf, "undocked\n");
524 }
525
526 static ssize_t
527 show_radios_state(struct device *dev,
528                         struct device_attribute *attr, char *buf)
529 {
530         if (!(fujitsu_hotkey->rfkill_supported & 0x20))
531                 return sprintf(buf, "unknown\n");
532         if (fujitsu_hotkey->rfkill_state & 0x20)
533                 return sprintf(buf, "on\n");
534         else
535                 return sprintf(buf, "killed\n");
536 }
537
538 static DEVICE_ATTR(max_brightness, 0444, show_max_brightness, ignore_store);
539 static DEVICE_ATTR(brightness_changed, 0444, show_brightness_changed,
540                    ignore_store);
541 static DEVICE_ATTR(lcd_level, 0644, show_lcd_level, store_lcd_level);
542 static DEVICE_ATTR(lid, 0444, show_lid_state, ignore_store);
543 static DEVICE_ATTR(dock, 0444, show_dock_state, ignore_store);
544 static DEVICE_ATTR(radios, 0444, show_radios_state, ignore_store);
545
546 static struct attribute *fujitsupf_attributes[] = {
547         &dev_attr_brightness_changed.attr,
548         &dev_attr_max_brightness.attr,
549         &dev_attr_lcd_level.attr,
550         &dev_attr_lid.attr,
551         &dev_attr_dock.attr,
552         &dev_attr_radios.attr,
553         NULL
554 };
555
556 static struct attribute_group fujitsupf_attribute_group = {
557         .attrs = fujitsupf_attributes
558 };
559
560 static struct platform_driver fujitsupf_driver = {
561         .driver = {
562                    .name = "fujitsu-laptop",
563                    }
564 };
565
566 static void __init dmi_check_cb_common(const struct dmi_system_id *id)
567 {
568         pr_info("Identified laptop model '%s'\n", id->ident);
569         if (use_alt_lcd_levels == -1) {
570                 if (acpi_has_method(NULL,
571                                 "\\_SB.PCI0.LPCB.FJEX.SBL2"))
572                         use_alt_lcd_levels = 1;
573                 else
574                         use_alt_lcd_levels = 0;
575                 vdbg_printk(FUJLAPTOP_DBG_TRACE, "auto-detected usealt as "
576                         "%i\n", use_alt_lcd_levels);
577         }
578 }
579
580 static int __init dmi_check_cb_s6410(const struct dmi_system_id *id)
581 {
582         dmi_check_cb_common(id);
583         fujitsu->keycode1 = KEY_SCREENLOCK;     /* "Lock" */
584         fujitsu->keycode2 = KEY_HELP;   /* "Mobility Center" */
585         return 1;
586 }
587
588 static int __init dmi_check_cb_s6420(const struct dmi_system_id *id)
589 {
590         dmi_check_cb_common(id);
591         fujitsu->keycode1 = KEY_SCREENLOCK;     /* "Lock" */
592         fujitsu->keycode2 = KEY_HELP;   /* "Mobility Center" */
593         return 1;
594 }
595
596 static int __init dmi_check_cb_p8010(const struct dmi_system_id *id)
597 {
598         dmi_check_cb_common(id);
599         fujitsu->keycode1 = KEY_HELP;   /* "Support" */
600         fujitsu->keycode3 = KEY_SWITCHVIDEOMODE;        /* "Presentation" */
601         fujitsu->keycode4 = KEY_WWW;    /* "Internet" */
602         return 1;
603 }
604
605 static const struct dmi_system_id fujitsu_dmi_table[] __initconst = {
606         {
607          .ident = "Fujitsu Siemens S6410",
608          .matches = {
609                      DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
610                      DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6410"),
611                      },
612          .callback = dmi_check_cb_s6410},
613         {
614          .ident = "Fujitsu Siemens S6420",
615          .matches = {
616                      DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
617                      DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6420"),
618                      },
619          .callback = dmi_check_cb_s6420},
620         {
621          .ident = "Fujitsu LifeBook P8010",
622          .matches = {
623                      DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"),
624                      DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook P8010"),
625                      },
626          .callback = dmi_check_cb_p8010},
627         {}
628 };
629
630 /* ACPI device for LCD brightness control */
631
632 static int acpi_fujitsu_add(struct acpi_device *device)
633 {
634         int state = 0;
635         struct input_dev *input;
636         int error;
637
638         if (!device)
639                 return -EINVAL;
640
641         fujitsu->acpi_handle = device->handle;
642         sprintf(acpi_device_name(device), "%s", ACPI_FUJITSU_DEVICE_NAME);
643         sprintf(acpi_device_class(device), "%s", ACPI_FUJITSU_CLASS);
644         device->driver_data = fujitsu;
645
646         fujitsu->input = input = input_allocate_device();
647         if (!input) {
648                 error = -ENOMEM;
649                 goto err_stop;
650         }
651
652         snprintf(fujitsu->phys, sizeof(fujitsu->phys),
653                  "%s/video/input0", acpi_device_hid(device));
654
655         input->name = acpi_device_name(device);
656         input->phys = fujitsu->phys;
657         input->id.bustype = BUS_HOST;
658         input->id.product = 0x06;
659         input->dev.parent = &device->dev;
660         input->evbit[0] = BIT(EV_KEY);
661         set_bit(KEY_BRIGHTNESSUP, input->keybit);
662         set_bit(KEY_BRIGHTNESSDOWN, input->keybit);
663         set_bit(KEY_UNKNOWN, input->keybit);
664
665         error = input_register_device(input);
666         if (error)
667                 goto err_free_input_dev;
668
669         error = acpi_bus_update_power(fujitsu->acpi_handle, &state);
670         if (error) {
671                 pr_err("Error reading power state\n");
672                 goto err_unregister_input_dev;
673         }
674
675         pr_info("ACPI: %s [%s] (%s)\n",
676                acpi_device_name(device), acpi_device_bid(device),
677                !device->power.state ? "on" : "off");
678
679         fujitsu->dev = device;
680
681         if (acpi_has_method(device->handle, METHOD_NAME__INI)) {
682                 vdbg_printk(FUJLAPTOP_DBG_INFO, "Invoking _INI\n");
683                 if (ACPI_FAILURE
684                     (acpi_evaluate_object
685                      (device->handle, METHOD_NAME__INI, NULL, NULL)))
686                         pr_err("_INI Method failed\n");
687         }
688
689         /* do config (detect defaults) */
690         use_alt_lcd_levels = use_alt_lcd_levels == 1 ? 1 : 0;
691         disable_brightness_adjust = disable_brightness_adjust == 1 ? 1 : 0;
692         vdbg_printk(FUJLAPTOP_DBG_INFO,
693                     "config: [alt interface: %d], [adjust disable: %d]\n",
694                     use_alt_lcd_levels, disable_brightness_adjust);
695
696         if (get_max_brightness() <= 0)
697                 fujitsu->max_brightness = FUJITSU_LCD_N_LEVELS;
698         get_lcd_level();
699
700         return 0;
701
702 err_unregister_input_dev:
703         input_unregister_device(input);
704         input = NULL;
705 err_free_input_dev:
706         input_free_device(input);
707 err_stop:
708         return error;
709 }
710
711 static int acpi_fujitsu_remove(struct acpi_device *device)
712 {
713         struct fujitsu_t *fujitsu = acpi_driver_data(device);
714         struct input_dev *input = fujitsu->input;
715
716         input_unregister_device(input);
717
718         fujitsu->acpi_handle = NULL;
719
720         return 0;
721 }
722
723 /* Brightness notify */
724
725 static void acpi_fujitsu_notify(struct acpi_device *device, u32 event)
726 {
727         struct input_dev *input;
728         int keycode;
729         int oldb, newb;
730
731         input = fujitsu->input;
732
733         switch (event) {
734         case ACPI_FUJITSU_NOTIFY_CODE1:
735                 keycode = 0;
736                 oldb = fujitsu->brightness_level;
737                 get_lcd_level();
738                 newb = fujitsu->brightness_level;
739
740                 vdbg_printk(FUJLAPTOP_DBG_TRACE,
741                             "brightness button event [%i -> %i (%i)]\n",
742                             oldb, newb, fujitsu->brightness_changed);
743
744                 if (oldb < newb) {
745                         if (disable_brightness_adjust != 1) {
746                                 if (use_alt_lcd_levels)
747                                         set_lcd_level_alt(newb);
748                                 else
749                                         set_lcd_level(newb);
750                         }
751                         keycode = KEY_BRIGHTNESSUP;
752                 } else if (oldb > newb) {
753                         if (disable_brightness_adjust != 1) {
754                                 if (use_alt_lcd_levels)
755                                         set_lcd_level_alt(newb);
756                                 else
757                                         set_lcd_level(newb);
758                         }
759                         keycode = KEY_BRIGHTNESSDOWN;
760                 }
761                 break;
762         default:
763                 keycode = KEY_UNKNOWN;
764                 vdbg_printk(FUJLAPTOP_DBG_WARN,
765                             "unsupported event [0x%x]\n", event);
766                 break;
767         }
768
769         if (keycode != 0) {
770                 input_report_key(input, keycode, 1);
771                 input_sync(input);
772                 input_report_key(input, keycode, 0);
773                 input_sync(input);
774         }
775 }
776
777 /* ACPI device for hotkey handling */
778
779 static int acpi_fujitsu_hotkey_add(struct acpi_device *device)
780 {
781         int result = 0;
782         int state = 0;
783         struct input_dev *input;
784         int error;
785         int i;
786
787         if (!device)
788                 return -EINVAL;
789
790         fujitsu_hotkey->acpi_handle = device->handle;
791         sprintf(acpi_device_name(device), "%s",
792                 ACPI_FUJITSU_HOTKEY_DEVICE_NAME);
793         sprintf(acpi_device_class(device), "%s", ACPI_FUJITSU_CLASS);
794         device->driver_data = fujitsu_hotkey;
795
796         /* kfifo */
797         spin_lock_init(&fujitsu_hotkey->fifo_lock);
798         error = kfifo_alloc(&fujitsu_hotkey->fifo, RINGBUFFERSIZE * sizeof(int),
799                         GFP_KERNEL);
800         if (error) {
801                 pr_err("kfifo_alloc failed\n");
802                 goto err_stop;
803         }
804
805         fujitsu_hotkey->input = input = input_allocate_device();
806         if (!input) {
807                 error = -ENOMEM;
808                 goto err_free_fifo;
809         }
810
811         snprintf(fujitsu_hotkey->phys, sizeof(fujitsu_hotkey->phys),
812                  "%s/video/input0", acpi_device_hid(device));
813
814         input->name = acpi_device_name(device);
815         input->phys = fujitsu_hotkey->phys;
816         input->id.bustype = BUS_HOST;
817         input->id.product = 0x06;
818         input->dev.parent = &device->dev;
819
820         set_bit(EV_KEY, input->evbit);
821         set_bit(fujitsu->keycode1, input->keybit);
822         set_bit(fujitsu->keycode2, input->keybit);
823         set_bit(fujitsu->keycode3, input->keybit);
824         set_bit(fujitsu->keycode4, input->keybit);
825         set_bit(KEY_UNKNOWN, input->keybit);
826
827         error = input_register_device(input);
828         if (error)
829                 goto err_free_input_dev;
830
831         error = acpi_bus_update_power(fujitsu_hotkey->acpi_handle, &state);
832         if (error) {
833                 pr_err("Error reading power state\n");
834                 goto err_unregister_input_dev;
835         }
836
837         pr_info("ACPI: %s [%s] (%s)\n",
838                 acpi_device_name(device), acpi_device_bid(device),
839                 !device->power.state ? "on" : "off");
840
841         fujitsu_hotkey->dev = device;
842
843         if (acpi_has_method(device->handle, METHOD_NAME__INI)) {
844                 vdbg_printk(FUJLAPTOP_DBG_INFO, "Invoking _INI\n");
845                 if (ACPI_FAILURE
846                     (acpi_evaluate_object
847                      (device->handle, METHOD_NAME__INI, NULL, NULL)))
848                         pr_err("_INI Method failed\n");
849         }
850
851         i = 0;
852         while (call_fext_func(FUNC_BUTTONS, 0x1, 0x0, 0x0) != 0
853                 && (i++) < MAX_HOTKEY_RINGBUFFER_SIZE)
854                 ; /* No action, result is discarded */
855         vdbg_printk(FUJLAPTOP_DBG_INFO, "Discarded %i ringbuffer entries\n", i);
856
857         fujitsu_hotkey->rfkill_supported =
858                 call_fext_func(FUNC_RFKILL, 0x0, 0x0, 0x0);
859
860         /* Make sure our bitmask of supported functions is cleared if the
861            RFKILL function block is not implemented, like on the S7020. */
862         if (fujitsu_hotkey->rfkill_supported == UNSUPPORTED_CMD)
863                 fujitsu_hotkey->rfkill_supported = 0;
864
865         if (fujitsu_hotkey->rfkill_supported)
866                 fujitsu_hotkey->rfkill_state =
867                         call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
868
869         /* Suspect this is a keymap of the application panel, print it */
870         pr_info("BTNI: [0x%x]\n", call_fext_func(FUNC_BUTTONS, 0x0, 0x0, 0x0));
871
872 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
873         if (call_fext_func(FUNC_LEDS, 0x0, 0x0, 0x0) & LOGOLAMP_POWERON) {
874                 result = led_classdev_register(&fujitsu->pf_device->dev,
875                                                 &logolamp_led);
876                 if (result == 0) {
877                         fujitsu_hotkey->logolamp_registered = 1;
878                 } else {
879                         pr_err("Could not register LED handler for logo lamp, error %i\n",
880                                result);
881                 }
882         }
883
884         if ((call_fext_func(FUNC_LEDS, 0x0, 0x0, 0x0) & KEYBOARD_LAMPS) &&
885            (call_fext_func(FUNC_BUTTONS, 0x0, 0x0, 0x0) == 0x0)) {
886                 result = led_classdev_register(&fujitsu->pf_device->dev,
887                                                 &kblamps_led);
888                 if (result == 0) {
889                         fujitsu_hotkey->kblamps_registered = 1;
890                 } else {
891                         pr_err("Could not register LED handler for keyboard lamps, error %i\n",
892                                result);
893                 }
894         }
895 #endif
896
897         return result;
898
899 err_unregister_input_dev:
900         input_unregister_device(input);
901         input = NULL;
902 err_free_input_dev:
903         input_free_device(input);
904 err_free_fifo:
905         kfifo_free(&fujitsu_hotkey->fifo);
906 err_stop:
907         return error;
908 }
909
910 static int acpi_fujitsu_hotkey_remove(struct acpi_device *device)
911 {
912         struct fujitsu_hotkey_t *fujitsu_hotkey = acpi_driver_data(device);
913         struct input_dev *input = fujitsu_hotkey->input;
914
915 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
916         if (fujitsu_hotkey->logolamp_registered)
917                 led_classdev_unregister(&logolamp_led);
918
919         if (fujitsu_hotkey->kblamps_registered)
920                 led_classdev_unregister(&kblamps_led);
921 #endif
922
923         input_unregister_device(input);
924
925         kfifo_free(&fujitsu_hotkey->fifo);
926
927         fujitsu_hotkey->acpi_handle = NULL;
928
929         return 0;
930 }
931
932 static void acpi_fujitsu_hotkey_notify(struct acpi_device *device, u32 event)
933 {
934         struct input_dev *input;
935         int keycode, keycode_r;
936         unsigned int irb = 1;
937         int i, status;
938
939         input = fujitsu_hotkey->input;
940
941         if (fujitsu_hotkey->rfkill_supported)
942                 fujitsu_hotkey->rfkill_state =
943                         call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
944
945         switch (event) {
946         case ACPI_FUJITSU_NOTIFY_CODE1:
947                 i = 0;
948                 while ((irb =
949                         call_fext_func(FUNC_BUTTONS, 0x1, 0x0, 0x0)) != 0
950                                 && (i++) < MAX_HOTKEY_RINGBUFFER_SIZE) {
951                         switch (irb & 0x4ff) {
952                         case KEY1_CODE:
953                                 keycode = fujitsu->keycode1;
954                                 break;
955                         case KEY2_CODE:
956                                 keycode = fujitsu->keycode2;
957                                 break;
958                         case KEY3_CODE:
959                                 keycode = fujitsu->keycode3;
960                                 break;
961                         case KEY4_CODE:
962                                 keycode = fujitsu->keycode4;
963                                 break;
964                         case 0:
965                                 keycode = 0;
966                                 break;
967                         default:
968                                 vdbg_printk(FUJLAPTOP_DBG_WARN,
969                                             "Unknown GIRB result [%x]\n", irb);
970                                 keycode = -1;
971                                 break;
972                         }
973                         if (keycode > 0) {
974                                 vdbg_printk(FUJLAPTOP_DBG_TRACE,
975                                         "Push keycode into ringbuffer [%d]\n",
976                                         keycode);
977                                 status = kfifo_in_locked(&fujitsu_hotkey->fifo,
978                                                    (unsigned char *)&keycode,
979                                                    sizeof(keycode),
980                                                    &fujitsu_hotkey->fifo_lock);
981                                 if (status != sizeof(keycode)) {
982                                         vdbg_printk(FUJLAPTOP_DBG_WARN,
983                                             "Could not push keycode [0x%x]\n",
984                                             keycode);
985                                 } else {
986                                         input_report_key(input, keycode, 1);
987                                         input_sync(input);
988                                 }
989                         } else if (keycode == 0) {
990                                 while ((status =
991                                         kfifo_out_locked(
992                                          &fujitsu_hotkey->fifo,
993                                          (unsigned char *) &keycode_r,
994                                          sizeof(keycode_r),
995                                          &fujitsu_hotkey->fifo_lock))
996                                          == sizeof(keycode_r)) {
997                                         input_report_key(input, keycode_r, 0);
998                                         input_sync(input);
999                                         vdbg_printk(FUJLAPTOP_DBG_TRACE,
1000                                           "Pop keycode from ringbuffer [%d]\n",
1001                                           keycode_r);
1002                                 }
1003                         }
1004                 }
1005
1006                 break;
1007         default:
1008                 keycode = KEY_UNKNOWN;
1009                 vdbg_printk(FUJLAPTOP_DBG_WARN,
1010                             "Unsupported event [0x%x]\n", event);
1011                 input_report_key(input, keycode, 1);
1012                 input_sync(input);
1013                 input_report_key(input, keycode, 0);
1014                 input_sync(input);
1015                 break;
1016         }
1017 }
1018
1019 /* Initialization */
1020
1021 static const struct acpi_device_id fujitsu_device_ids[] = {
1022         {ACPI_FUJITSU_HID, 0},
1023         {"", 0},
1024 };
1025
1026 static struct acpi_driver acpi_fujitsu_driver = {
1027         .name = ACPI_FUJITSU_DRIVER_NAME,
1028         .class = ACPI_FUJITSU_CLASS,
1029         .ids = fujitsu_device_ids,
1030         .ops = {
1031                 .add = acpi_fujitsu_add,
1032                 .remove = acpi_fujitsu_remove,
1033                 .notify = acpi_fujitsu_notify,
1034                 },
1035 };
1036
1037 static const struct acpi_device_id fujitsu_hotkey_device_ids[] = {
1038         {ACPI_FUJITSU_HOTKEY_HID, 0},
1039         {"", 0},
1040 };
1041
1042 static struct acpi_driver acpi_fujitsu_hotkey_driver = {
1043         .name = ACPI_FUJITSU_HOTKEY_DRIVER_NAME,
1044         .class = ACPI_FUJITSU_CLASS,
1045         .ids = fujitsu_hotkey_device_ids,
1046         .ops = {
1047                 .add = acpi_fujitsu_hotkey_add,
1048                 .remove = acpi_fujitsu_hotkey_remove,
1049                 .notify = acpi_fujitsu_hotkey_notify,
1050                 },
1051 };
1052
1053 static const struct acpi_device_id fujitsu_ids[] __used = {
1054         {ACPI_FUJITSU_HID, 0},
1055         {ACPI_FUJITSU_HOTKEY_HID, 0},
1056         {"", 0}
1057 };
1058 MODULE_DEVICE_TABLE(acpi, fujitsu_ids);
1059
1060 static int __init fujitsu_init(void)
1061 {
1062         int ret, result, max_brightness;
1063
1064         if (acpi_disabled)
1065                 return -ENODEV;
1066
1067         fujitsu = kzalloc(sizeof(struct fujitsu_t), GFP_KERNEL);
1068         if (!fujitsu)
1069                 return -ENOMEM;
1070         fujitsu->keycode1 = KEY_PROG1;
1071         fujitsu->keycode2 = KEY_PROG2;
1072         fujitsu->keycode3 = KEY_PROG3;
1073         fujitsu->keycode4 = KEY_PROG4;
1074         dmi_check_system(fujitsu_dmi_table);
1075
1076         result = acpi_bus_register_driver(&acpi_fujitsu_driver);
1077         if (result < 0) {
1078                 ret = -ENODEV;
1079                 goto fail_acpi;
1080         }
1081
1082         /* Register platform stuff */
1083
1084         fujitsu->pf_device = platform_device_alloc("fujitsu-laptop", -1);
1085         if (!fujitsu->pf_device) {
1086                 ret = -ENOMEM;
1087                 goto fail_platform_driver;
1088         }
1089
1090         ret = platform_device_add(fujitsu->pf_device);
1091         if (ret)
1092                 goto fail_platform_device1;
1093
1094         ret =
1095             sysfs_create_group(&fujitsu->pf_device->dev.kobj,
1096                                &fujitsupf_attribute_group);
1097         if (ret)
1098                 goto fail_platform_device2;
1099
1100         /* Register backlight stuff */
1101
1102         if (!acpi_video_backlight_support()) {
1103                 struct backlight_properties props;
1104
1105                 memset(&props, 0, sizeof(struct backlight_properties));
1106                 max_brightness = fujitsu->max_brightness;
1107                 props.type = BACKLIGHT_PLATFORM;
1108                 props.max_brightness = max_brightness - 1;
1109                 fujitsu->bl_device = backlight_device_register("fujitsu-laptop",
1110                                                                NULL, NULL,
1111                                                                &fujitsubl_ops,
1112                                                                &props);
1113                 if (IS_ERR(fujitsu->bl_device)) {
1114                         ret = PTR_ERR(fujitsu->bl_device);
1115                         fujitsu->bl_device = NULL;
1116                         goto fail_sysfs_group;
1117                 }
1118                 fujitsu->bl_device->props.brightness = fujitsu->brightness_level;
1119         }
1120
1121         ret = platform_driver_register(&fujitsupf_driver);
1122         if (ret)
1123                 goto fail_backlight;
1124
1125         /* Register hotkey driver */
1126
1127         fujitsu_hotkey = kzalloc(sizeof(struct fujitsu_hotkey_t), GFP_KERNEL);
1128         if (!fujitsu_hotkey) {
1129                 ret = -ENOMEM;
1130                 goto fail_hotkey;
1131         }
1132
1133         result = acpi_bus_register_driver(&acpi_fujitsu_hotkey_driver);
1134         if (result < 0) {
1135                 ret = -ENODEV;
1136                 goto fail_hotkey1;
1137         }
1138
1139         /* Sync backlight power status (needs FUJ02E3 device, hence deferred) */
1140
1141         if (!acpi_video_backlight_support()) {
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:*");