gro: Allow tunnel stacking in the case of FOU/GUE
[linux/fpc-iii.git] / drivers / platform / x86 / fujitsu-laptop.c
blob2a9afa261c615bffb1f1586f2fcb3a287fd33d4b
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
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 #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
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;
153 unsigned int max_brightness;
154 unsigned int brightness_changed;
155 unsigned int brightness_level;
158 static struct fujitsu_t *fujitsu;
159 static int use_alt_lcd_levels = -1;
160 static int disable_brightness_adjust = -1;
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;
177 static struct fujitsu_hotkey_t *fujitsu_hotkey;
179 static void acpi_fujitsu_hotkey_notify(struct acpi_device *device, u32 event);
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);
186 static struct led_classdev logolamp_led = {
187 .name = "fujitsu::logolamp",
188 .brightness_get = logolamp_get,
189 .brightness_set = logolamp_set
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);
196 static struct led_classdev kblamps_led = {
197 .name = "fujitsu::kblamps",
198 .brightness_get = kblamps_get,
199 .brightness_set = kblamps_set
201 #endif
203 #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
204 static u32 dbg_level = 0x03;
205 #endif
207 static void acpi_fujitsu_notify(struct acpi_device *device, u32 event);
209 /* Fujitsu ACPI interface function */
211 static int call_fext_func(int cmd, int arg0, int arg1, int arg2)
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 }
220 struct acpi_object_list arg_list = { 4, &params[0] };
221 unsigned long long value;
222 acpi_handle handle = NULL;
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;
231 params[0].integer.value = cmd;
232 params[1].integer.value = arg0;
233 params[2].integer.value = arg1;
234 params[3].integer.value = arg2;
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;
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;
250 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
251 /* LED class callbacks */
253 static void logolamp_set(struct led_classdev *cdev,
254 enum led_brightness brightness)
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);
267 static void kblamps_set(struct led_classdev *cdev,
268 enum led_brightness brightness)
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);
276 static enum led_brightness logolamp_get(struct led_classdev *cdev)
278 enum led_brightness brightness = LED_OFF;
279 int poweron, always;
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;
288 return brightness;
291 static enum led_brightness kblamps_get(struct led_classdev *cdev)
293 enum led_brightness brightness = LED_OFF;
295 if (call_fext_func(FUNC_LEDS, 0x2, KEYBOARD_LAMPS, 0x0) == FUNC_LED_ON)
296 brightness = LED_FULL;
298 return brightness;
300 #endif
302 /* Hardware access for LCD brightness control */
304 static int set_lcd_level(int level)
306 acpi_status status = AE_OK;
307 acpi_handle handle = NULL;
309 vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBLL [%d]\n",
310 level);
312 if (level < 0 || level >= fujitsu->max_brightness)
313 return -EINVAL;
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;
322 status = acpi_execute_simple_method(handle, NULL, level);
323 if (ACPI_FAILURE(status))
324 return -ENODEV;
326 return 0;
329 static int set_lcd_level_alt(int level)
331 acpi_status status = AE_OK;
332 acpi_handle handle = NULL;
334 vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBL2 [%d]\n",
335 level);
337 if (level < 0 || level >= fujitsu->max_brightness)
338 return -EINVAL;
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;
346 status = acpi_execute_simple_method(handle, NULL, level);
347 if (ACPI_FAILURE(status))
348 return -ENODEV;
350 return 0;
353 static int get_lcd_level(void)
355 unsigned long long state = 0;
356 acpi_status status = AE_OK;
358 vdbg_printk(FUJLAPTOP_DBG_TRACE, "get lcd level via GBLL\n");
360 status =
361 acpi_evaluate_integer(fujitsu->acpi_handle, "GBLL", NULL, &state);
362 if (ACPI_FAILURE(status))
363 return 0;
365 fujitsu->brightness_level = state & 0x0fffffff;
367 if (state & 0x80000000)
368 fujitsu->brightness_changed = 1;
369 else
370 fujitsu->brightness_changed = 0;
372 return fujitsu->brightness_level;
375 static int get_max_brightness(void)
377 unsigned long long state = 0;
378 acpi_status status = AE_OK;
380 vdbg_printk(FUJLAPTOP_DBG_TRACE, "get max lcd level via RBLL\n");
382 status =
383 acpi_evaluate_integer(fujitsu->acpi_handle, "RBLL", NULL, &state);
384 if (ACPI_FAILURE(status))
385 return -1;
387 fujitsu->max_brightness = state;
389 return fujitsu->max_brightness;
392 /* Backlight device stuff */
394 static int bl_get_brightness(struct backlight_device *b)
396 return get_lcd_level();
399 static int bl_update_status(struct backlight_device *b)
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);
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;
422 static const struct backlight_ops fujitsubl_ops = {
423 .get_brightness = bl_get_brightness,
424 .update_status = bl_update_status,
427 /* Platform LCD brightness device */
429 static ssize_t
430 show_max_brightness(struct device *dev,
431 struct device_attribute *attr, char *buf)
434 int ret;
436 ret = get_max_brightness();
437 if (ret < 0)
438 return ret;
440 return sprintf(buf, "%i\n", ret);
443 static ssize_t
444 show_brightness_changed(struct device *dev,
445 struct device_attribute *attr, char *buf)
448 int ret;
450 ret = fujitsu->brightness_changed;
451 if (ret < 0)
452 return ret;
454 return sprintf(buf, "%i\n", ret);
457 static ssize_t show_lcd_level(struct device *dev,
458 struct device_attribute *attr, char *buf)
461 int ret;
463 ret = get_lcd_level();
464 if (ret < 0)
465 return ret;
467 return sprintf(buf, "%i\n", ret);
470 static ssize_t store_lcd_level(struct device *dev,
471 struct device_attribute *attr, const char *buf,
472 size_t count)
475 int level, ret;
477 if (sscanf(buf, "%i", &level) != 1
478 || (level < 0 || level >= fujitsu->max_brightness))
479 return -EINVAL;
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;
488 ret = get_lcd_level();
489 if (ret < 0)
490 return ret;
492 return count;
495 static ssize_t
496 ignore_store(struct device *dev,
497 struct device_attribute *attr, const char *buf, size_t count)
499 return count;
502 static ssize_t
503 show_lid_state(struct device *dev,
504 struct device_attribute *attr, char *buf)
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");
514 static ssize_t
515 show_dock_state(struct device *dev,
516 struct device_attribute *attr, char *buf)
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");
526 static ssize_t
527 show_radios_state(struct device *dev,
528 struct device_attribute *attr, char *buf)
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");
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);
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
556 static struct attribute_group fujitsupf_attribute_group = {
557 .attrs = fujitsupf_attributes
560 static struct platform_driver fujitsupf_driver = {
561 .driver = {
562 .name = "fujitsu-laptop",
566 static void __init dmi_check_cb_common(const struct dmi_system_id *id)
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);
580 static int __init dmi_check_cb_s6410(const struct dmi_system_id *id)
582 dmi_check_cb_common(id);
583 fujitsu->keycode1 = KEY_SCREENLOCK; /* "Lock" */
584 fujitsu->keycode2 = KEY_HELP; /* "Mobility Center" */
585 return 1;
588 static int __init dmi_check_cb_s6420(const struct dmi_system_id *id)
590 dmi_check_cb_common(id);
591 fujitsu->keycode1 = KEY_SCREENLOCK; /* "Lock" */
592 fujitsu->keycode2 = KEY_HELP; /* "Mobility Center" */
593 return 1;
596 static int __init dmi_check_cb_p8010(const struct dmi_system_id *id)
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;
605 static const struct dmi_system_id fujitsu_dmi_table[] __initconst = {
607 .ident = "Fujitsu Siemens S6410",
608 .matches = {
609 DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
610 DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6410"),
612 .callback = dmi_check_cb_s6410},
614 .ident = "Fujitsu Siemens S6420",
615 .matches = {
616 DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
617 DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6420"),
619 .callback = dmi_check_cb_s6420},
621 .ident = "Fujitsu LifeBook P8010",
622 .matches = {
623 DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"),
624 DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook P8010"),
626 .callback = dmi_check_cb_p8010},
630 /* ACPI device for LCD brightness control */
632 static int acpi_fujitsu_add(struct acpi_device *device)
634 int state = 0;
635 struct input_dev *input;
636 int error;
638 if (!device)
639 return -EINVAL;
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;
646 fujitsu->input = input = input_allocate_device();
647 if (!input) {
648 error = -ENOMEM;
649 goto err_stop;
652 snprintf(fujitsu->phys, sizeof(fujitsu->phys),
653 "%s/video/input0", acpi_device_hid(device));
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);
665 error = input_register_device(input);
666 if (error)
667 goto err_free_input_dev;
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;
675 pr_info("ACPI: %s [%s] (%s)\n",
676 acpi_device_name(device), acpi_device_bid(device),
677 !device->power.state ? "on" : "off");
679 fujitsu->dev = device;
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");
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);
696 if (get_max_brightness() <= 0)
697 fujitsu->max_brightness = FUJITSU_LCD_N_LEVELS;
698 get_lcd_level();
700 return 0;
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;
711 static int acpi_fujitsu_remove(struct acpi_device *device)
713 struct fujitsu_t *fujitsu = acpi_driver_data(device);
714 struct input_dev *input = fujitsu->input;
716 input_unregister_device(input);
718 fujitsu->acpi_handle = NULL;
720 return 0;
723 /* Brightness notify */
725 static void acpi_fujitsu_notify(struct acpi_device *device, u32 event)
727 struct input_dev *input;
728 int keycode;
729 int oldb, newb;
731 input = fujitsu->input;
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;
740 vdbg_printk(FUJLAPTOP_DBG_TRACE,
741 "brightness button event [%i -> %i (%i)]\n",
742 oldb, newb, fujitsu->brightness_changed);
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);
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);
759 keycode = KEY_BRIGHTNESSDOWN;
761 break;
762 default:
763 keycode = KEY_UNKNOWN;
764 vdbg_printk(FUJLAPTOP_DBG_WARN,
765 "unsupported event [0x%x]\n", event);
766 break;
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);
777 /* ACPI device for hotkey handling */
779 static int acpi_fujitsu_hotkey_add(struct acpi_device *device)
781 int result = 0;
782 int state = 0;
783 struct input_dev *input;
784 int error;
785 int i;
787 if (!device)
788 return -EINVAL;
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;
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;
805 fujitsu_hotkey->input = input = input_allocate_device();
806 if (!input) {
807 error = -ENOMEM;
808 goto err_free_fifo;
811 snprintf(fujitsu_hotkey->phys, sizeof(fujitsu_hotkey->phys),
812 "%s/video/input0", acpi_device_hid(device));
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;
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);
827 error = input_register_device(input);
828 if (error)
829 goto err_free_input_dev;
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;
837 pr_info("ACPI: %s [%s] (%s)\n",
838 acpi_device_name(device), acpi_device_bid(device),
839 !device->power.state ? "on" : "off");
841 fujitsu_hotkey->dev = device;
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");
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);
857 fujitsu_hotkey->rfkill_supported =
858 call_fext_func(FUNC_RFKILL, 0x0, 0x0, 0x0);
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;
865 if (fujitsu_hotkey->rfkill_supported)
866 fujitsu_hotkey->rfkill_state =
867 call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
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));
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);
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);
895 #endif
897 return result;
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;
910 static int acpi_fujitsu_hotkey_remove(struct acpi_device *device)
912 struct fujitsu_hotkey_t *fujitsu_hotkey = acpi_driver_data(device);
913 struct input_dev *input = fujitsu_hotkey->input;
915 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
916 if (fujitsu_hotkey->logolamp_registered)
917 led_classdev_unregister(&logolamp_led);
919 if (fujitsu_hotkey->kblamps_registered)
920 led_classdev_unregister(&kblamps_led);
921 #endif
923 input_unregister_device(input);
925 kfifo_free(&fujitsu_hotkey->fifo);
927 fujitsu_hotkey->acpi_handle = NULL;
929 return 0;
932 static void acpi_fujitsu_hotkey_notify(struct acpi_device *device, u32 event)
934 struct input_dev *input;
935 int keycode, keycode_r;
936 unsigned int irb = 1;
937 int i, status;
939 input = fujitsu_hotkey->input;
941 if (fujitsu_hotkey->rfkill_supported)
942 fujitsu_hotkey->rfkill_state =
943 call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
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;
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);
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);
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;
1019 /* Initialization */
1021 static const struct acpi_device_id fujitsu_device_ids[] = {
1022 {ACPI_FUJITSU_HID, 0},
1023 {"", 0},
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,
1037 static const struct acpi_device_id fujitsu_hotkey_device_ids[] = {
1038 {ACPI_FUJITSU_HOTKEY_HID, 0},
1039 {"", 0},
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,
1053 static const struct acpi_device_id fujitsu_ids[] __used = {
1054 {ACPI_FUJITSU_HID, 0},
1055 {ACPI_FUJITSU_HOTKEY_HID, 0},
1056 {"", 0}
1058 MODULE_DEVICE_TABLE(acpi, fujitsu_ids);
1060 static int __init fujitsu_init(void)
1062 int ret, result, max_brightness;
1064 if (acpi_disabled)
1065 return -ENODEV;
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);
1076 result = acpi_bus_register_driver(&acpi_fujitsu_driver);
1077 if (result < 0) {
1078 ret = -ENODEV;
1079 goto fail_acpi;
1082 /* Register platform stuff */
1084 fujitsu->pf_device = platform_device_alloc("fujitsu-laptop", -1);
1085 if (!fujitsu->pf_device) {
1086 ret = -ENOMEM;
1087 goto fail_platform_driver;
1090 ret = platform_device_add(fujitsu->pf_device);
1091 if (ret)
1092 goto fail_platform_device1;
1094 ret =
1095 sysfs_create_group(&fujitsu->pf_device->dev.kobj,
1096 &fujitsupf_attribute_group);
1097 if (ret)
1098 goto fail_platform_device2;
1100 /* Register backlight stuff */
1102 if (!acpi_video_backlight_support()) {
1103 struct backlight_properties props;
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;
1118 fujitsu->bl_device->props.brightness = fujitsu->brightness_level;
1121 ret = platform_driver_register(&fujitsupf_driver);
1122 if (ret)
1123 goto fail_backlight;
1125 /* Register hotkey driver */
1127 fujitsu_hotkey = kzalloc(sizeof(struct fujitsu_hotkey_t), GFP_KERNEL);
1128 if (!fujitsu_hotkey) {
1129 ret = -ENOMEM;
1130 goto fail_hotkey;
1133 result = acpi_bus_register_driver(&acpi_fujitsu_hotkey_driver);
1134 if (result < 0) {
1135 ret = -ENODEV;
1136 goto fail_hotkey1;
1139 /* Sync backlight power status (needs FUJ02E3 device, hence deferred) */
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;
1148 pr_info("driver " FUJITSU_DRIVER_VERSION " successfully loaded\n");
1150 return 0;
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);
1170 return ret;
1173 static void __exit fujitsu_cleanup(void)
1175 acpi_bus_unregister_driver(&acpi_fujitsu_hotkey_driver);
1177 kfree(fujitsu_hotkey);
1179 platform_driver_unregister(&fujitsupf_driver);
1181 backlight_device_unregister(fujitsu->bl_device);
1183 sysfs_remove_group(&fujitsu->pf_device->dev.kobj,
1184 &fujitsupf_attribute_group);
1186 platform_device_unregister(fujitsu->pf_device);
1188 acpi_bus_unregister_driver(&acpi_fujitsu_driver);
1190 kfree(fujitsu);
1192 pr_info("driver unloaded\n");
1195 module_init(fujitsu_init);
1196 module_exit(fujitsu_cleanup);
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
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");
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:*");