thinkpad-acpi: acpi_evalf fixes
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / platform / x86 / fujitsu-laptop.c
blob5f3320d468f61bd6aa37d7606e86570508910b81
1 /*-*-linux-c-*-*/
3 /*
4 Copyright (C) 2007,2008 Jonathan Woithe <jwoithe@physics.adelaide.edu.au>
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 #include <linux/module.h>
60 #include <linux/kernel.h>
61 #include <linux/init.h>
62 #include <linux/acpi.h>
63 #include <linux/dmi.h>
64 #include <linux/backlight.h>
65 #include <linux/input.h>
66 #include <linux/kfifo.h>
67 #include <linux/video_output.h>
68 #include <linux/platform_device.h>
69 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
70 #include <linux/leds.h>
71 #endif
73 #define FUJITSU_DRIVER_VERSION "0.6.0"
75 #define FUJITSU_LCD_N_LEVELS 8
77 #define ACPI_FUJITSU_CLASS "fujitsu"
78 #define ACPI_FUJITSU_HID "FUJ02B1"
79 #define ACPI_FUJITSU_DRIVER_NAME "Fujitsu laptop FUJ02B1 ACPI brightness driver"
80 #define ACPI_FUJITSU_DEVICE_NAME "Fujitsu FUJ02B1"
81 #define ACPI_FUJITSU_HOTKEY_HID "FUJ02E3"
82 #define ACPI_FUJITSU_HOTKEY_DRIVER_NAME "Fujitsu laptop FUJ02E3 ACPI hotkeys driver"
83 #define ACPI_FUJITSU_HOTKEY_DEVICE_NAME "Fujitsu FUJ02E3"
85 #define ACPI_FUJITSU_NOTIFY_CODE1 0x80
87 #define ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS 0x86
88 #define ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS 0x87
90 /* FUNC interface - command values */
91 #define FUNC_RFKILL 0x1000
92 #define FUNC_LEDS 0x1001
93 #define FUNC_BUTTONS 0x1002
94 #define FUNC_BACKLIGHT 0x1004
96 /* FUNC interface - responses */
97 #define UNSUPPORTED_CMD 0x80000000
99 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
100 /* FUNC interface - LED control */
101 #define FUNC_LED_OFF 0x1
102 #define FUNC_LED_ON 0x30001
103 #define KEYBOARD_LAMPS 0x100
104 #define LOGOLAMP_POWERON 0x2000
105 #define LOGOLAMP_ALWAYS 0x4000
106 #endif
108 /* Hotkey details */
109 #define KEY1_CODE 0x410 /* codes for the keys in the GIRB register */
110 #define KEY2_CODE 0x411
111 #define KEY3_CODE 0x412
112 #define KEY4_CODE 0x413
114 #define MAX_HOTKEY_RINGBUFFER_SIZE 100
115 #define RINGBUFFERSIZE 40
117 /* Debugging */
118 #define FUJLAPTOP_LOG ACPI_FUJITSU_HID ": "
119 #define FUJLAPTOP_ERR KERN_ERR FUJLAPTOP_LOG
120 #define FUJLAPTOP_NOTICE KERN_NOTICE FUJLAPTOP_LOG
121 #define FUJLAPTOP_INFO KERN_INFO FUJLAPTOP_LOG
122 #define FUJLAPTOP_DEBUG KERN_DEBUG FUJLAPTOP_LOG
124 #define FUJLAPTOP_DBG_ALL 0xffff
125 #define FUJLAPTOP_DBG_ERROR 0x0001
126 #define FUJLAPTOP_DBG_WARN 0x0002
127 #define FUJLAPTOP_DBG_INFO 0x0004
128 #define FUJLAPTOP_DBG_TRACE 0x0008
130 #define dbg_printk(a_dbg_level, format, arg...) \
131 do { if (dbg_level & a_dbg_level) \
132 printk(FUJLAPTOP_DEBUG "%s: " format, __func__ , ## arg); \
133 } while (0)
134 #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
135 #define vdbg_printk(a_dbg_level, format, arg...) \
136 dbg_printk(a_dbg_level, format, ## arg)
137 #else
138 #define vdbg_printk(a_dbg_level, format, arg...)
139 #endif
141 /* Device controlling the backlight and associated keys */
142 struct fujitsu_t {
143 acpi_handle acpi_handle;
144 struct acpi_device *dev;
145 struct input_dev *input;
146 char phys[32];
147 struct backlight_device *bl_device;
148 struct platform_device *pf_device;
149 int keycode1, keycode2, keycode3, keycode4;
151 unsigned int max_brightness;
152 unsigned int brightness_changed;
153 unsigned int brightness_level;
156 static struct fujitsu_t *fujitsu;
157 static int use_alt_lcd_levels = -1;
158 static int disable_brightness_adjust = -1;
160 /* Device used to access other hotkeys on the laptop */
161 struct fujitsu_hotkey_t {
162 acpi_handle acpi_handle;
163 struct acpi_device *dev;
164 struct input_dev *input;
165 char phys[32];
166 struct platform_device *pf_device;
167 struct kfifo fifo;
168 spinlock_t fifo_lock;
169 int rfkill_supported;
170 int rfkill_state;
171 int logolamp_registered;
172 int kblamps_registered;
175 static struct fujitsu_hotkey_t *fujitsu_hotkey;
177 static void acpi_fujitsu_hotkey_notify(struct acpi_device *device, u32 event);
179 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
180 static enum led_brightness logolamp_get(struct led_classdev *cdev);
181 static void logolamp_set(struct led_classdev *cdev,
182 enum led_brightness brightness);
184 struct led_classdev logolamp_led = {
185 .name = "fujitsu::logolamp",
186 .brightness_get = logolamp_get,
187 .brightness_set = logolamp_set
190 static enum led_brightness kblamps_get(struct led_classdev *cdev);
191 static void kblamps_set(struct led_classdev *cdev,
192 enum led_brightness brightness);
194 struct led_classdev kblamps_led = {
195 .name = "fujitsu::kblamps",
196 .brightness_get = kblamps_get,
197 .brightness_set = kblamps_set
199 #endif
201 #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
202 static u32 dbg_level = 0x03;
203 #endif
205 static void acpi_fujitsu_notify(struct acpi_device *device, u32 event);
207 /* Fujitsu ACPI interface function */
209 static int call_fext_func(int cmd, int arg0, int arg1, int arg2)
211 acpi_status status = AE_OK;
212 union acpi_object params[4] = {
213 { .type = ACPI_TYPE_INTEGER },
214 { .type = ACPI_TYPE_INTEGER },
215 { .type = ACPI_TYPE_INTEGER },
216 { .type = ACPI_TYPE_INTEGER }
218 struct acpi_object_list arg_list = { 4, &params[0] };
219 struct acpi_buffer output;
220 union acpi_object out_obj;
221 acpi_handle handle = NULL;
223 status = acpi_get_handle(fujitsu_hotkey->acpi_handle, "FUNC", &handle);
224 if (ACPI_FAILURE(status)) {
225 vdbg_printk(FUJLAPTOP_DBG_ERROR,
226 "FUNC interface is not present\n");
227 return -ENODEV;
230 params[0].integer.value = cmd;
231 params[1].integer.value = arg0;
232 params[2].integer.value = arg1;
233 params[3].integer.value = arg2;
235 output.length = sizeof(out_obj);
236 output.pointer = &out_obj;
238 status = acpi_evaluate_object(handle, NULL, &arg_list, &output);
239 if (ACPI_FAILURE(status)) {
240 vdbg_printk(FUJLAPTOP_DBG_WARN,
241 "FUNC 0x%x (args 0x%x, 0x%x, 0x%x) call failed\n",
242 cmd, arg0, arg1, arg2);
243 return -ENODEV;
246 if (out_obj.type != ACPI_TYPE_INTEGER) {
247 vdbg_printk(FUJLAPTOP_DBG_WARN,
248 "FUNC 0x%x (args 0x%x, 0x%x, 0x%x) did not "
249 "return an integer\n",
250 cmd, arg0, arg1, arg2);
251 return -ENODEV;
254 vdbg_printk(FUJLAPTOP_DBG_TRACE,
255 "FUNC 0x%x (args 0x%x, 0x%x, 0x%x) returned 0x%x\n",
256 cmd, arg0, arg1, arg2, (int)out_obj.integer.value);
257 return out_obj.integer.value;
260 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
261 /* LED class callbacks */
263 static void logolamp_set(struct led_classdev *cdev,
264 enum led_brightness brightness)
266 if (brightness >= LED_FULL) {
267 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_ON);
268 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_ALWAYS, FUNC_LED_ON);
269 } else if (brightness >= LED_HALF) {
270 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_ON);
271 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_ALWAYS, FUNC_LED_OFF);
272 } else {
273 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_OFF);
277 static void kblamps_set(struct led_classdev *cdev,
278 enum led_brightness brightness)
280 if (brightness >= LED_FULL)
281 call_fext_func(FUNC_LEDS, 0x1, KEYBOARD_LAMPS, FUNC_LED_ON);
282 else
283 call_fext_func(FUNC_LEDS, 0x1, KEYBOARD_LAMPS, FUNC_LED_OFF);
286 static enum led_brightness logolamp_get(struct led_classdev *cdev)
288 enum led_brightness brightness = LED_OFF;
289 int poweron, always;
291 poweron = call_fext_func(FUNC_LEDS, 0x2, LOGOLAMP_POWERON, 0x0);
292 if (poweron == FUNC_LED_ON) {
293 brightness = LED_HALF;
294 always = call_fext_func(FUNC_LEDS, 0x2, LOGOLAMP_ALWAYS, 0x0);
295 if (always == FUNC_LED_ON)
296 brightness = LED_FULL;
298 return brightness;
301 static enum led_brightness kblamps_get(struct led_classdev *cdev)
303 enum led_brightness brightness = LED_OFF;
305 if (call_fext_func(FUNC_LEDS, 0x2, KEYBOARD_LAMPS, 0x0) == FUNC_LED_ON)
306 brightness = LED_FULL;
308 return brightness;
310 #endif
312 /* Hardware access for LCD brightness control */
314 static int set_lcd_level(int level)
316 acpi_status status = AE_OK;
317 union acpi_object arg0 = { ACPI_TYPE_INTEGER };
318 struct acpi_object_list arg_list = { 1, &arg0 };
319 acpi_handle handle = NULL;
321 vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBLL [%d]\n",
322 level);
324 if (level < 0 || level >= fujitsu->max_brightness)
325 return -EINVAL;
327 status = acpi_get_handle(fujitsu->acpi_handle, "SBLL", &handle);
328 if (ACPI_FAILURE(status)) {
329 vdbg_printk(FUJLAPTOP_DBG_ERROR, "SBLL not present\n");
330 return -ENODEV;
333 arg0.integer.value = level;
335 status = acpi_evaluate_object(handle, NULL, &arg_list, NULL);
336 if (ACPI_FAILURE(status))
337 return -ENODEV;
339 return 0;
342 static int set_lcd_level_alt(int level)
344 acpi_status status = AE_OK;
345 union acpi_object arg0 = { ACPI_TYPE_INTEGER };
346 struct acpi_object_list arg_list = { 1, &arg0 };
347 acpi_handle handle = NULL;
349 vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBL2 [%d]\n",
350 level);
352 if (level < 0 || level >= fujitsu->max_brightness)
353 return -EINVAL;
355 status = acpi_get_handle(fujitsu->acpi_handle, "SBL2", &handle);
356 if (ACPI_FAILURE(status)) {
357 vdbg_printk(FUJLAPTOP_DBG_ERROR, "SBL2 not present\n");
358 return -ENODEV;
361 arg0.integer.value = level;
363 status = acpi_evaluate_object(handle, NULL, &arg_list, NULL);
364 if (ACPI_FAILURE(status))
365 return -ENODEV;
367 return 0;
370 static int get_lcd_level(void)
372 unsigned long long state = 0;
373 acpi_status status = AE_OK;
375 vdbg_printk(FUJLAPTOP_DBG_TRACE, "get lcd level via GBLL\n");
377 status =
378 acpi_evaluate_integer(fujitsu->acpi_handle, "GBLL", NULL, &state);
379 if (ACPI_FAILURE(status))
380 return 0;
382 fujitsu->brightness_level = state & 0x0fffffff;
384 if (state & 0x80000000)
385 fujitsu->brightness_changed = 1;
386 else
387 fujitsu->brightness_changed = 0;
389 return fujitsu->brightness_level;
392 static int get_max_brightness(void)
394 unsigned long long state = 0;
395 acpi_status status = AE_OK;
397 vdbg_printk(FUJLAPTOP_DBG_TRACE, "get max lcd level via RBLL\n");
399 status =
400 acpi_evaluate_integer(fujitsu->acpi_handle, "RBLL", NULL, &state);
401 if (ACPI_FAILURE(status))
402 return -1;
404 fujitsu->max_brightness = state;
406 return fujitsu->max_brightness;
409 /* Backlight device stuff */
411 static int bl_get_brightness(struct backlight_device *b)
413 return get_lcd_level();
416 static int bl_update_status(struct backlight_device *b)
418 int ret;
419 if (b->props.power == 4)
420 ret = call_fext_func(FUNC_BACKLIGHT, 0x1, 0x4, 0x3);
421 else
422 ret = call_fext_func(FUNC_BACKLIGHT, 0x1, 0x4, 0x0);
423 if (ret != 0)
424 vdbg_printk(FUJLAPTOP_DBG_ERROR,
425 "Unable to adjust backlight power, error code %i\n",
426 ret);
428 if (use_alt_lcd_levels)
429 ret = set_lcd_level_alt(b->props.brightness);
430 else
431 ret = set_lcd_level(b->props.brightness);
432 if (ret != 0)
433 vdbg_printk(FUJLAPTOP_DBG_ERROR,
434 "Unable to adjust LCD brightness, error code %i\n",
435 ret);
436 return ret;
439 static struct backlight_ops fujitsubl_ops = {
440 .get_brightness = bl_get_brightness,
441 .update_status = bl_update_status,
444 /* Platform LCD brightness device */
446 static ssize_t
447 show_max_brightness(struct device *dev,
448 struct device_attribute *attr, char *buf)
451 int ret;
453 ret = get_max_brightness();
454 if (ret < 0)
455 return ret;
457 return sprintf(buf, "%i\n", ret);
460 static ssize_t
461 show_brightness_changed(struct device *dev,
462 struct device_attribute *attr, char *buf)
465 int ret;
467 ret = fujitsu->brightness_changed;
468 if (ret < 0)
469 return ret;
471 return sprintf(buf, "%i\n", ret);
474 static ssize_t show_lcd_level(struct device *dev,
475 struct device_attribute *attr, char *buf)
478 int ret;
480 ret = get_lcd_level();
481 if (ret < 0)
482 return ret;
484 return sprintf(buf, "%i\n", ret);
487 static ssize_t store_lcd_level(struct device *dev,
488 struct device_attribute *attr, const char *buf,
489 size_t count)
492 int level, ret;
494 if (sscanf(buf, "%i", &level) != 1
495 || (level < 0 || level >= fujitsu->max_brightness))
496 return -EINVAL;
498 if (use_alt_lcd_levels)
499 ret = set_lcd_level_alt(level);
500 else
501 ret = set_lcd_level(level);
502 if (ret < 0)
503 return ret;
505 ret = get_lcd_level();
506 if (ret < 0)
507 return ret;
509 return count;
512 static ssize_t
513 ignore_store(struct device *dev,
514 struct device_attribute *attr, const char *buf, size_t count)
516 return count;
519 static ssize_t
520 show_lid_state(struct device *dev,
521 struct device_attribute *attr, char *buf)
523 if (!(fujitsu_hotkey->rfkill_supported & 0x100))
524 return sprintf(buf, "unknown\n");
525 if (fujitsu_hotkey->rfkill_state & 0x100)
526 return sprintf(buf, "open\n");
527 else
528 return sprintf(buf, "closed\n");
531 static ssize_t
532 show_dock_state(struct device *dev,
533 struct device_attribute *attr, char *buf)
535 if (!(fujitsu_hotkey->rfkill_supported & 0x200))
536 return sprintf(buf, "unknown\n");
537 if (fujitsu_hotkey->rfkill_state & 0x200)
538 return sprintf(buf, "docked\n");
539 else
540 return sprintf(buf, "undocked\n");
543 static ssize_t
544 show_radios_state(struct device *dev,
545 struct device_attribute *attr, char *buf)
547 if (!(fujitsu_hotkey->rfkill_supported & 0x20))
548 return sprintf(buf, "unknown\n");
549 if (fujitsu_hotkey->rfkill_state & 0x20)
550 return sprintf(buf, "on\n");
551 else
552 return sprintf(buf, "killed\n");
555 static DEVICE_ATTR(max_brightness, 0444, show_max_brightness, ignore_store);
556 static DEVICE_ATTR(brightness_changed, 0444, show_brightness_changed,
557 ignore_store);
558 static DEVICE_ATTR(lcd_level, 0644, show_lcd_level, store_lcd_level);
559 static DEVICE_ATTR(lid, 0444, show_lid_state, ignore_store);
560 static DEVICE_ATTR(dock, 0444, show_dock_state, ignore_store);
561 static DEVICE_ATTR(radios, 0444, show_radios_state, ignore_store);
563 static struct attribute *fujitsupf_attributes[] = {
564 &dev_attr_brightness_changed.attr,
565 &dev_attr_max_brightness.attr,
566 &dev_attr_lcd_level.attr,
567 &dev_attr_lid.attr,
568 &dev_attr_dock.attr,
569 &dev_attr_radios.attr,
570 NULL
573 static struct attribute_group fujitsupf_attribute_group = {
574 .attrs = fujitsupf_attributes
577 static struct platform_driver fujitsupf_driver = {
578 .driver = {
579 .name = "fujitsu-laptop",
580 .owner = THIS_MODULE,
584 static void dmi_check_cb_common(const struct dmi_system_id *id)
586 acpi_handle handle;
587 printk(KERN_INFO "fujitsu-laptop: Identified laptop model '%s'.\n",
588 id->ident);
589 if (use_alt_lcd_levels == -1) {
590 if (ACPI_SUCCESS(acpi_get_handle(NULL,
591 "\\_SB.PCI0.LPCB.FJEX.SBL2", &handle)))
592 use_alt_lcd_levels = 1;
593 else
594 use_alt_lcd_levels = 0;
595 vdbg_printk(FUJLAPTOP_DBG_TRACE, "auto-detected usealt as "
596 "%i\n", use_alt_lcd_levels);
600 static int dmi_check_cb_s6410(const struct dmi_system_id *id)
602 dmi_check_cb_common(id);
603 fujitsu->keycode1 = KEY_SCREENLOCK; /* "Lock" */
604 fujitsu->keycode2 = KEY_HELP; /* "Mobility Center" */
605 return 0;
608 static int dmi_check_cb_s6420(const struct dmi_system_id *id)
610 dmi_check_cb_common(id);
611 fujitsu->keycode1 = KEY_SCREENLOCK; /* "Lock" */
612 fujitsu->keycode2 = KEY_HELP; /* "Mobility Center" */
613 return 0;
616 static int dmi_check_cb_p8010(const struct dmi_system_id *id)
618 dmi_check_cb_common(id);
619 fujitsu->keycode1 = KEY_HELP; /* "Support" */
620 fujitsu->keycode3 = KEY_SWITCHVIDEOMODE; /* "Presentation" */
621 fujitsu->keycode4 = KEY_WWW; /* "Internet" */
622 return 0;
625 static struct dmi_system_id fujitsu_dmi_table[] = {
627 .ident = "Fujitsu Siemens S6410",
628 .matches = {
629 DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
630 DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6410"),
632 .callback = dmi_check_cb_s6410},
634 .ident = "Fujitsu Siemens S6420",
635 .matches = {
636 DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
637 DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6420"),
639 .callback = dmi_check_cb_s6420},
641 .ident = "Fujitsu LifeBook P8010",
642 .matches = {
643 DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"),
644 DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook P8010"),
646 .callback = dmi_check_cb_p8010},
650 /* ACPI device for LCD brightness control */
652 static int acpi_fujitsu_add(struct acpi_device *device)
654 acpi_handle handle;
655 int result = 0;
656 int state = 0;
657 struct input_dev *input;
658 int error;
660 if (!device)
661 return -EINVAL;
663 fujitsu->acpi_handle = device->handle;
664 sprintf(acpi_device_name(device), "%s", ACPI_FUJITSU_DEVICE_NAME);
665 sprintf(acpi_device_class(device), "%s", ACPI_FUJITSU_CLASS);
666 device->driver_data = fujitsu;
668 fujitsu->input = input = input_allocate_device();
669 if (!input) {
670 error = -ENOMEM;
671 goto err_stop;
674 snprintf(fujitsu->phys, sizeof(fujitsu->phys),
675 "%s/video/input0", acpi_device_hid(device));
677 input->name = acpi_device_name(device);
678 input->phys = fujitsu->phys;
679 input->id.bustype = BUS_HOST;
680 input->id.product = 0x06;
681 input->dev.parent = &device->dev;
682 input->evbit[0] = BIT(EV_KEY);
683 set_bit(KEY_BRIGHTNESSUP, input->keybit);
684 set_bit(KEY_BRIGHTNESSDOWN, input->keybit);
685 set_bit(KEY_UNKNOWN, input->keybit);
687 error = input_register_device(input);
688 if (error)
689 goto err_free_input_dev;
691 result = acpi_bus_get_power(fujitsu->acpi_handle, &state);
692 if (result) {
693 printk(KERN_ERR "Error reading power state\n");
694 goto err_unregister_input_dev;
697 printk(KERN_INFO "ACPI: %s [%s] (%s)\n",
698 acpi_device_name(device), acpi_device_bid(device),
699 !device->power.state ? "on" : "off");
701 fujitsu->dev = device;
703 if (ACPI_SUCCESS
704 (acpi_get_handle(device->handle, METHOD_NAME__INI, &handle))) {
705 vdbg_printk(FUJLAPTOP_DBG_INFO, "Invoking _INI\n");
706 if (ACPI_FAILURE
707 (acpi_evaluate_object
708 (device->handle, METHOD_NAME__INI, NULL, NULL)))
709 printk(KERN_ERR "_INI Method failed\n");
712 /* do config (detect defaults) */
713 use_alt_lcd_levels = use_alt_lcd_levels == 1 ? 1 : 0;
714 disable_brightness_adjust = disable_brightness_adjust == 1 ? 1 : 0;
715 vdbg_printk(FUJLAPTOP_DBG_INFO,
716 "config: [alt interface: %d], [adjust disable: %d]\n",
717 use_alt_lcd_levels, disable_brightness_adjust);
719 if (get_max_brightness() <= 0)
720 fujitsu->max_brightness = FUJITSU_LCD_N_LEVELS;
721 get_lcd_level();
723 return result;
725 err_unregister_input_dev:
726 input_unregister_device(input);
727 err_free_input_dev:
728 input_free_device(input);
729 err_stop:
730 return result;
733 static int acpi_fujitsu_remove(struct acpi_device *device, int type)
735 struct fujitsu_t *fujitsu = acpi_driver_data(device);
736 struct input_dev *input = fujitsu->input;
738 input_unregister_device(input);
740 input_free_device(input);
742 fujitsu->acpi_handle = NULL;
744 return 0;
747 /* Brightness notify */
749 static void acpi_fujitsu_notify(struct acpi_device *device, u32 event)
751 struct input_dev *input;
752 int keycode;
753 int oldb, newb;
755 input = fujitsu->input;
757 switch (event) {
758 case ACPI_FUJITSU_NOTIFY_CODE1:
759 keycode = 0;
760 oldb = fujitsu->brightness_level;
761 get_lcd_level();
762 newb = fujitsu->brightness_level;
764 vdbg_printk(FUJLAPTOP_DBG_TRACE,
765 "brightness button event [%i -> %i (%i)]\n",
766 oldb, newb, fujitsu->brightness_changed);
768 if (oldb < newb) {
769 if (disable_brightness_adjust != 1) {
770 if (use_alt_lcd_levels)
771 set_lcd_level_alt(newb);
772 else
773 set_lcd_level(newb);
775 acpi_bus_generate_proc_event(fujitsu->dev,
776 ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS, 0);
777 keycode = KEY_BRIGHTNESSUP;
778 } else if (oldb > newb) {
779 if (disable_brightness_adjust != 1) {
780 if (use_alt_lcd_levels)
781 set_lcd_level_alt(newb);
782 else
783 set_lcd_level(newb);
785 acpi_bus_generate_proc_event(fujitsu->dev,
786 ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS, 0);
787 keycode = KEY_BRIGHTNESSDOWN;
789 break;
790 default:
791 keycode = KEY_UNKNOWN;
792 vdbg_printk(FUJLAPTOP_DBG_WARN,
793 "unsupported event [0x%x]\n", event);
794 break;
797 if (keycode != 0) {
798 input_report_key(input, keycode, 1);
799 input_sync(input);
800 input_report_key(input, keycode, 0);
801 input_sync(input);
805 /* ACPI device for hotkey handling */
807 static int acpi_fujitsu_hotkey_add(struct acpi_device *device)
809 acpi_handle handle;
810 int result = 0;
811 int state = 0;
812 struct input_dev *input;
813 int error;
814 int i;
816 if (!device)
817 return -EINVAL;
819 fujitsu_hotkey->acpi_handle = device->handle;
820 sprintf(acpi_device_name(device), "%s",
821 ACPI_FUJITSU_HOTKEY_DEVICE_NAME);
822 sprintf(acpi_device_class(device), "%s", ACPI_FUJITSU_CLASS);
823 device->driver_data = fujitsu_hotkey;
825 /* kfifo */
826 spin_lock_init(&fujitsu_hotkey->fifo_lock);
827 error = kfifo_alloc(&fujitsu_hotkey->fifo, RINGBUFFERSIZE * sizeof(int),
828 GFP_KERNEL);
829 if (error) {
830 printk(KERN_ERR "kfifo_alloc failed\n");
831 goto err_stop;
834 fujitsu_hotkey->input = input = input_allocate_device();
835 if (!input) {
836 error = -ENOMEM;
837 goto err_free_fifo;
840 snprintf(fujitsu_hotkey->phys, sizeof(fujitsu_hotkey->phys),
841 "%s/video/input0", acpi_device_hid(device));
843 input->name = acpi_device_name(device);
844 input->phys = fujitsu_hotkey->phys;
845 input->id.bustype = BUS_HOST;
846 input->id.product = 0x06;
847 input->dev.parent = &device->dev;
849 set_bit(EV_KEY, input->evbit);
850 set_bit(fujitsu->keycode1, input->keybit);
851 set_bit(fujitsu->keycode2, input->keybit);
852 set_bit(fujitsu->keycode3, input->keybit);
853 set_bit(fujitsu->keycode4, input->keybit);
854 set_bit(KEY_UNKNOWN, input->keybit);
856 error = input_register_device(input);
857 if (error)
858 goto err_free_input_dev;
860 result = acpi_bus_get_power(fujitsu_hotkey->acpi_handle, &state);
861 if (result) {
862 printk(KERN_ERR "Error reading power state\n");
863 goto err_unregister_input_dev;
866 printk(KERN_INFO "ACPI: %s [%s] (%s)\n",
867 acpi_device_name(device), acpi_device_bid(device),
868 !device->power.state ? "on" : "off");
870 fujitsu_hotkey->dev = device;
872 if (ACPI_SUCCESS
873 (acpi_get_handle(device->handle, METHOD_NAME__INI, &handle))) {
874 vdbg_printk(FUJLAPTOP_DBG_INFO, "Invoking _INI\n");
875 if (ACPI_FAILURE
876 (acpi_evaluate_object
877 (device->handle, METHOD_NAME__INI, NULL, NULL)))
878 printk(KERN_ERR "_INI Method failed\n");
881 i = 0;
882 while (call_fext_func(FUNC_BUTTONS, 0x1, 0x0, 0x0) != 0
883 && (i++) < MAX_HOTKEY_RINGBUFFER_SIZE)
884 ; /* No action, result is discarded */
885 vdbg_printk(FUJLAPTOP_DBG_INFO, "Discarded %i ringbuffer entries\n", i);
887 fujitsu_hotkey->rfkill_supported =
888 call_fext_func(FUNC_RFKILL, 0x0, 0x0, 0x0);
890 /* Make sure our bitmask of supported functions is cleared if the
891 RFKILL function block is not implemented, like on the S7020. */
892 if (fujitsu_hotkey->rfkill_supported == UNSUPPORTED_CMD)
893 fujitsu_hotkey->rfkill_supported = 0;
895 if (fujitsu_hotkey->rfkill_supported)
896 fujitsu_hotkey->rfkill_state =
897 call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
899 /* Suspect this is a keymap of the application panel, print it */
900 printk(KERN_INFO "fujitsu-laptop: BTNI: [0x%x]\n",
901 call_fext_func(FUNC_BUTTONS, 0x0, 0x0, 0x0));
903 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
904 if (call_fext_func(FUNC_LEDS, 0x0, 0x0, 0x0) & LOGOLAMP_POWERON) {
905 result = led_classdev_register(&fujitsu->pf_device->dev,
906 &logolamp_led);
907 if (result == 0) {
908 fujitsu_hotkey->logolamp_registered = 1;
909 } else {
910 printk(KERN_ERR "fujitsu-laptop: Could not register "
911 "LED handler for logo lamp, error %i\n", result);
915 if ((call_fext_func(FUNC_LEDS, 0x0, 0x0, 0x0) & KEYBOARD_LAMPS) &&
916 (call_fext_func(FUNC_BUTTONS, 0x0, 0x0, 0x0) == 0x0)) {
917 result = led_classdev_register(&fujitsu->pf_device->dev,
918 &kblamps_led);
919 if (result == 0) {
920 fujitsu_hotkey->kblamps_registered = 1;
921 } else {
922 printk(KERN_ERR "fujitsu-laptop: Could not register "
923 "LED handler for keyboard lamps, error %i\n", result);
926 #endif
928 return result;
930 err_unregister_input_dev:
931 input_unregister_device(input);
932 err_free_input_dev:
933 input_free_device(input);
934 err_free_fifo:
935 kfifo_free(&fujitsu_hotkey->fifo);
936 err_stop:
937 return result;
940 static int acpi_fujitsu_hotkey_remove(struct acpi_device *device, int type)
942 struct fujitsu_hotkey_t *fujitsu_hotkey = acpi_driver_data(device);
943 struct input_dev *input = fujitsu_hotkey->input;
945 #if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
946 if (fujitsu_hotkey->logolamp_registered)
947 led_classdev_unregister(&logolamp_led);
949 if (fujitsu_hotkey->kblamps_registered)
950 led_classdev_unregister(&kblamps_led);
951 #endif
953 input_unregister_device(input);
955 input_free_device(input);
957 kfifo_free(&fujitsu_hotkey->fifo);
959 fujitsu_hotkey->acpi_handle = NULL;
961 return 0;
964 static void acpi_fujitsu_hotkey_notify(struct acpi_device *device, u32 event)
966 struct input_dev *input;
967 int keycode, keycode_r;
968 unsigned int irb = 1;
969 int i, status;
971 input = fujitsu_hotkey->input;
973 if (fujitsu_hotkey->rfkill_supported)
974 fujitsu_hotkey->rfkill_state =
975 call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
977 switch (event) {
978 case ACPI_FUJITSU_NOTIFY_CODE1:
979 i = 0;
980 while ((irb =
981 call_fext_func(FUNC_BUTTONS, 0x1, 0x0, 0x0)) != 0
982 && (i++) < MAX_HOTKEY_RINGBUFFER_SIZE) {
983 switch (irb & 0x4ff) {
984 case KEY1_CODE:
985 keycode = fujitsu->keycode1;
986 break;
987 case KEY2_CODE:
988 keycode = fujitsu->keycode2;
989 break;
990 case KEY3_CODE:
991 keycode = fujitsu->keycode3;
992 break;
993 case KEY4_CODE:
994 keycode = fujitsu->keycode4;
995 break;
996 case 0:
997 keycode = 0;
998 break;
999 default:
1000 vdbg_printk(FUJLAPTOP_DBG_WARN,
1001 "Unknown GIRB result [%x]\n", irb);
1002 keycode = -1;
1003 break;
1005 if (keycode > 0) {
1006 vdbg_printk(FUJLAPTOP_DBG_TRACE,
1007 "Push keycode into ringbuffer [%d]\n",
1008 keycode);
1009 status = kfifo_in_locked(&fujitsu_hotkey->fifo,
1010 (unsigned char *)&keycode,
1011 sizeof(keycode),
1012 &fujitsu_hotkey->fifo_lock);
1013 if (status != sizeof(keycode)) {
1014 vdbg_printk(FUJLAPTOP_DBG_WARN,
1015 "Could not push keycode [0x%x]\n",
1016 keycode);
1017 } else {
1018 input_report_key(input, keycode, 1);
1019 input_sync(input);
1021 } else if (keycode == 0) {
1022 while ((status =
1023 kfifo_out_locked(
1024 &fujitsu_hotkey->fifo,
1025 (unsigned char *) &keycode_r,
1026 sizeof(keycode_r),
1027 &fujitsu_hotkey->fifo_lock))
1028 == sizeof(keycode_r)) {
1029 input_report_key(input, keycode_r, 0);
1030 input_sync(input);
1031 vdbg_printk(FUJLAPTOP_DBG_TRACE,
1032 "Pop keycode from ringbuffer [%d]\n",
1033 keycode_r);
1038 break;
1039 default:
1040 keycode = KEY_UNKNOWN;
1041 vdbg_printk(FUJLAPTOP_DBG_WARN,
1042 "Unsupported event [0x%x]\n", event);
1043 input_report_key(input, keycode, 1);
1044 input_sync(input);
1045 input_report_key(input, keycode, 0);
1046 input_sync(input);
1047 break;
1051 /* Initialization */
1053 static const struct acpi_device_id fujitsu_device_ids[] = {
1054 {ACPI_FUJITSU_HID, 0},
1055 {"", 0},
1058 static struct acpi_driver acpi_fujitsu_driver = {
1059 .name = ACPI_FUJITSU_DRIVER_NAME,
1060 .class = ACPI_FUJITSU_CLASS,
1061 .ids = fujitsu_device_ids,
1062 .ops = {
1063 .add = acpi_fujitsu_add,
1064 .remove = acpi_fujitsu_remove,
1065 .notify = acpi_fujitsu_notify,
1069 static const struct acpi_device_id fujitsu_hotkey_device_ids[] = {
1070 {ACPI_FUJITSU_HOTKEY_HID, 0},
1071 {"", 0},
1074 static struct acpi_driver acpi_fujitsu_hotkey_driver = {
1075 .name = ACPI_FUJITSU_HOTKEY_DRIVER_NAME,
1076 .class = ACPI_FUJITSU_CLASS,
1077 .ids = fujitsu_hotkey_device_ids,
1078 .ops = {
1079 .add = acpi_fujitsu_hotkey_add,
1080 .remove = acpi_fujitsu_hotkey_remove,
1081 .notify = acpi_fujitsu_hotkey_notify,
1085 static int __init fujitsu_init(void)
1087 int ret, result, max_brightness;
1089 if (acpi_disabled)
1090 return -ENODEV;
1092 fujitsu = kmalloc(sizeof(struct fujitsu_t), GFP_KERNEL);
1093 if (!fujitsu)
1094 return -ENOMEM;
1095 memset(fujitsu, 0, sizeof(struct fujitsu_t));
1096 fujitsu->keycode1 = KEY_PROG1;
1097 fujitsu->keycode2 = KEY_PROG2;
1098 fujitsu->keycode3 = KEY_PROG3;
1099 fujitsu->keycode4 = KEY_PROG4;
1100 dmi_check_system(fujitsu_dmi_table);
1102 result = acpi_bus_register_driver(&acpi_fujitsu_driver);
1103 if (result < 0) {
1104 ret = -ENODEV;
1105 goto fail_acpi;
1108 /* Register platform stuff */
1110 fujitsu->pf_device = platform_device_alloc("fujitsu-laptop", -1);
1111 if (!fujitsu->pf_device) {
1112 ret = -ENOMEM;
1113 goto fail_platform_driver;
1116 ret = platform_device_add(fujitsu->pf_device);
1117 if (ret)
1118 goto fail_platform_device1;
1120 ret =
1121 sysfs_create_group(&fujitsu->pf_device->dev.kobj,
1122 &fujitsupf_attribute_group);
1123 if (ret)
1124 goto fail_platform_device2;
1126 /* Register backlight stuff */
1128 if (!acpi_video_backlight_support()) {
1129 fujitsu->bl_device =
1130 backlight_device_register("fujitsu-laptop", NULL, NULL,
1131 &fujitsubl_ops);
1132 if (IS_ERR(fujitsu->bl_device)) {
1133 ret = PTR_ERR(fujitsu->bl_device);
1134 fujitsu->bl_device = NULL;
1135 goto fail_sysfs_group;
1137 max_brightness = fujitsu->max_brightness;
1138 fujitsu->bl_device->props.max_brightness = max_brightness - 1;
1139 fujitsu->bl_device->props.brightness = fujitsu->brightness_level;
1142 ret = platform_driver_register(&fujitsupf_driver);
1143 if (ret)
1144 goto fail_backlight;
1146 /* Register hotkey driver */
1148 fujitsu_hotkey = kmalloc(sizeof(struct fujitsu_hotkey_t), GFP_KERNEL);
1149 if (!fujitsu_hotkey) {
1150 ret = -ENOMEM;
1151 goto fail_hotkey;
1153 memset(fujitsu_hotkey, 0, sizeof(struct fujitsu_hotkey_t));
1155 result = acpi_bus_register_driver(&acpi_fujitsu_hotkey_driver);
1156 if (result < 0) {
1157 ret = -ENODEV;
1158 goto fail_hotkey1;
1161 /* Sync backlight power status (needs FUJ02E3 device, hence deferred) */
1163 if (!acpi_video_backlight_support()) {
1164 if (call_fext_func(FUNC_BACKLIGHT, 0x2, 0x4, 0x0) == 3)
1165 fujitsu->bl_device->props.power = 4;
1166 else
1167 fujitsu->bl_device->props.power = 0;
1170 printk(KERN_INFO "fujitsu-laptop: driver " FUJITSU_DRIVER_VERSION
1171 " successfully loaded.\n");
1173 return 0;
1175 fail_hotkey1:
1176 kfree(fujitsu_hotkey);
1177 fail_hotkey:
1178 platform_driver_unregister(&fujitsupf_driver);
1179 fail_backlight:
1180 if (fujitsu->bl_device)
1181 backlight_device_unregister(fujitsu->bl_device);
1182 fail_sysfs_group:
1183 sysfs_remove_group(&fujitsu->pf_device->dev.kobj,
1184 &fujitsupf_attribute_group);
1185 fail_platform_device2:
1186 platform_device_del(fujitsu->pf_device);
1187 fail_platform_device1:
1188 platform_device_put(fujitsu->pf_device);
1189 fail_platform_driver:
1190 acpi_bus_unregister_driver(&acpi_fujitsu_driver);
1191 fail_acpi:
1192 kfree(fujitsu);
1194 return ret;
1197 static void __exit fujitsu_cleanup(void)
1199 acpi_bus_unregister_driver(&acpi_fujitsu_hotkey_driver);
1201 kfree(fujitsu_hotkey);
1203 platform_driver_unregister(&fujitsupf_driver);
1205 if (fujitsu->bl_device)
1206 backlight_device_unregister(fujitsu->bl_device);
1208 sysfs_remove_group(&fujitsu->pf_device->dev.kobj,
1209 &fujitsupf_attribute_group);
1211 platform_device_unregister(fujitsu->pf_device);
1213 acpi_bus_unregister_driver(&acpi_fujitsu_driver);
1215 kfree(fujitsu);
1217 printk(KERN_INFO "fujitsu-laptop: driver unloaded.\n");
1220 module_init(fujitsu_init);
1221 module_exit(fujitsu_cleanup);
1223 module_param(use_alt_lcd_levels, uint, 0644);
1224 MODULE_PARM_DESC(use_alt_lcd_levels,
1225 "Use alternative interface for lcd_levels (needed for Lifebook s6410).");
1226 module_param(disable_brightness_adjust, uint, 0644);
1227 MODULE_PARM_DESC(disable_brightness_adjust, "Disable brightness adjustment .");
1228 #ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
1229 module_param_named(debug, dbg_level, uint, 0644);
1230 MODULE_PARM_DESC(debug, "Sets debug level bit-mask");
1231 #endif
1233 MODULE_AUTHOR("Jonathan Woithe, Peter Gruber, Tony Vroon");
1234 MODULE_DESCRIPTION("Fujitsu laptop extras support");
1235 MODULE_VERSION(FUJITSU_DRIVER_VERSION);
1236 MODULE_LICENSE("GPL");
1238 MODULE_ALIAS("dmi:*:svnFUJITSUSIEMENS:*:pvr:rvnFUJITSU:rnFJNB1D3:*:cvrS6410:*");
1239 MODULE_ALIAS("dmi:*:svnFUJITSUSIEMENS:*:pvr:rvnFUJITSU:rnFJNB1E6:*:cvrS6420:*");
1240 MODULE_ALIAS("dmi:*:svnFUJITSU:*:pvr:rvnFUJITSU:rnFJNB19C:*:cvrS7020:*");
1242 static struct pnp_device_id pnp_ids[] = {
1243 {.id = "FUJ02bf"},
1244 {.id = "FUJ02B1"},
1245 {.id = "FUJ02E3"},
1246 {.id = ""}
1249 MODULE_DEVICE_TABLE(pnp, pnp_ids);