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