Merge branch 'fixes' of git://git.kernel.org/pub/scm/linux/kernel/git/evalenti/linux...
[linux/fpc-iii.git] / drivers / platform / x86 / fujitsu-laptop.c
blobffc84cc7b1c79fc8b8bdecd5cd2ae1201b338194
1 /*-*-linux-c-*-*/
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>
11 Templated from msi-laptop.c and thinkpad_acpi.c which is copyright
12 by its respective authors.
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.
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.
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.
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.
35 * This driver exports a few files in /sys/devices/platform/fujitsu-laptop/;
36 * others may be added at a later date.
38 * lcd_level - Screen brightness: contains a single integer in the
39 * range 0..7. (rw)
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/.
45 * Hotkeys present on certain Fujitsu laptops (eg: the S6xxx series) are
46 * also supported by this driver.
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.
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.
59 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
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>
77 #define FUJITSU_DRIVER_VERSION "0.6.0"
79 #define FUJITSU_LCD_N_LEVELS 8
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"
89 #define ACPI_FUJITSU_NOTIFY_CODE1 0x80
91 #define ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS 0x86
92 #define ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS 0x87
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
100 /* FUNC interface - responses */
101 #define UNSUPPORTED_CMD 0x80000000
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
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 #define KEY5_CODE 0x420
119 #define MAX_HOTKEY_RINGBUFFER_SIZE 100
120 #define RINGBUFFERSIZE 40
122 /* Debugging */
123 #define FUJLAPTOP_LOG ACPI_FUJITSU_HID ": "
124 #define FUJLAPTOP_ERR KERN_ERR FUJLAPTOP_LOG
125 #define FUJLAPTOP_NOTICE KERN_NOTICE FUJLAPTOP_LOG
126 #define FUJLAPTOP_INFO KERN_INFO FUJLAPTOP_LOG
127 #define FUJLAPTOP_DEBUG KERN_DEBUG FUJLAPTOP_LOG
129 #define FUJLAPTOP_DBG_ALL 0xffff
130 #define FUJLAPTOP_DBG_ERROR 0x0001
131 #define FUJLAPTOP_DBG_WARN 0x0002
132 #define FUJLAPTOP_DBG_INFO 0x0004
133 #define FUJLAPTOP_DBG_TRACE 0x0008
135 #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
136 #define vdbg_printk(a_dbg_level, format, arg...) \
137 do { if (dbg_level & a_dbg_level) \
138 printk(FUJLAPTOP_DEBUG "%s: " format, __func__ , ## arg); \
139 } while (0)
140 #else
141 #define vdbg_printk(a_dbg_level, format, arg...) \
142 do { } while (0)
143 #endif
145 /* Device controlling the backlight and associated keys */
146 struct fujitsu_t {
147 acpi_handle acpi_handle;
148 struct acpi_device *dev;
149 struct input_dev *input;
150 char phys[32];
151 struct backlight_device *bl_device;
152 struct platform_device *pf_device;
153 int keycode1, keycode2, keycode3, keycode4, keycode5;
155 unsigned int max_brightness;
156 unsigned int brightness_changed;
157 unsigned int brightness_level;
160 static struct fujitsu_t *fujitsu;
161 static int use_alt_lcd_levels = -1;
162 static int disable_brightness_adjust = -1;
164 /* Device used to access other hotkeys on the laptop */
165 struct fujitsu_hotkey_t {
166 acpi_handle acpi_handle;
167 struct acpi_device *dev;
168 struct input_dev *input;
169 char phys[32];
170 struct platform_device *pf_device;
171 struct kfifo fifo;
172 spinlock_t fifo_lock;
173 int rfkill_supported;
174 int rfkill_state;
175 int logolamp_registered;
176 int kblamps_registered;
179 static struct fujitsu_hotkey_t *fujitsu_hotkey;
181 static void acpi_fujitsu_hotkey_notify(struct acpi_device *device, u32 event);
183 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
184 static enum led_brightness logolamp_get(struct led_classdev *cdev);
185 static void logolamp_set(struct led_classdev *cdev,
186 enum led_brightness brightness);
188 static struct led_classdev logolamp_led = {
189 .name = "fujitsu::logolamp",
190 .brightness_get = logolamp_get,
191 .brightness_set = logolamp_set
194 static enum led_brightness kblamps_get(struct led_classdev *cdev);
195 static void kblamps_set(struct led_classdev *cdev,
196 enum led_brightness brightness);
198 static struct led_classdev kblamps_led = {
199 .name = "fujitsu::kblamps",
200 .brightness_get = kblamps_get,
201 .brightness_set = kblamps_set
203 #endif
205 #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
206 static u32 dbg_level = 0x03;
207 #endif
209 static void acpi_fujitsu_notify(struct acpi_device *device, u32 event);
211 /* Fujitsu ACPI interface function */
213 static int call_fext_func(int cmd, int arg0, int arg1, int arg2)
215 acpi_status status = AE_OK;
216 union acpi_object params[4] = {
217 { .type = ACPI_TYPE_INTEGER },
218 { .type = ACPI_TYPE_INTEGER },
219 { .type = ACPI_TYPE_INTEGER },
220 { .type = ACPI_TYPE_INTEGER }
222 struct acpi_object_list arg_list = { 4, &params[0] };
223 unsigned long long value;
224 acpi_handle handle = NULL;
226 status = acpi_get_handle(fujitsu_hotkey->acpi_handle, "FUNC", &handle);
227 if (ACPI_FAILURE(status)) {
228 vdbg_printk(FUJLAPTOP_DBG_ERROR,
229 "FUNC interface is not present\n");
230 return -ENODEV;
233 params[0].integer.value = cmd;
234 params[1].integer.value = arg0;
235 params[2].integer.value = arg1;
236 params[3].integer.value = arg2;
238 status = acpi_evaluate_integer(handle, NULL, &arg_list, &value);
239 if (ACPI_FAILURE(status)) {
240 vdbg_printk(FUJLAPTOP_DBG_WARN,
241 "FUNC 0x%x (args 0x%x, 0x%x, 0x%x) call failed\n",
242 cmd, arg0, arg1, arg2);
243 return -ENODEV;
246 vdbg_printk(FUJLAPTOP_DBG_TRACE,
247 "FUNC 0x%x (args 0x%x, 0x%x, 0x%x) returned 0x%x\n",
248 cmd, arg0, arg1, arg2, (int)value);
249 return value;
252 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
253 /* LED class callbacks */
255 static void logolamp_set(struct led_classdev *cdev,
256 enum led_brightness brightness)
258 if (brightness >= LED_FULL) {
259 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_ON);
260 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_ALWAYS, FUNC_LED_ON);
261 } else if (brightness >= LED_HALF) {
262 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_ON);
263 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_ALWAYS, FUNC_LED_OFF);
264 } else {
265 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_OFF);
269 static void kblamps_set(struct led_classdev *cdev,
270 enum led_brightness brightness)
272 if (brightness >= LED_FULL)
273 call_fext_func(FUNC_LEDS, 0x1, KEYBOARD_LAMPS, FUNC_LED_ON);
274 else
275 call_fext_func(FUNC_LEDS, 0x1, KEYBOARD_LAMPS, FUNC_LED_OFF);
278 static enum led_brightness logolamp_get(struct led_classdev *cdev)
280 enum led_brightness brightness = LED_OFF;
281 int poweron, always;
283 poweron = call_fext_func(FUNC_LEDS, 0x2, LOGOLAMP_POWERON, 0x0);
284 if (poweron == FUNC_LED_ON) {
285 brightness = LED_HALF;
286 always = call_fext_func(FUNC_LEDS, 0x2, LOGOLAMP_ALWAYS, 0x0);
287 if (always == FUNC_LED_ON)
288 brightness = LED_FULL;
290 return brightness;
293 static enum led_brightness kblamps_get(struct led_classdev *cdev)
295 enum led_brightness brightness = LED_OFF;
297 if (call_fext_func(FUNC_LEDS, 0x2, KEYBOARD_LAMPS, 0x0) == FUNC_LED_ON)
298 brightness = LED_FULL;
300 return brightness;
302 #endif
304 /* Hardware access for LCD brightness control */
306 static int set_lcd_level(int level)
308 acpi_status status = AE_OK;
309 acpi_handle handle = NULL;
311 vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBLL [%d]\n",
312 level);
314 if (level < 0 || level >= fujitsu->max_brightness)
315 return -EINVAL;
317 status = acpi_get_handle(fujitsu->acpi_handle, "SBLL", &handle);
318 if (ACPI_FAILURE(status)) {
319 vdbg_printk(FUJLAPTOP_DBG_ERROR, "SBLL not present\n");
320 return -ENODEV;
324 status = acpi_execute_simple_method(handle, NULL, level);
325 if (ACPI_FAILURE(status))
326 return -ENODEV;
328 return 0;
331 static int set_lcd_level_alt(int level)
333 acpi_status status = AE_OK;
334 acpi_handle handle = NULL;
336 vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBL2 [%d]\n",
337 level);
339 if (level < 0 || level >= fujitsu->max_brightness)
340 return -EINVAL;
342 status = acpi_get_handle(fujitsu->acpi_handle, "SBL2", &handle);
343 if (ACPI_FAILURE(status)) {
344 vdbg_printk(FUJLAPTOP_DBG_ERROR, "SBL2 not present\n");
345 return -ENODEV;
348 status = acpi_execute_simple_method(handle, NULL, level);
349 if (ACPI_FAILURE(status))
350 return -ENODEV;
352 return 0;
355 static int get_lcd_level(void)
357 unsigned long long state = 0;
358 acpi_status status = AE_OK;
360 vdbg_printk(FUJLAPTOP_DBG_TRACE, "get lcd level via GBLL\n");
362 status =
363 acpi_evaluate_integer(fujitsu->acpi_handle, "GBLL", NULL, &state);
364 if (ACPI_FAILURE(status))
365 return 0;
367 fujitsu->brightness_level = state & 0x0fffffff;
369 if (state & 0x80000000)
370 fujitsu->brightness_changed = 1;
371 else
372 fujitsu->brightness_changed = 0;
374 return fujitsu->brightness_level;
377 static int get_max_brightness(void)
379 unsigned long long state = 0;
380 acpi_status status = AE_OK;
382 vdbg_printk(FUJLAPTOP_DBG_TRACE, "get max lcd level via RBLL\n");
384 status =
385 acpi_evaluate_integer(fujitsu->acpi_handle, "RBLL", NULL, &state);
386 if (ACPI_FAILURE(status))
387 return -1;
389 fujitsu->max_brightness = state;
391 return fujitsu->max_brightness;
394 /* Backlight device stuff */
396 static int bl_get_brightness(struct backlight_device *b)
398 return get_lcd_level();
401 static int bl_update_status(struct backlight_device *b)
403 int ret;
404 if (b->props.power == FB_BLANK_POWERDOWN)
405 ret = call_fext_func(FUNC_BACKLIGHT, 0x1, 0x4, 0x3);
406 else
407 ret = call_fext_func(FUNC_BACKLIGHT, 0x1, 0x4, 0x0);
408 if (ret != 0)
409 vdbg_printk(FUJLAPTOP_DBG_ERROR,
410 "Unable to adjust backlight power, error code %i\n",
411 ret);
413 if (use_alt_lcd_levels)
414 ret = set_lcd_level_alt(b->props.brightness);
415 else
416 ret = set_lcd_level(b->props.brightness);
417 if (ret != 0)
418 vdbg_printk(FUJLAPTOP_DBG_ERROR,
419 "Unable to adjust LCD brightness, error code %i\n",
420 ret);
421 return ret;
424 static const struct backlight_ops fujitsubl_ops = {
425 .get_brightness = bl_get_brightness,
426 .update_status = bl_update_status,
429 /* Platform LCD brightness device */
431 static ssize_t
432 show_max_brightness(struct device *dev,
433 struct device_attribute *attr, char *buf)
436 int ret;
438 ret = get_max_brightness();
439 if (ret < 0)
440 return ret;
442 return sprintf(buf, "%i\n", ret);
445 static ssize_t
446 show_brightness_changed(struct device *dev,
447 struct device_attribute *attr, char *buf)
450 int ret;
452 ret = fujitsu->brightness_changed;
453 if (ret < 0)
454 return ret;
456 return sprintf(buf, "%i\n", ret);
459 static ssize_t show_lcd_level(struct device *dev,
460 struct device_attribute *attr, char *buf)
463 int ret;
465 ret = get_lcd_level();
466 if (ret < 0)
467 return ret;
469 return sprintf(buf, "%i\n", ret);
472 static ssize_t store_lcd_level(struct device *dev,
473 struct device_attribute *attr, const char *buf,
474 size_t count)
477 int level, ret;
479 if (sscanf(buf, "%i", &level) != 1
480 || (level < 0 || level >= fujitsu->max_brightness))
481 return -EINVAL;
483 if (use_alt_lcd_levels)
484 ret = set_lcd_level_alt(level);
485 else
486 ret = set_lcd_level(level);
487 if (ret < 0)
488 return ret;
490 ret = get_lcd_level();
491 if (ret < 0)
492 return ret;
494 return count;
497 static ssize_t
498 ignore_store(struct device *dev,
499 struct device_attribute *attr, const char *buf, size_t count)
501 return count;
504 static ssize_t
505 show_lid_state(struct device *dev,
506 struct device_attribute *attr, char *buf)
508 if (!(fujitsu_hotkey->rfkill_supported & 0x100))
509 return sprintf(buf, "unknown\n");
510 if (fujitsu_hotkey->rfkill_state & 0x100)
511 return sprintf(buf, "open\n");
512 else
513 return sprintf(buf, "closed\n");
516 static ssize_t
517 show_dock_state(struct device *dev,
518 struct device_attribute *attr, char *buf)
520 if (!(fujitsu_hotkey->rfkill_supported & 0x200))
521 return sprintf(buf, "unknown\n");
522 if (fujitsu_hotkey->rfkill_state & 0x200)
523 return sprintf(buf, "docked\n");
524 else
525 return sprintf(buf, "undocked\n");
528 static ssize_t
529 show_radios_state(struct device *dev,
530 struct device_attribute *attr, char *buf)
532 if (!(fujitsu_hotkey->rfkill_supported & 0x20))
533 return sprintf(buf, "unknown\n");
534 if (fujitsu_hotkey->rfkill_state & 0x20)
535 return sprintf(buf, "on\n");
536 else
537 return sprintf(buf, "killed\n");
540 static DEVICE_ATTR(max_brightness, 0444, show_max_brightness, ignore_store);
541 static DEVICE_ATTR(brightness_changed, 0444, show_brightness_changed,
542 ignore_store);
543 static DEVICE_ATTR(lcd_level, 0644, show_lcd_level, store_lcd_level);
544 static DEVICE_ATTR(lid, 0444, show_lid_state, ignore_store);
545 static DEVICE_ATTR(dock, 0444, show_dock_state, ignore_store);
546 static DEVICE_ATTR(radios, 0444, show_radios_state, ignore_store);
548 static struct attribute *fujitsupf_attributes[] = {
549 &dev_attr_brightness_changed.attr,
550 &dev_attr_max_brightness.attr,
551 &dev_attr_lcd_level.attr,
552 &dev_attr_lid.attr,
553 &dev_attr_dock.attr,
554 &dev_attr_radios.attr,
555 NULL
558 static struct attribute_group fujitsupf_attribute_group = {
559 .attrs = fujitsupf_attributes
562 static struct platform_driver fujitsupf_driver = {
563 .driver = {
564 .name = "fujitsu-laptop",
568 static void __init dmi_check_cb_common(const struct dmi_system_id *id)
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);
582 static int __init dmi_check_cb_s6410(const struct dmi_system_id *id)
584 dmi_check_cb_common(id);
585 fujitsu->keycode1 = KEY_SCREENLOCK; /* "Lock" */
586 fujitsu->keycode2 = KEY_HELP; /* "Mobility Center" */
587 return 1;
590 static int __init dmi_check_cb_s6420(const struct dmi_system_id *id)
592 dmi_check_cb_common(id);
593 fujitsu->keycode1 = KEY_SCREENLOCK; /* "Lock" */
594 fujitsu->keycode2 = KEY_HELP; /* "Mobility Center" */
595 return 1;
598 static int __init dmi_check_cb_p8010(const struct dmi_system_id *id)
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;
607 static const struct dmi_system_id fujitsu_dmi_table[] __initconst = {
609 .ident = "Fujitsu Siemens S6410",
610 .matches = {
611 DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
612 DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6410"),
614 .callback = dmi_check_cb_s6410},
616 .ident = "Fujitsu Siemens S6420",
617 .matches = {
618 DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
619 DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6420"),
621 .callback = dmi_check_cb_s6420},
623 .ident = "Fujitsu LifeBook P8010",
624 .matches = {
625 DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"),
626 DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook P8010"),
628 .callback = dmi_check_cb_p8010},
632 /* ACPI device for LCD brightness control */
634 static int acpi_fujitsu_add(struct acpi_device *device)
636 int state = 0;
637 struct input_dev *input;
638 int error;
640 if (!device)
641 return -EINVAL;
643 fujitsu->acpi_handle = device->handle;
644 sprintf(acpi_device_name(device), "%s", ACPI_FUJITSU_DEVICE_NAME);
645 sprintf(acpi_device_class(device), "%s", ACPI_FUJITSU_CLASS);
646 device->driver_data = fujitsu;
648 fujitsu->input = input = input_allocate_device();
649 if (!input) {
650 error = -ENOMEM;
651 goto err_stop;
654 snprintf(fujitsu->phys, sizeof(fujitsu->phys),
655 "%s/video/input0", acpi_device_hid(device));
657 input->name = acpi_device_name(device);
658 input->phys = fujitsu->phys;
659 input->id.bustype = BUS_HOST;
660 input->id.product = 0x06;
661 input->dev.parent = &device->dev;
662 input->evbit[0] = BIT(EV_KEY);
663 set_bit(KEY_BRIGHTNESSUP, input->keybit);
664 set_bit(KEY_BRIGHTNESSDOWN, input->keybit);
665 set_bit(KEY_UNKNOWN, input->keybit);
667 error = input_register_device(input);
668 if (error)
669 goto err_free_input_dev;
671 error = acpi_bus_update_power(fujitsu->acpi_handle, &state);
672 if (error) {
673 pr_err("Error reading power state\n");
674 goto err_unregister_input_dev;
677 pr_info("ACPI: %s [%s] (%s)\n",
678 acpi_device_name(device), acpi_device_bid(device),
679 !device->power.state ? "on" : "off");
681 fujitsu->dev = device;
683 if (acpi_has_method(device->handle, METHOD_NAME__INI)) {
684 vdbg_printk(FUJLAPTOP_DBG_INFO, "Invoking _INI\n");
685 if (ACPI_FAILURE
686 (acpi_evaluate_object
687 (device->handle, METHOD_NAME__INI, NULL, NULL)))
688 pr_err("_INI Method failed\n");
691 /* do config (detect defaults) */
692 use_alt_lcd_levels = use_alt_lcd_levels == 1 ? 1 : 0;
693 disable_brightness_adjust = disable_brightness_adjust == 1 ? 1 : 0;
694 vdbg_printk(FUJLAPTOP_DBG_INFO,
695 "config: [alt interface: %d], [adjust disable: %d]\n",
696 use_alt_lcd_levels, disable_brightness_adjust);
698 if (get_max_brightness() <= 0)
699 fujitsu->max_brightness = FUJITSU_LCD_N_LEVELS;
700 get_lcd_level();
702 return 0;
704 err_unregister_input_dev:
705 input_unregister_device(input);
706 input = NULL;
707 err_free_input_dev:
708 input_free_device(input);
709 err_stop:
710 return error;
713 static int acpi_fujitsu_remove(struct acpi_device *device)
715 struct fujitsu_t *fujitsu = acpi_driver_data(device);
716 struct input_dev *input = fujitsu->input;
718 input_unregister_device(input);
720 fujitsu->acpi_handle = NULL;
722 return 0;
725 /* Brightness notify */
727 static void acpi_fujitsu_notify(struct acpi_device *device, u32 event)
729 struct input_dev *input;
730 int keycode;
731 int oldb, newb;
733 input = fujitsu->input;
735 switch (event) {
736 case ACPI_FUJITSU_NOTIFY_CODE1:
737 keycode = 0;
738 oldb = fujitsu->brightness_level;
739 get_lcd_level();
740 newb = fujitsu->brightness_level;
742 vdbg_printk(FUJLAPTOP_DBG_TRACE,
743 "brightness button event [%i -> %i (%i)]\n",
744 oldb, newb, fujitsu->brightness_changed);
746 if (oldb < newb) {
747 if (disable_brightness_adjust != 1) {
748 if (use_alt_lcd_levels)
749 set_lcd_level_alt(newb);
750 else
751 set_lcd_level(newb);
753 keycode = KEY_BRIGHTNESSUP;
754 } else if (oldb > newb) {
755 if (disable_brightness_adjust != 1) {
756 if (use_alt_lcd_levels)
757 set_lcd_level_alt(newb);
758 else
759 set_lcd_level(newb);
761 keycode = KEY_BRIGHTNESSDOWN;
763 break;
764 default:
765 keycode = KEY_UNKNOWN;
766 vdbg_printk(FUJLAPTOP_DBG_WARN,
767 "unsupported event [0x%x]\n", event);
768 break;
771 if (keycode != 0) {
772 input_report_key(input, keycode, 1);
773 input_sync(input);
774 input_report_key(input, keycode, 0);
775 input_sync(input);
779 /* ACPI device for hotkey handling */
781 static int acpi_fujitsu_hotkey_add(struct acpi_device *device)
783 int result = 0;
784 int state = 0;
785 struct input_dev *input;
786 int error;
787 int i;
789 if (!device)
790 return -EINVAL;
792 fujitsu_hotkey->acpi_handle = device->handle;
793 sprintf(acpi_device_name(device), "%s",
794 ACPI_FUJITSU_HOTKEY_DEVICE_NAME);
795 sprintf(acpi_device_class(device), "%s", ACPI_FUJITSU_CLASS);
796 device->driver_data = fujitsu_hotkey;
798 /* kfifo */
799 spin_lock_init(&fujitsu_hotkey->fifo_lock);
800 error = kfifo_alloc(&fujitsu_hotkey->fifo, RINGBUFFERSIZE * sizeof(int),
801 GFP_KERNEL);
802 if (error) {
803 pr_err("kfifo_alloc failed\n");
804 goto err_stop;
807 fujitsu_hotkey->input = input = input_allocate_device();
808 if (!input) {
809 error = -ENOMEM;
810 goto err_free_fifo;
813 snprintf(fujitsu_hotkey->phys, sizeof(fujitsu_hotkey->phys),
814 "%s/video/input0", acpi_device_hid(device));
816 input->name = acpi_device_name(device);
817 input->phys = fujitsu_hotkey->phys;
818 input->id.bustype = BUS_HOST;
819 input->id.product = 0x06;
820 input->dev.parent = &device->dev;
822 set_bit(EV_KEY, input->evbit);
823 set_bit(fujitsu->keycode1, input->keybit);
824 set_bit(fujitsu->keycode2, input->keybit);
825 set_bit(fujitsu->keycode3, input->keybit);
826 set_bit(fujitsu->keycode4, input->keybit);
827 set_bit(fujitsu->keycode5, input->keybit);
828 set_bit(KEY_UNKNOWN, input->keybit);
830 error = input_register_device(input);
831 if (error)
832 goto err_free_input_dev;
834 error = acpi_bus_update_power(fujitsu_hotkey->acpi_handle, &state);
835 if (error) {
836 pr_err("Error reading power state\n");
837 goto err_unregister_input_dev;
840 pr_info("ACPI: %s [%s] (%s)\n",
841 acpi_device_name(device), acpi_device_bid(device),
842 !device->power.state ? "on" : "off");
844 fujitsu_hotkey->dev = device;
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");
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);
860 fujitsu_hotkey->rfkill_supported =
861 call_fext_func(FUNC_RFKILL, 0x0, 0x0, 0x0);
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;
868 if (fujitsu_hotkey->rfkill_supported)
869 fujitsu_hotkey->rfkill_state =
870 call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
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));
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);
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);
898 #endif
900 return result;
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 error;
913 static int acpi_fujitsu_hotkey_remove(struct acpi_device *device)
915 struct fujitsu_hotkey_t *fujitsu_hotkey = acpi_driver_data(device);
916 struct input_dev *input = fujitsu_hotkey->input;
918 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
919 if (fujitsu_hotkey->logolamp_registered)
920 led_classdev_unregister(&logolamp_led);
922 if (fujitsu_hotkey->kblamps_registered)
923 led_classdev_unregister(&kblamps_led);
924 #endif
926 input_unregister_device(input);
928 kfifo_free(&fujitsu_hotkey->fifo);
930 fujitsu_hotkey->acpi_handle = NULL;
932 return 0;
935 static void acpi_fujitsu_hotkey_notify(struct acpi_device *device, u32 event)
937 struct input_dev *input;
938 int keycode, keycode_r;
939 unsigned int irb = 1;
940 int i, status;
942 input = fujitsu_hotkey->input;
944 if (fujitsu_hotkey->rfkill_supported)
945 fujitsu_hotkey->rfkill_state =
946 call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
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 KEY5_CODE:
968 keycode = fujitsu->keycode5;
969 break;
970 case 0:
971 keycode = 0;
972 break;
973 default:
974 vdbg_printk(FUJLAPTOP_DBG_WARN,
975 "Unknown GIRB result [%x]\n", irb);
976 keycode = -1;
977 break;
979 if (keycode > 0) {
980 vdbg_printk(FUJLAPTOP_DBG_TRACE,
981 "Push keycode into ringbuffer [%d]\n",
982 keycode);
983 status = kfifo_in_locked(&fujitsu_hotkey->fifo,
984 (unsigned char *)&keycode,
985 sizeof(keycode),
986 &fujitsu_hotkey->fifo_lock);
987 if (status != sizeof(keycode)) {
988 vdbg_printk(FUJLAPTOP_DBG_WARN,
989 "Could not push keycode [0x%x]\n",
990 keycode);
991 } else {
992 input_report_key(input, keycode, 1);
993 input_sync(input);
995 } else if (keycode == 0) {
996 while ((status =
997 kfifo_out_locked(
998 &fujitsu_hotkey->fifo,
999 (unsigned char *) &keycode_r,
1000 sizeof(keycode_r),
1001 &fujitsu_hotkey->fifo_lock))
1002 == sizeof(keycode_r)) {
1003 input_report_key(input, keycode_r, 0);
1004 input_sync(input);
1005 vdbg_printk(FUJLAPTOP_DBG_TRACE,
1006 "Pop keycode from ringbuffer [%d]\n",
1007 keycode_r);
1012 break;
1013 default:
1014 keycode = KEY_UNKNOWN;
1015 vdbg_printk(FUJLAPTOP_DBG_WARN,
1016 "Unsupported event [0x%x]\n", event);
1017 input_report_key(input, keycode, 1);
1018 input_sync(input);
1019 input_report_key(input, keycode, 0);
1020 input_sync(input);
1021 break;
1025 /* Initialization */
1027 static const struct acpi_device_id fujitsu_device_ids[] = {
1028 {ACPI_FUJITSU_HID, 0},
1029 {"", 0},
1032 static struct acpi_driver acpi_fujitsu_driver = {
1033 .name = ACPI_FUJITSU_DRIVER_NAME,
1034 .class = ACPI_FUJITSU_CLASS,
1035 .ids = fujitsu_device_ids,
1036 .ops = {
1037 .add = acpi_fujitsu_add,
1038 .remove = acpi_fujitsu_remove,
1039 .notify = acpi_fujitsu_notify,
1043 static const struct acpi_device_id fujitsu_hotkey_device_ids[] = {
1044 {ACPI_FUJITSU_HOTKEY_HID, 0},
1045 {"", 0},
1048 static struct acpi_driver acpi_fujitsu_hotkey_driver = {
1049 .name = ACPI_FUJITSU_HOTKEY_DRIVER_NAME,
1050 .class = ACPI_FUJITSU_CLASS,
1051 .ids = fujitsu_hotkey_device_ids,
1052 .ops = {
1053 .add = acpi_fujitsu_hotkey_add,
1054 .remove = acpi_fujitsu_hotkey_remove,
1055 .notify = acpi_fujitsu_hotkey_notify,
1059 static const struct acpi_device_id fujitsu_ids[] __used = {
1060 {ACPI_FUJITSU_HID, 0},
1061 {ACPI_FUJITSU_HOTKEY_HID, 0},
1062 {"", 0}
1064 MODULE_DEVICE_TABLE(acpi, fujitsu_ids);
1066 static int __init fujitsu_init(void)
1068 int ret, result, max_brightness;
1070 if (acpi_disabled)
1071 return -ENODEV;
1073 fujitsu = kzalloc(sizeof(struct fujitsu_t), GFP_KERNEL);
1074 if (!fujitsu)
1075 return -ENOMEM;
1076 fujitsu->keycode1 = KEY_PROG1;
1077 fujitsu->keycode2 = KEY_PROG2;
1078 fujitsu->keycode3 = KEY_PROG3;
1079 fujitsu->keycode4 = KEY_PROG4;
1080 fujitsu->keycode5 = KEY_RFKILL;
1081 dmi_check_system(fujitsu_dmi_table);
1083 result = acpi_bus_register_driver(&acpi_fujitsu_driver);
1084 if (result < 0) {
1085 ret = -ENODEV;
1086 goto fail_acpi;
1089 /* Register platform stuff */
1091 fujitsu->pf_device = platform_device_alloc("fujitsu-laptop", -1);
1092 if (!fujitsu->pf_device) {
1093 ret = -ENOMEM;
1094 goto fail_platform_driver;
1097 ret = platform_device_add(fujitsu->pf_device);
1098 if (ret)
1099 goto fail_platform_device1;
1101 ret =
1102 sysfs_create_group(&fujitsu->pf_device->dev.kobj,
1103 &fujitsupf_attribute_group);
1104 if (ret)
1105 goto fail_platform_device2;
1107 /* Register backlight stuff */
1109 if (acpi_video_get_backlight_type() == acpi_backlight_vendor) {
1110 struct backlight_properties props;
1112 memset(&props, 0, sizeof(struct backlight_properties));
1113 max_brightness = fujitsu->max_brightness;
1114 props.type = BACKLIGHT_PLATFORM;
1115 props.max_brightness = max_brightness - 1;
1116 fujitsu->bl_device = backlight_device_register("fujitsu-laptop",
1117 NULL, NULL,
1118 &fujitsubl_ops,
1119 &props);
1120 if (IS_ERR(fujitsu->bl_device)) {
1121 ret = PTR_ERR(fujitsu->bl_device);
1122 fujitsu->bl_device = NULL;
1123 goto fail_sysfs_group;
1125 fujitsu->bl_device->props.brightness = fujitsu->brightness_level;
1128 ret = platform_driver_register(&fujitsupf_driver);
1129 if (ret)
1130 goto fail_backlight;
1132 /* Register hotkey driver */
1134 fujitsu_hotkey = kzalloc(sizeof(struct fujitsu_hotkey_t), GFP_KERNEL);
1135 if (!fujitsu_hotkey) {
1136 ret = -ENOMEM;
1137 goto fail_hotkey;
1140 result = acpi_bus_register_driver(&acpi_fujitsu_hotkey_driver);
1141 if (result < 0) {
1142 ret = -ENODEV;
1143 goto fail_hotkey1;
1146 /* Sync backlight power status (needs FUJ02E3 device, hence deferred) */
1147 if (acpi_video_get_backlight_type() == acpi_backlight_vendor) {
1148 if (call_fext_func(FUNC_BACKLIGHT, 0x2, 0x4, 0x0) == 3)
1149 fujitsu->bl_device->props.power = FB_BLANK_POWERDOWN;
1150 else
1151 fujitsu->bl_device->props.power = FB_BLANK_UNBLANK;
1154 pr_info("driver " FUJITSU_DRIVER_VERSION " successfully loaded\n");
1156 return 0;
1158 fail_hotkey1:
1159 kfree(fujitsu_hotkey);
1160 fail_hotkey:
1161 platform_driver_unregister(&fujitsupf_driver);
1162 fail_backlight:
1163 backlight_device_unregister(fujitsu->bl_device);
1164 fail_sysfs_group:
1165 sysfs_remove_group(&fujitsu->pf_device->dev.kobj,
1166 &fujitsupf_attribute_group);
1167 fail_platform_device2:
1168 platform_device_del(fujitsu->pf_device);
1169 fail_platform_device1:
1170 platform_device_put(fujitsu->pf_device);
1171 fail_platform_driver:
1172 acpi_bus_unregister_driver(&acpi_fujitsu_driver);
1173 fail_acpi:
1174 kfree(fujitsu);
1176 return ret;
1179 static void __exit fujitsu_cleanup(void)
1181 acpi_bus_unregister_driver(&acpi_fujitsu_hotkey_driver);
1183 kfree(fujitsu_hotkey);
1185 platform_driver_unregister(&fujitsupf_driver);
1187 backlight_device_unregister(fujitsu->bl_device);
1189 sysfs_remove_group(&fujitsu->pf_device->dev.kobj,
1190 &fujitsupf_attribute_group);
1192 platform_device_unregister(fujitsu->pf_device);
1194 acpi_bus_unregister_driver(&acpi_fujitsu_driver);
1196 kfree(fujitsu);
1198 pr_info("driver unloaded\n");
1201 module_init(fujitsu_init);
1202 module_exit(fujitsu_cleanup);
1204 module_param(use_alt_lcd_levels, uint, 0644);
1205 MODULE_PARM_DESC(use_alt_lcd_levels,
1206 "Use alternative interface for lcd_levels (needed for Lifebook s6410).");
1207 module_param(disable_brightness_adjust, uint, 0644);
1208 MODULE_PARM_DESC(disable_brightness_adjust, "Disable brightness adjustment .");
1209 #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
1210 module_param_named(debug, dbg_level, uint, 0644);
1211 MODULE_PARM_DESC(debug, "Sets debug level bit-mask");
1212 #endif
1214 MODULE_AUTHOR("Jonathan Woithe, Peter Gruber, Tony Vroon");
1215 MODULE_DESCRIPTION("Fujitsu laptop extras support");
1216 MODULE_VERSION(FUJITSU_DRIVER_VERSION);
1217 MODULE_LICENSE("GPL");
1219 MODULE_ALIAS("dmi:*:svnFUJITSUSIEMENS:*:pvr:rvnFUJITSU:rnFJNB1D3:*:cvrS6410:*");
1220 MODULE_ALIAS("dmi:*:svnFUJITSUSIEMENS:*:pvr:rvnFUJITSU:rnFJNB1E6:*:cvrS6420:*");
1221 MODULE_ALIAS("dmi:*:svnFUJITSU:*:pvr:rvnFUJITSU:rnFJNB19C:*:cvrS7020:*");