PM / sleep: Asynchronous threads for suspend_noirq
[linux/fpc-iii.git] / drivers / platform / x86 / fujitsu-laptop.c
blobbe02bcc346d30cb9dc17fff807aa414d0147216a
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/input.h>
68 #include <linux/kfifo.h>
69 #include <linux/video_output.h>
70 #include <linux/platform_device.h>
71 #include <linux/slab.h>
72 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
73 #include <linux/leds.h>
74 #endif
76 #define FUJITSU_DRIVER_VERSION "0.6.0"
78 #define FUJITSU_LCD_N_LEVELS 8
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"
88 #define ACPI_FUJITSU_NOTIFY_CODE1 0x80
90 #define ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS 0x86
91 #define ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS 0x87
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
99 /* FUNC interface - responses */
100 #define UNSUPPORTED_CMD 0x80000000
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
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
117 #define MAX_HOTKEY_RINGBUFFER_SIZE 100
118 #define RINGBUFFERSIZE 40
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
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
133 #define dbg_printk(a_dbg_level, format, arg...) \
134 do { if (dbg_level & a_dbg_level) \
135 printk(FUJLAPTOP_DEBUG "%s: " format, __func__ , ## arg); \
136 } while (0)
137 #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
138 #define vdbg_printk(a_dbg_level, format, arg...) \
139 dbg_printk(a_dbg_level, format, ## arg)
140 #else
141 #define vdbg_printk(a_dbg_level, format, arg...)
142 #endif
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;
154 unsigned int max_brightness;
155 unsigned int brightness_changed;
156 unsigned int brightness_level;
159 static struct fujitsu_t *fujitsu;
160 static int use_alt_lcd_levels = -1;
161 static int disable_brightness_adjust = -1;
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;
178 static struct fujitsu_hotkey_t *fujitsu_hotkey;
180 static void acpi_fujitsu_hotkey_notify(struct acpi_device *device, u32 event);
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);
187 static struct led_classdev logolamp_led = {
188 .name = "fujitsu::logolamp",
189 .brightness_get = logolamp_get,
190 .brightness_set = logolamp_set
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);
197 static struct led_classdev kblamps_led = {
198 .name = "fujitsu::kblamps",
199 .brightness_get = kblamps_get,
200 .brightness_set = kblamps_set
202 #endif
204 #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
205 static u32 dbg_level = 0x03;
206 #endif
208 static void acpi_fujitsu_notify(struct acpi_device *device, u32 event);
210 /* Fujitsu ACPI interface function */
212 static int call_fext_func(int cmd, int arg0, int arg1, int arg2)
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 }
221 struct acpi_object_list arg_list = { 4, &params[0] };
222 unsigned long long value;
223 acpi_handle handle = NULL;
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;
232 params[0].integer.value = cmd;
233 params[1].integer.value = arg0;
234 params[2].integer.value = arg1;
235 params[3].integer.value = arg2;
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;
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;
251 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
252 /* LED class callbacks */
254 static void logolamp_set(struct led_classdev *cdev,
255 enum led_brightness brightness)
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);
268 static void kblamps_set(struct led_classdev *cdev,
269 enum led_brightness brightness)
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);
277 static enum led_brightness logolamp_get(struct led_classdev *cdev)
279 enum led_brightness brightness = LED_OFF;
280 int poweron, always;
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;
289 return brightness;
292 static enum led_brightness kblamps_get(struct led_classdev *cdev)
294 enum led_brightness brightness = LED_OFF;
296 if (call_fext_func(FUNC_LEDS, 0x2, KEYBOARD_LAMPS, 0x0) == FUNC_LED_ON)
297 brightness = LED_FULL;
299 return brightness;
301 #endif
303 /* Hardware access for LCD brightness control */
305 static int set_lcd_level(int level)
307 acpi_status status = AE_OK;
308 acpi_handle handle = NULL;
310 vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBLL [%d]\n",
311 level);
313 if (level < 0 || level >= fujitsu->max_brightness)
314 return -EINVAL;
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;
323 status = acpi_execute_simple_method(handle, NULL, level);
324 if (ACPI_FAILURE(status))
325 return -ENODEV;
327 return 0;
330 static int set_lcd_level_alt(int level)
332 acpi_status status = AE_OK;
333 acpi_handle handle = NULL;
335 vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBL2 [%d]\n",
336 level);
338 if (level < 0 || level >= fujitsu->max_brightness)
339 return -EINVAL;
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;
347 status = acpi_execute_simple_method(handle, NULL, level);
348 if (ACPI_FAILURE(status))
349 return -ENODEV;
351 return 0;
354 static int get_lcd_level(void)
356 unsigned long long state = 0;
357 acpi_status status = AE_OK;
359 vdbg_printk(FUJLAPTOP_DBG_TRACE, "get lcd level via GBLL\n");
361 status =
362 acpi_evaluate_integer(fujitsu->acpi_handle, "GBLL", NULL, &state);
363 if (ACPI_FAILURE(status))
364 return 0;
366 fujitsu->brightness_level = state & 0x0fffffff;
368 if (state & 0x80000000)
369 fujitsu->brightness_changed = 1;
370 else
371 fujitsu->brightness_changed = 0;
373 return fujitsu->brightness_level;
376 static int get_max_brightness(void)
378 unsigned long long state = 0;
379 acpi_status status = AE_OK;
381 vdbg_printk(FUJLAPTOP_DBG_TRACE, "get max lcd level via RBLL\n");
383 status =
384 acpi_evaluate_integer(fujitsu->acpi_handle, "RBLL", NULL, &state);
385 if (ACPI_FAILURE(status))
386 return -1;
388 fujitsu->max_brightness = state;
390 return fujitsu->max_brightness;
393 /* Backlight device stuff */
395 static int bl_get_brightness(struct backlight_device *b)
397 return get_lcd_level();
400 static int bl_update_status(struct backlight_device *b)
402 int ret;
403 if (b->props.power == 4)
404 ret = call_fext_func(FUNC_BACKLIGHT, 0x1, 0x4, 0x3);
405 else
406 ret = call_fext_func(FUNC_BACKLIGHT, 0x1, 0x4, 0x0);
407 if (ret != 0)
408 vdbg_printk(FUJLAPTOP_DBG_ERROR,
409 "Unable to adjust backlight power, error code %i\n",
410 ret);
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;
423 static const struct backlight_ops fujitsubl_ops = {
424 .get_brightness = bl_get_brightness,
425 .update_status = bl_update_status,
428 /* Platform LCD brightness device */
430 static ssize_t
431 show_max_brightness(struct device *dev,
432 struct device_attribute *attr, char *buf)
435 int ret;
437 ret = get_max_brightness();
438 if (ret < 0)
439 return ret;
441 return sprintf(buf, "%i\n", ret);
444 static ssize_t
445 show_brightness_changed(struct device *dev,
446 struct device_attribute *attr, char *buf)
449 int ret;
451 ret = fujitsu->brightness_changed;
452 if (ret < 0)
453 return ret;
455 return sprintf(buf, "%i\n", ret);
458 static ssize_t show_lcd_level(struct device *dev,
459 struct device_attribute *attr, char *buf)
462 int ret;
464 ret = get_lcd_level();
465 if (ret < 0)
466 return ret;
468 return sprintf(buf, "%i\n", ret);
471 static ssize_t store_lcd_level(struct device *dev,
472 struct device_attribute *attr, const char *buf,
473 size_t count)
476 int level, ret;
478 if (sscanf(buf, "%i", &level) != 1
479 || (level < 0 || level >= fujitsu->max_brightness))
480 return -EINVAL;
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;
489 ret = get_lcd_level();
490 if (ret < 0)
491 return ret;
493 return count;
496 static ssize_t
497 ignore_store(struct device *dev,
498 struct device_attribute *attr, const char *buf, size_t count)
500 return count;
503 static ssize_t
504 show_lid_state(struct device *dev,
505 struct device_attribute *attr, char *buf)
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");
515 static ssize_t
516 show_dock_state(struct device *dev,
517 struct device_attribute *attr, char *buf)
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");
527 static ssize_t
528 show_radios_state(struct device *dev,
529 struct device_attribute *attr, char *buf)
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");
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);
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
557 static struct attribute_group fujitsupf_attribute_group = {
558 .attrs = fujitsupf_attributes
561 static struct platform_driver fujitsupf_driver = {
562 .driver = {
563 .name = "fujitsu-laptop",
564 .owner = THIS_MODULE,
568 static void 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 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 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 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 struct dmi_system_id fujitsu_dmi_table[] = {
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(KEY_UNKNOWN, input->keybit);
829 error = input_register_device(input);
830 if (error)
831 goto err_free_input_dev;
833 error = acpi_bus_update_power(fujitsu_hotkey->acpi_handle, &state);
834 if (error) {
835 pr_err("Error reading power state\n");
836 goto err_unregister_input_dev;
839 pr_info("ACPI: %s [%s] (%s)\n",
840 acpi_device_name(device), acpi_device_bid(device),
841 !device->power.state ? "on" : "off");
843 fujitsu_hotkey->dev = device;
845 if (acpi_has_method(device->handle, METHOD_NAME__INI)) {
846 vdbg_printk(FUJLAPTOP_DBG_INFO, "Invoking _INI\n");
847 if (ACPI_FAILURE
848 (acpi_evaluate_object
849 (device->handle, METHOD_NAME__INI, NULL, NULL)))
850 pr_err("_INI Method failed\n");
853 i = 0;
854 while (call_fext_func(FUNC_BUTTONS, 0x1, 0x0, 0x0) != 0
855 && (i++) < MAX_HOTKEY_RINGBUFFER_SIZE)
856 ; /* No action, result is discarded */
857 vdbg_printk(FUJLAPTOP_DBG_INFO, "Discarded %i ringbuffer entries\n", i);
859 fujitsu_hotkey->rfkill_supported =
860 call_fext_func(FUNC_RFKILL, 0x0, 0x0, 0x0);
862 /* Make sure our bitmask of supported functions is cleared if the
863 RFKILL function block is not implemented, like on the S7020. */
864 if (fujitsu_hotkey->rfkill_supported == UNSUPPORTED_CMD)
865 fujitsu_hotkey->rfkill_supported = 0;
867 if (fujitsu_hotkey->rfkill_supported)
868 fujitsu_hotkey->rfkill_state =
869 call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
871 /* Suspect this is a keymap of the application panel, print it */
872 pr_info("BTNI: [0x%x]\n", call_fext_func(FUNC_BUTTONS, 0x0, 0x0, 0x0));
874 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
875 if (call_fext_func(FUNC_LEDS, 0x0, 0x0, 0x0) & LOGOLAMP_POWERON) {
876 result = led_classdev_register(&fujitsu->pf_device->dev,
877 &logolamp_led);
878 if (result == 0) {
879 fujitsu_hotkey->logolamp_registered = 1;
880 } else {
881 pr_err("Could not register LED handler for logo lamp, error %i\n",
882 result);
886 if ((call_fext_func(FUNC_LEDS, 0x0, 0x0, 0x0) & KEYBOARD_LAMPS) &&
887 (call_fext_func(FUNC_BUTTONS, 0x0, 0x0, 0x0) == 0x0)) {
888 result = led_classdev_register(&fujitsu->pf_device->dev,
889 &kblamps_led);
890 if (result == 0) {
891 fujitsu_hotkey->kblamps_registered = 1;
892 } else {
893 pr_err("Could not register LED handler for keyboard lamps, error %i\n",
894 result);
897 #endif
899 return result;
901 err_unregister_input_dev:
902 input_unregister_device(input);
903 input = NULL;
904 err_free_input_dev:
905 input_free_device(input);
906 err_free_fifo:
907 kfifo_free(&fujitsu_hotkey->fifo);
908 err_stop:
909 return error;
912 static int acpi_fujitsu_hotkey_remove(struct acpi_device *device)
914 struct fujitsu_hotkey_t *fujitsu_hotkey = acpi_driver_data(device);
915 struct input_dev *input = fujitsu_hotkey->input;
917 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
918 if (fujitsu_hotkey->logolamp_registered)
919 led_classdev_unregister(&logolamp_led);
921 if (fujitsu_hotkey->kblamps_registered)
922 led_classdev_unregister(&kblamps_led);
923 #endif
925 input_unregister_device(input);
927 kfifo_free(&fujitsu_hotkey->fifo);
929 fujitsu_hotkey->acpi_handle = NULL;
931 return 0;
934 static void acpi_fujitsu_hotkey_notify(struct acpi_device *device, u32 event)
936 struct input_dev *input;
937 int keycode, keycode_r;
938 unsigned int irb = 1;
939 int i, status;
941 input = fujitsu_hotkey->input;
943 if (fujitsu_hotkey->rfkill_supported)
944 fujitsu_hotkey->rfkill_state =
945 call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
947 switch (event) {
948 case ACPI_FUJITSU_NOTIFY_CODE1:
949 i = 0;
950 while ((irb =
951 call_fext_func(FUNC_BUTTONS, 0x1, 0x0, 0x0)) != 0
952 && (i++) < MAX_HOTKEY_RINGBUFFER_SIZE) {
953 switch (irb & 0x4ff) {
954 case KEY1_CODE:
955 keycode = fujitsu->keycode1;
956 break;
957 case KEY2_CODE:
958 keycode = fujitsu->keycode2;
959 break;
960 case KEY3_CODE:
961 keycode = fujitsu->keycode3;
962 break;
963 case KEY4_CODE:
964 keycode = fujitsu->keycode4;
965 break;
966 case 0:
967 keycode = 0;
968 break;
969 default:
970 vdbg_printk(FUJLAPTOP_DBG_WARN,
971 "Unknown GIRB result [%x]\n", irb);
972 keycode = -1;
973 break;
975 if (keycode > 0) {
976 vdbg_printk(FUJLAPTOP_DBG_TRACE,
977 "Push keycode into ringbuffer [%d]\n",
978 keycode);
979 status = kfifo_in_locked(&fujitsu_hotkey->fifo,
980 (unsigned char *)&keycode,
981 sizeof(keycode),
982 &fujitsu_hotkey->fifo_lock);
983 if (status != sizeof(keycode)) {
984 vdbg_printk(FUJLAPTOP_DBG_WARN,
985 "Could not push keycode [0x%x]\n",
986 keycode);
987 } else {
988 input_report_key(input, keycode, 1);
989 input_sync(input);
991 } else if (keycode == 0) {
992 while ((status =
993 kfifo_out_locked(
994 &fujitsu_hotkey->fifo,
995 (unsigned char *) &keycode_r,
996 sizeof(keycode_r),
997 &fujitsu_hotkey->fifo_lock))
998 == sizeof(keycode_r)) {
999 input_report_key(input, keycode_r, 0);
1000 input_sync(input);
1001 vdbg_printk(FUJLAPTOP_DBG_TRACE,
1002 "Pop keycode from ringbuffer [%d]\n",
1003 keycode_r);
1008 break;
1009 default:
1010 keycode = KEY_UNKNOWN;
1011 vdbg_printk(FUJLAPTOP_DBG_WARN,
1012 "Unsupported event [0x%x]\n", event);
1013 input_report_key(input, keycode, 1);
1014 input_sync(input);
1015 input_report_key(input, keycode, 0);
1016 input_sync(input);
1017 break;
1021 /* Initialization */
1023 static const struct acpi_device_id fujitsu_device_ids[] = {
1024 {ACPI_FUJITSU_HID, 0},
1025 {"", 0},
1028 static struct acpi_driver acpi_fujitsu_driver = {
1029 .name = ACPI_FUJITSU_DRIVER_NAME,
1030 .class = ACPI_FUJITSU_CLASS,
1031 .ids = fujitsu_device_ids,
1032 .ops = {
1033 .add = acpi_fujitsu_add,
1034 .remove = acpi_fujitsu_remove,
1035 .notify = acpi_fujitsu_notify,
1039 static const struct acpi_device_id fujitsu_hotkey_device_ids[] = {
1040 {ACPI_FUJITSU_HOTKEY_HID, 0},
1041 {"", 0},
1044 static struct acpi_driver acpi_fujitsu_hotkey_driver = {
1045 .name = ACPI_FUJITSU_HOTKEY_DRIVER_NAME,
1046 .class = ACPI_FUJITSU_CLASS,
1047 .ids = fujitsu_hotkey_device_ids,
1048 .ops = {
1049 .add = acpi_fujitsu_hotkey_add,
1050 .remove = acpi_fujitsu_hotkey_remove,
1051 .notify = acpi_fujitsu_hotkey_notify,
1055 static int __init fujitsu_init(void)
1057 int ret, result, max_brightness;
1059 if (acpi_disabled)
1060 return -ENODEV;
1062 fujitsu = kzalloc(sizeof(struct fujitsu_t), GFP_KERNEL);
1063 if (!fujitsu)
1064 return -ENOMEM;
1065 fujitsu->keycode1 = KEY_PROG1;
1066 fujitsu->keycode2 = KEY_PROG2;
1067 fujitsu->keycode3 = KEY_PROG3;
1068 fujitsu->keycode4 = KEY_PROG4;
1069 dmi_check_system(fujitsu_dmi_table);
1071 result = acpi_bus_register_driver(&acpi_fujitsu_driver);
1072 if (result < 0) {
1073 ret = -ENODEV;
1074 goto fail_acpi;
1077 /* Register platform stuff */
1079 fujitsu->pf_device = platform_device_alloc("fujitsu-laptop", -1);
1080 if (!fujitsu->pf_device) {
1081 ret = -ENOMEM;
1082 goto fail_platform_driver;
1085 ret = platform_device_add(fujitsu->pf_device);
1086 if (ret)
1087 goto fail_platform_device1;
1089 ret =
1090 sysfs_create_group(&fujitsu->pf_device->dev.kobj,
1091 &fujitsupf_attribute_group);
1092 if (ret)
1093 goto fail_platform_device2;
1095 /* Register backlight stuff */
1097 if (!acpi_video_backlight_support()) {
1098 struct backlight_properties props;
1100 memset(&props, 0, sizeof(struct backlight_properties));
1101 max_brightness = fujitsu->max_brightness;
1102 props.type = BACKLIGHT_PLATFORM;
1103 props.max_brightness = max_brightness - 1;
1104 fujitsu->bl_device = backlight_device_register("fujitsu-laptop",
1105 NULL, NULL,
1106 &fujitsubl_ops,
1107 &props);
1108 if (IS_ERR(fujitsu->bl_device)) {
1109 ret = PTR_ERR(fujitsu->bl_device);
1110 fujitsu->bl_device = NULL;
1111 goto fail_sysfs_group;
1113 fujitsu->bl_device->props.brightness = fujitsu->brightness_level;
1116 ret = platform_driver_register(&fujitsupf_driver);
1117 if (ret)
1118 goto fail_backlight;
1120 /* Register hotkey driver */
1122 fujitsu_hotkey = kzalloc(sizeof(struct fujitsu_hotkey_t), GFP_KERNEL);
1123 if (!fujitsu_hotkey) {
1124 ret = -ENOMEM;
1125 goto fail_hotkey;
1128 result = acpi_bus_register_driver(&acpi_fujitsu_hotkey_driver);
1129 if (result < 0) {
1130 ret = -ENODEV;
1131 goto fail_hotkey1;
1134 /* Sync backlight power status (needs FUJ02E3 device, hence deferred) */
1136 if (!acpi_video_backlight_support()) {
1137 if (call_fext_func(FUNC_BACKLIGHT, 0x2, 0x4, 0x0) == 3)
1138 fujitsu->bl_device->props.power = 4;
1139 else
1140 fujitsu->bl_device->props.power = 0;
1143 pr_info("driver " FUJITSU_DRIVER_VERSION " successfully loaded\n");
1145 return 0;
1147 fail_hotkey1:
1148 kfree(fujitsu_hotkey);
1149 fail_hotkey:
1150 platform_driver_unregister(&fujitsupf_driver);
1151 fail_backlight:
1152 if (fujitsu->bl_device)
1153 backlight_device_unregister(fujitsu->bl_device);
1154 fail_sysfs_group:
1155 sysfs_remove_group(&fujitsu->pf_device->dev.kobj,
1156 &fujitsupf_attribute_group);
1157 fail_platform_device2:
1158 platform_device_del(fujitsu->pf_device);
1159 fail_platform_device1:
1160 platform_device_put(fujitsu->pf_device);
1161 fail_platform_driver:
1162 acpi_bus_unregister_driver(&acpi_fujitsu_driver);
1163 fail_acpi:
1164 kfree(fujitsu);
1166 return ret;
1169 static void __exit fujitsu_cleanup(void)
1171 acpi_bus_unregister_driver(&acpi_fujitsu_hotkey_driver);
1173 kfree(fujitsu_hotkey);
1175 platform_driver_unregister(&fujitsupf_driver);
1177 if (fujitsu->bl_device)
1178 backlight_device_unregister(fujitsu->bl_device);
1180 sysfs_remove_group(&fujitsu->pf_device->dev.kobj,
1181 &fujitsupf_attribute_group);
1183 platform_device_unregister(fujitsu->pf_device);
1185 acpi_bus_unregister_driver(&acpi_fujitsu_driver);
1187 kfree(fujitsu);
1189 pr_info("driver unloaded\n");
1192 module_init(fujitsu_init);
1193 module_exit(fujitsu_cleanup);
1195 module_param(use_alt_lcd_levels, uint, 0644);
1196 MODULE_PARM_DESC(use_alt_lcd_levels,
1197 "Use alternative interface for lcd_levels (needed for Lifebook s6410).");
1198 module_param(disable_brightness_adjust, uint, 0644);
1199 MODULE_PARM_DESC(disable_brightness_adjust, "Disable brightness adjustment .");
1200 #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
1201 module_param_named(debug, dbg_level, uint, 0644);
1202 MODULE_PARM_DESC(debug, "Sets debug level bit-mask");
1203 #endif
1205 MODULE_AUTHOR("Jonathan Woithe, Peter Gruber, Tony Vroon");
1206 MODULE_DESCRIPTION("Fujitsu laptop extras support");
1207 MODULE_VERSION(FUJITSU_DRIVER_VERSION);
1208 MODULE_LICENSE("GPL");
1210 MODULE_ALIAS("dmi:*:svnFUJITSUSIEMENS:*:pvr:rvnFUJITSU:rnFJNB1D3:*:cvrS6410:*");
1211 MODULE_ALIAS("dmi:*:svnFUJITSUSIEMENS:*:pvr:rvnFUJITSU:rnFJNB1E6:*:cvrS6420:*");
1212 MODULE_ALIAS("dmi:*:svnFUJITSU:*:pvr:rvnFUJITSU:rnFJNB19C:*:cvrS7020:*");
1214 static struct pnp_device_id pnp_ids[] __used = {
1215 {.id = "FUJ02bf"},
1216 {.id = "FUJ02B1"},
1217 {.id = "FUJ02E3"},
1218 {.id = ""}
1221 MODULE_DEVICE_TABLE(pnp, pnp_ids);