1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
60
61#include <linux/module.h>
62#include <linux/kernel.h>
63#include <linux/init.h>
64#include <linux/acpi.h>
65#include <linux/dmi.h>
66#include <linux/backlight.h>
67#include <linux/input.h>
68#include <linux/kfifo.h>
69#include <linux/video_output.h>
70#include <linux/platform_device.h>
71#include <linux/slab.h>
72#if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
73#include <linux/leds.h>
74#endif
75
76#define FUJITSU_DRIVER_VERSION "0.6.0"
77
78#define FUJITSU_LCD_N_LEVELS 8
79
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"
87
88#define ACPI_FUJITSU_NOTIFY_CODE1 0x80
89
90#define ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS 0x86
91#define ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS 0x87
92
93
94#define FUNC_RFKILL 0x1000
95#define FUNC_LEDS 0x1001
96#define FUNC_BUTTONS 0x1002
97#define FUNC_BACKLIGHT 0x1004
98
99
100#define UNSUPPORTED_CMD 0x80000000
101
102#if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
103
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
110
111
112#define KEY1_CODE 0x410
113#define KEY2_CODE 0x411
114#define KEY3_CODE 0x412
115#define KEY4_CODE 0x413
116
117#define MAX_HOTKEY_RINGBUFFER_SIZE 100
118#define RINGBUFFERSIZE 40
119
120
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
126
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
132
133#define dbg_printk(a_dbg_level, format, arg...) \
134 do { if (dbg_level & a_dbg_level) \
135 printk(FUJLAPTOP_DEBUG "%s: " format, __func__ , ## arg); \
136 } while (0)
137#ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
138#define vdbg_printk(a_dbg_level, format, arg...) \
139 dbg_printk(a_dbg_level, format, ## arg)
140#else
141#define vdbg_printk(a_dbg_level, format, arg...)
142#endif
143
144
145struct fujitsu_t {
146 acpi_handle acpi_handle;
147 struct acpi_device *dev;
148 struct input_dev *input;
149 char phys[32];
150 struct backlight_device *bl_device;
151 struct platform_device *pf_device;
152 int keycode1, keycode2, keycode3, keycode4;
153
154 unsigned int max_brightness;
155 unsigned int brightness_changed;
156 unsigned int brightness_level;
157};
158
159static struct fujitsu_t *fujitsu;
160static int use_alt_lcd_levels = -1;
161static int disable_brightness_adjust = -1;
162
163
164struct fujitsu_hotkey_t {
165 acpi_handle acpi_handle;
166 struct acpi_device *dev;
167 struct input_dev *input;
168 char phys[32];
169 struct platform_device *pf_device;
170 struct kfifo fifo;
171 spinlock_t fifo_lock;
172 int rfkill_supported;
173 int rfkill_state;
174 int logolamp_registered;
175 int kblamps_registered;
176};
177
178static struct fujitsu_hotkey_t *fujitsu_hotkey;
179
180static void acpi_fujitsu_hotkey_notify(struct acpi_device *device, u32 event);
181
182#if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
183static enum led_brightness logolamp_get(struct led_classdev *cdev);
184static void logolamp_set(struct led_classdev *cdev,
185 enum led_brightness brightness);
186
187static struct led_classdev logolamp_led = {
188 .name = "fujitsu::logolamp",
189 .brightness_get = logolamp_get,
190 .brightness_set = logolamp_set
191};
192
193static enum led_brightness kblamps_get(struct led_classdev *cdev);
194static void kblamps_set(struct led_classdev *cdev,
195 enum led_brightness brightness);
196
197static struct led_classdev kblamps_led = {
198 .name = "fujitsu::kblamps",
199 .brightness_get = kblamps_get,
200 .brightness_set = kblamps_set
201};
202#endif
203
204#ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
205static u32 dbg_level = 0x03;
206#endif
207
208static void acpi_fujitsu_notify(struct acpi_device *device, u32 event);
209
210
211
212static int call_fext_func(int cmd, int arg0, int arg1, int arg2)
213{
214 acpi_status status = AE_OK;
215 union acpi_object params[4] = {
216 { .type = ACPI_TYPE_INTEGER },
217 { .type = ACPI_TYPE_INTEGER },
218 { .type = ACPI_TYPE_INTEGER },
219 { .type = ACPI_TYPE_INTEGER }
220 };
221 struct acpi_object_list arg_list = { 4, ¶ms[0] };
222 struct acpi_buffer output;
223 union acpi_object out_obj;
224 acpi_handle handle = NULL;
225
226 status = acpi_get_handle(fujitsu_hotkey->acpi_handle, "FUNC", &handle);
227 if (ACPI_FAILURE(status)) {
228 vdbg_printk(FUJLAPTOP_DBG_ERROR,
229 "FUNC interface is not present\n");
230 return -ENODEV;
231 }
232
233 params[0].integer.value = cmd;
234 params[1].integer.value = arg0;
235 params[2].integer.value = arg1;
236 params[3].integer.value = arg2;
237
238 output.length = sizeof(out_obj);
239 output.pointer = &out_obj;
240
241 status = acpi_evaluate_object(handle, NULL, &arg_list, &output);
242 if (ACPI_FAILURE(status)) {
243 vdbg_printk(FUJLAPTOP_DBG_WARN,
244 "FUNC 0x%x (args 0x%x, 0x%x, 0x%x) call failed\n",
245 cmd, arg0, arg1, arg2);
246 return -ENODEV;
247 }
248
249 if (out_obj.type != ACPI_TYPE_INTEGER) {
250 vdbg_printk(FUJLAPTOP_DBG_WARN,
251 "FUNC 0x%x (args 0x%x, 0x%x, 0x%x) did not "
252 "return an integer\n",
253 cmd, arg0, arg1, arg2);
254 return -ENODEV;
255 }
256
257 vdbg_printk(FUJLAPTOP_DBG_TRACE,
258 "FUNC 0x%x (args 0x%x, 0x%x, 0x%x) returned 0x%x\n",
259 cmd, arg0, arg1, arg2, (int)out_obj.integer.value);
260 return out_obj.integer.value;
261}
262
263#if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
264
265
266static void logolamp_set(struct led_classdev *cdev,
267 enum led_brightness brightness)
268{
269 if (brightness >= LED_FULL) {
270 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_ON);
271 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_ALWAYS, FUNC_LED_ON);
272 } else if (brightness >= LED_HALF) {
273 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_ON);
274 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_ALWAYS, FUNC_LED_OFF);
275 } else {
276 call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_OFF);
277 }
278}
279
280static void kblamps_set(struct led_classdev *cdev,
281 enum led_brightness brightness)
282{
283 if (brightness >= LED_FULL)
284 call_fext_func(FUNC_LEDS, 0x1, KEYBOARD_LAMPS, FUNC_LED_ON);
285 else
286 call_fext_func(FUNC_LEDS, 0x1, KEYBOARD_LAMPS, FUNC_LED_OFF);
287}
288
289static enum led_brightness logolamp_get(struct led_classdev *cdev)
290{
291 enum led_brightness brightness = LED_OFF;
292 int poweron, always;
293
294 poweron = call_fext_func(FUNC_LEDS, 0x2, LOGOLAMP_POWERON, 0x0);
295 if (poweron == FUNC_LED_ON) {
296 brightness = LED_HALF;
297 always = call_fext_func(FUNC_LEDS, 0x2, LOGOLAMP_ALWAYS, 0x0);
298 if (always == FUNC_LED_ON)
299 brightness = LED_FULL;
300 }
301 return brightness;
302}
303
304static enum led_brightness kblamps_get(struct led_classdev *cdev)
305{
306 enum led_brightness brightness = LED_OFF;
307
308 if (call_fext_func(FUNC_LEDS, 0x2, KEYBOARD_LAMPS, 0x0) == FUNC_LED_ON)
309 brightness = LED_FULL;
310
311 return brightness;
312}
313#endif
314
315
316
317static int set_lcd_level(int level)
318{
319 acpi_status status = AE_OK;
320 union acpi_object arg0 = { ACPI_TYPE_INTEGER };
321 struct acpi_object_list arg_list = { 1, &arg0 };
322 acpi_handle handle = NULL;
323
324 vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBLL [%d]\n",
325 level);
326
327 if (level < 0 || level >= fujitsu->max_brightness)
328 return -EINVAL;
329
330 status = acpi_get_handle(fujitsu->acpi_handle, "SBLL", &handle);
331 if (ACPI_FAILURE(status)) {
332 vdbg_printk(FUJLAPTOP_DBG_ERROR, "SBLL not present\n");
333 return -ENODEV;
334 }
335
336 arg0.integer.value = level;
337
338 status = acpi_evaluate_object(handle, NULL, &arg_list, NULL);
339 if (ACPI_FAILURE(status))
340 return -ENODEV;
341
342 return 0;
343}
344
345static int set_lcd_level_alt(int level)
346{
347 acpi_status status = AE_OK;
348 union acpi_object arg0 = { ACPI_TYPE_INTEGER };
349 struct acpi_object_list arg_list = { 1, &arg0 };
350 acpi_handle handle = NULL;
351
352 vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBL2 [%d]\n",
353 level);
354
355 if (level < 0 || level >= fujitsu->max_brightness)
356 return -EINVAL;
357
358 status = acpi_get_handle(fujitsu->acpi_handle, "SBL2", &handle);
359 if (ACPI_FAILURE(status)) {
360 vdbg_printk(FUJLAPTOP_DBG_ERROR, "SBL2 not present\n");
361 return -ENODEV;
362 }
363
364 arg0.integer.value = level;
365
366 status = acpi_evaluate_object(handle, NULL, &arg_list, NULL);
367 if (ACPI_FAILURE(status))
368 return -ENODEV;
369
370 return 0;
371}
372
373static int get_lcd_level(void)
374{
375 unsigned long long state = 0;
376 acpi_status status = AE_OK;
377
378 vdbg_printk(FUJLAPTOP_DBG_TRACE, "get lcd level via GBLL\n");
379
380 status =
381 acpi_evaluate_integer(fujitsu->acpi_handle, "GBLL", NULL, &state);
382 if (ACPI_FAILURE(status))
383 return 0;
384
385 fujitsu->brightness_level = state & 0x0fffffff;
386
387 if (state & 0x80000000)
388 fujitsu->brightness_changed = 1;
389 else
390 fujitsu->brightness_changed = 0;
391
392 return fujitsu->brightness_level;
393}
394
395static int get_max_brightness(void)
396{
397 unsigned long long state = 0;
398 acpi_status status = AE_OK;
399
400 vdbg_printk(FUJLAPTOP_DBG_TRACE, "get max lcd level via RBLL\n");
401
402 status =
403 acpi_evaluate_integer(fujitsu->acpi_handle, "RBLL", NULL, &state);
404 if (ACPI_FAILURE(status))
405 return -1;
406
407 fujitsu->max_brightness = state;
408
409 return fujitsu->max_brightness;
410}
411
412
413
414static int bl_get_brightness(struct backlight_device *b)
415{
416 return get_lcd_level();
417}
418
419static int bl_update_status(struct backlight_device *b)
420{
421 int ret;
422 if (b->props.power == 4)
423 ret = call_fext_func(FUNC_BACKLIGHT, 0x1, 0x4, 0x3);
424 else
425 ret = call_fext_func(FUNC_BACKLIGHT, 0x1, 0x4, 0x0);
426 if (ret != 0)
427 vdbg_printk(FUJLAPTOP_DBG_ERROR,
428 "Unable to adjust backlight power, error code %i\n",
429 ret);
430
431 if (use_alt_lcd_levels)
432 ret = set_lcd_level_alt(b->props.brightness);
433 else
434 ret = set_lcd_level(b->props.brightness);
435 if (ret != 0)
436 vdbg_printk(FUJLAPTOP_DBG_ERROR,
437 "Unable to adjust LCD brightness, error code %i\n",
438 ret);
439 return ret;
440}
441
442static const struct backlight_ops fujitsubl_ops = {
443 .get_brightness = bl_get_brightness,
444 .update_status = bl_update_status,
445};
446
447
448
449static ssize_t
450show_max_brightness(struct device *dev,
451 struct device_attribute *attr, char *buf)
452{
453
454 int ret;
455
456 ret = get_max_brightness();
457 if (ret < 0)
458 return ret;
459
460 return sprintf(buf, "%i\n", ret);
461}
462
463static ssize_t
464show_brightness_changed(struct device *dev,
465 struct device_attribute *attr, char *buf)
466{
467
468 int ret;
469
470 ret = fujitsu->brightness_changed;
471 if (ret < 0)
472 return ret;
473
474 return sprintf(buf, "%i\n", ret);
475}
476
477static ssize_t show_lcd_level(struct device *dev,
478 struct device_attribute *attr, char *buf)
479{
480
481 int ret;
482
483 ret = get_lcd_level();
484 if (ret < 0)
485 return ret;
486
487 return sprintf(buf, "%i\n", ret);
488}
489
490static ssize_t store_lcd_level(struct device *dev,
491 struct device_attribute *attr, const char *buf,
492 size_t count)
493{
494
495 int level, ret;
496
497 if (sscanf(buf, "%i", &level) != 1
498 || (level < 0 || level >= fujitsu->max_brightness))
499 return -EINVAL;
500
501 if (use_alt_lcd_levels)
502 ret = set_lcd_level_alt(level);
503 else
504 ret = set_lcd_level(level);
505 if (ret < 0)
506 return ret;
507
508 ret = get_lcd_level();
509 if (ret < 0)
510 return ret;
511
512 return count;
513}
514
515static ssize_t
516ignore_store(struct device *dev,
517 struct device_attribute *attr, const char *buf, size_t count)
518{
519 return count;
520}
521
522static ssize_t
523show_lid_state(struct device *dev,
524 struct device_attribute *attr, char *buf)
525{
526 if (!(fujitsu_hotkey->rfkill_supported & 0x100))
527 return sprintf(buf, "unknown\n");
528 if (fujitsu_hotkey->rfkill_state & 0x100)
529 return sprintf(buf, "open\n");
530 else
531 return sprintf(buf, "closed\n");
532}
533
534static ssize_t
535show_dock_state(struct device *dev,
536 struct device_attribute *attr, char *buf)
537{
538 if (!(fujitsu_hotkey->rfkill_supported & 0x200))
539 return sprintf(buf, "unknown\n");
540 if (fujitsu_hotkey->rfkill_state & 0x200)
541 return sprintf(buf, "docked\n");
542 else
543 return sprintf(buf, "undocked\n");
544}
545
546static ssize_t
547show_radios_state(struct device *dev,
548 struct device_attribute *attr, char *buf)
549{
550 if (!(fujitsu_hotkey->rfkill_supported & 0x20))
551 return sprintf(buf, "unknown\n");
552 if (fujitsu_hotkey->rfkill_state & 0x20)
553 return sprintf(buf, "on\n");
554 else
555 return sprintf(buf, "killed\n");
556}
557
558static DEVICE_ATTR(max_brightness, 0444, show_max_brightness, ignore_store);
559static DEVICE_ATTR(brightness_changed, 0444, show_brightness_changed,
560 ignore_store);
561static DEVICE_ATTR(lcd_level, 0644, show_lcd_level, store_lcd_level);
562static DEVICE_ATTR(lid, 0444, show_lid_state, ignore_store);
563static DEVICE_ATTR(dock, 0444, show_dock_state, ignore_store);
564static DEVICE_ATTR(radios, 0444, show_radios_state, ignore_store);
565
566static struct attribute *fujitsupf_attributes[] = {
567 &dev_attr_brightness_changed.attr,
568 &dev_attr_max_brightness.attr,
569 &dev_attr_lcd_level.attr,
570 &dev_attr_lid.attr,
571 &dev_attr_dock.attr,
572 &dev_attr_radios.attr,
573 NULL
574};
575
576static struct attribute_group fujitsupf_attribute_group = {
577 .attrs = fujitsupf_attributes
578};
579
580static struct platform_driver fujitsupf_driver = {
581 .driver = {
582 .name = "fujitsu-laptop",
583 .owner = THIS_MODULE,
584 }
585};
586
587static void dmi_check_cb_common(const struct dmi_system_id *id)
588{
589 acpi_handle handle;
590 pr_info("Identified laptop model '%s'\n", id->ident);
591 if (use_alt_lcd_levels == -1) {
592 if (ACPI_SUCCESS(acpi_get_handle(NULL,
593 "\\_SB.PCI0.LPCB.FJEX.SBL2", &handle)))
594 use_alt_lcd_levels = 1;
595 else
596 use_alt_lcd_levels = 0;
597 vdbg_printk(FUJLAPTOP_DBG_TRACE, "auto-detected usealt as "
598 "%i\n", use_alt_lcd_levels);
599 }
600}
601
602static int dmi_check_cb_s6410(const struct dmi_system_id *id)
603{
604 dmi_check_cb_common(id);
605 fujitsu->keycode1 = KEY_SCREENLOCK;
606 fujitsu->keycode2 = KEY_HELP;
607 return 1;
608}
609
610static int dmi_check_cb_s6420(const struct dmi_system_id *id)
611{
612 dmi_check_cb_common(id);
613 fujitsu->keycode1 = KEY_SCREENLOCK;
614 fujitsu->keycode2 = KEY_HELP;
615 return 1;
616}
617
618static int dmi_check_cb_p8010(const struct dmi_system_id *id)
619{
620 dmi_check_cb_common(id);
621 fujitsu->keycode1 = KEY_HELP;
622 fujitsu->keycode3 = KEY_SWITCHVIDEOMODE;
623 fujitsu->keycode4 = KEY_WWW;
624 return 1;
625}
626
627static struct dmi_system_id fujitsu_dmi_table[] = {
628 {
629 .ident = "Fujitsu Siemens S6410",
630 .matches = {
631 DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
632 DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6410"),
633 },
634 .callback = dmi_check_cb_s6410},
635 {
636 .ident = "Fujitsu Siemens S6420",
637 .matches = {
638 DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
639 DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6420"),
640 },
641 .callback = dmi_check_cb_s6420},
642 {
643 .ident = "Fujitsu LifeBook P8010",
644 .matches = {
645 DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"),
646 DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook P8010"),
647 },
648 .callback = dmi_check_cb_p8010},
649 {}
650};
651
652
653
654static int acpi_fujitsu_add(struct acpi_device *device)
655{
656 acpi_handle handle;
657 int result = 0;
658 int state = 0;
659 struct input_dev *input;
660 int error;
661
662 if (!device)
663 return -EINVAL;
664
665 fujitsu->acpi_handle = device->handle;
666 sprintf(acpi_device_name(device), "%s", ACPI_FUJITSU_DEVICE_NAME);
667 sprintf(acpi_device_class(device), "%s", ACPI_FUJITSU_CLASS);
668 device->driver_data = fujitsu;
669
670 fujitsu->input = input = input_allocate_device();
671 if (!input) {
672 error = -ENOMEM;
673 goto err_stop;
674 }
675
676 snprintf(fujitsu->phys, sizeof(fujitsu->phys),
677 "%s/video/input0", acpi_device_hid(device));
678
679 input->name = acpi_device_name(device);
680 input->phys = fujitsu->phys;
681 input->id.bustype = BUS_HOST;
682 input->id.product = 0x06;
683 input->dev.parent = &device->dev;
684 input->evbit[0] = BIT(EV_KEY);
685 set_bit(KEY_BRIGHTNESSUP, input->keybit);
686 set_bit(KEY_BRIGHTNESSDOWN, input->keybit);
687 set_bit(KEY_UNKNOWN, input->keybit);
688
689 error = input_register_device(input);
690 if (error)
691 goto err_free_input_dev;
692
693 result = acpi_bus_update_power(fujitsu->acpi_handle, &state);
694 if (result) {
695 pr_err("Error reading power state\n");
696 goto err_unregister_input_dev;
697 }
698
699 pr_info("ACPI: %s [%s] (%s)\n",
700 acpi_device_name(device), acpi_device_bid(device),
701 !device->power.state ? "on" : "off");
702
703 fujitsu->dev = device;
704
705 if (ACPI_SUCCESS
706 (acpi_get_handle(device->handle, METHOD_NAME__INI, &handle))) {
707 vdbg_printk(FUJLAPTOP_DBG_INFO, "Invoking _INI\n");
708 if (ACPI_FAILURE
709 (acpi_evaluate_object
710 (device->handle, METHOD_NAME__INI, NULL, NULL)))
711 pr_err("_INI Method failed\n");
712 }
713
714
715 use_alt_lcd_levels = use_alt_lcd_levels == 1 ? 1 : 0;
716 disable_brightness_adjust = disable_brightness_adjust == 1 ? 1 : 0;
717 vdbg_printk(FUJLAPTOP_DBG_INFO,
718 "config: [alt interface: %d], [adjust disable: %d]\n",
719 use_alt_lcd_levels, disable_brightness_adjust);
720
721 if (get_max_brightness() <= 0)
722 fujitsu->max_brightness = FUJITSU_LCD_N_LEVELS;
723 get_lcd_level();
724
725 return result;
726
727err_unregister_input_dev:
728 input_unregister_device(input);
729 input = NULL;
730err_free_input_dev:
731 input_free_device(input);
732err_stop:
733 return result;
734}
735
736static int acpi_fujitsu_remove(struct acpi_device *device, int type)
737{
738 struct fujitsu_t *fujitsu = acpi_driver_data(device);
739 struct input_dev *input = fujitsu->input;
740
741 input_unregister_device(input);
742
743 fujitsu->acpi_handle = NULL;
744
745 return 0;
746}
747
748
749
750static void acpi_fujitsu_notify(struct acpi_device *device, u32 event)
751{
752 struct input_dev *input;
753 int keycode;
754 int oldb, newb;
755
756 input = fujitsu->input;
757
758 switch (event) {
759 case ACPI_FUJITSU_NOTIFY_CODE1:
760 keycode = 0;
761 oldb = fujitsu->brightness_level;
762 get_lcd_level();
763 newb = fujitsu->brightness_level;
764
765 vdbg_printk(FUJLAPTOP_DBG_TRACE,
766 "brightness button event [%i -> %i (%i)]\n",
767 oldb, newb, fujitsu->brightness_changed);
768
769 if (oldb < newb) {
770 if (disable_brightness_adjust != 1) {
771 if (use_alt_lcd_levels)
772 set_lcd_level_alt(newb);
773 else
774 set_lcd_level(newb);
775 }
776 acpi_bus_generate_proc_event(fujitsu->dev,
777 ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS, 0);
778 keycode = KEY_BRIGHTNESSUP;
779 } else if (oldb > newb) {
780 if (disable_brightness_adjust != 1) {
781 if (use_alt_lcd_levels)
782 set_lcd_level_alt(newb);
783 else
784 set_lcd_level(newb);
785 }
786 acpi_bus_generate_proc_event(fujitsu->dev,
787 ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS, 0);
788 keycode = KEY_BRIGHTNESSDOWN;
789 }
790 break;
791 default:
792 keycode = KEY_UNKNOWN;
793 vdbg_printk(FUJLAPTOP_DBG_WARN,
794 "unsupported event [0x%x]\n", event);
795 break;
796 }
797
798 if (keycode != 0) {
799 input_report_key(input, keycode, 1);
800 input_sync(input);
801 input_report_key(input, keycode, 0);
802 input_sync(input);
803 }
804}
805
806
807
808static int acpi_fujitsu_hotkey_add(struct acpi_device *device)
809{
810 acpi_handle handle;
811 int result = 0;
812 int state = 0;
813 struct input_dev *input;
814 int error;
815 int i;
816
817 if (!device)
818 return -EINVAL;
819
820 fujitsu_hotkey->acpi_handle = device->handle;
821 sprintf(acpi_device_name(device), "%s",
822 ACPI_FUJITSU_HOTKEY_DEVICE_NAME);
823 sprintf(acpi_device_class(device), "%s", ACPI_FUJITSU_CLASS);
824 device->driver_data = fujitsu_hotkey;
825
826
827 spin_lock_init(&fujitsu_hotkey->fifo_lock);
828 error = kfifo_alloc(&fujitsu_hotkey->fifo, RINGBUFFERSIZE * sizeof(int),
829 GFP_KERNEL);
830 if (error) {
831 pr_err("kfifo_alloc failed\n");
832 goto err_stop;
833 }
834
835 fujitsu_hotkey->input = input = input_allocate_device();
836 if (!input) {
837 error = -ENOMEM;
838 goto err_free_fifo;
839 }
840
841 snprintf(fujitsu_hotkey->phys, sizeof(fujitsu_hotkey->phys),
842 "%s/video/input0", acpi_device_hid(device));
843
844 input->name = acpi_device_name(device);
845 input->phys = fujitsu_hotkey->phys;
846 input->id.bustype = BUS_HOST;
847 input->id.product = 0x06;
848 input->dev.parent = &device->dev;
849
850 set_bit(EV_KEY, input->evbit);
851 set_bit(fujitsu->keycode1, input->keybit);
852 set_bit(fujitsu->keycode2, input->keybit);
853 set_bit(fujitsu->keycode3, input->keybit);
854 set_bit(fujitsu->keycode4, input->keybit);
855 set_bit(KEY_UNKNOWN, input->keybit);
856
857 error = input_register_device(input);
858 if (error)
859 goto err_free_input_dev;
860
861 result = acpi_bus_update_power(fujitsu_hotkey->acpi_handle, &state);
862 if (result) {
863 pr_err("Error reading power state\n");
864 goto err_unregister_input_dev;
865 }
866
867 pr_info("ACPI: %s [%s] (%s)\n",
868 acpi_device_name(device), acpi_device_bid(device),
869 !device->power.state ? "on" : "off");
870
871 fujitsu_hotkey->dev = device;
872
873 if (ACPI_SUCCESS
874 (acpi_get_handle(device->handle, METHOD_NAME__INI, &handle))) {
875 vdbg_printk(FUJLAPTOP_DBG_INFO, "Invoking _INI\n");
876 if (ACPI_FAILURE
877 (acpi_evaluate_object
878 (device->handle, METHOD_NAME__INI, NULL, NULL)))
879 pr_err("_INI Method failed\n");
880 }
881
882 i = 0;
883 while (call_fext_func(FUNC_BUTTONS, 0x1, 0x0, 0x0) != 0
884 && (i++) < MAX_HOTKEY_RINGBUFFER_SIZE)
885 ;
886 vdbg_printk(FUJLAPTOP_DBG_INFO, "Discarded %i ringbuffer entries\n", i);
887
888 fujitsu_hotkey->rfkill_supported =
889 call_fext_func(FUNC_RFKILL, 0x0, 0x0, 0x0);
890
891
892
893 if (fujitsu_hotkey->rfkill_supported == UNSUPPORTED_CMD)
894 fujitsu_hotkey->rfkill_supported = 0;
895
896 if (fujitsu_hotkey->rfkill_supported)
897 fujitsu_hotkey->rfkill_state =
898 call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
899
900
901 pr_info("BTNI: [0x%x]\n", call_fext_func(FUNC_BUTTONS, 0x0, 0x0, 0x0));
902
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 pr_err("Could not register LED handler for logo lamp, error %i\n",
911 result);
912 }
913 }
914
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 pr_err("Could not register LED handler for keyboard lamps, error %i\n",
923 result);
924 }
925 }
926#endif
927
928 return result;
929
930err_unregister_input_dev:
931 input_unregister_device(input);
932 input = NULL;
933err_free_input_dev:
934 input_free_device(input);
935err_free_fifo:
936 kfifo_free(&fujitsu_hotkey->fifo);
937err_stop:
938 return result;
939}
940
941static int acpi_fujitsu_hotkey_remove(struct acpi_device *device, int type)
942{
943 struct fujitsu_hotkey_t *fujitsu_hotkey = acpi_driver_data(device);
944 struct input_dev *input = fujitsu_hotkey->input;
945
946#if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
947 if (fujitsu_hotkey->logolamp_registered)
948 led_classdev_unregister(&logolamp_led);
949
950 if (fujitsu_hotkey->kblamps_registered)
951 led_classdev_unregister(&kblamps_led);
952#endif
953
954 input_unregister_device(input);
955
956 kfifo_free(&fujitsu_hotkey->fifo);
957
958 fujitsu_hotkey->acpi_handle = NULL;
959
960 return 0;
961}
962
963static void acpi_fujitsu_hotkey_notify(struct acpi_device *device, u32 event)
964{
965 struct input_dev *input;
966 int keycode, keycode_r;
967 unsigned int irb = 1;
968 int i, status;
969
970 input = fujitsu_hotkey->input;
971
972 if (fujitsu_hotkey->rfkill_supported)
973 fujitsu_hotkey->rfkill_state =
974 call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
975
976 switch (event) {
977 case ACPI_FUJITSU_NOTIFY_CODE1:
978 i = 0;
979 while ((irb =
980 call_fext_func(FUNC_BUTTONS, 0x1, 0x0, 0x0)) != 0
981 && (i++) < MAX_HOTKEY_RINGBUFFER_SIZE) {
982 switch (irb & 0x4ff) {
983 case KEY1_CODE:
984 keycode = fujitsu->keycode1;
985 break;
986 case KEY2_CODE:
987 keycode = fujitsu->keycode2;
988 break;
989 case KEY3_CODE:
990 keycode = fujitsu->keycode3;
991 break;
992 case KEY4_CODE:
993 keycode = fujitsu->keycode4;
994 break;
995 case 0:
996 keycode = 0;
997 break;
998 default:
999 vdbg_printk(FUJLAPTOP_DBG_WARN,
1000 "Unknown GIRB result [%x]\n", irb);
1001 keycode = -1;
1002 break;
1003 }
1004 if (keycode > 0) {
1005 vdbg_printk(FUJLAPTOP_DBG_TRACE,
1006 "Push keycode into ringbuffer [%d]\n",
1007 keycode);
1008 status = kfifo_in_locked(&fujitsu_hotkey->fifo,
1009 (unsigned char *)&keycode,
1010 sizeof(keycode),
1011 &fujitsu_hotkey->fifo_lock);
1012 if (status != sizeof(keycode)) {
1013 vdbg_printk(FUJLAPTOP_DBG_WARN,
1014 "Could not push keycode [0x%x]\n",
1015 keycode);
1016 } else {
1017 input_report_key(input, keycode, 1);
1018 input_sync(input);
1019 }
1020 } else if (keycode == 0) {
1021 while ((status =
1022 kfifo_out_locked(
1023 &fujitsu_hotkey->fifo,
1024 (unsigned char *) &keycode_r,
1025 sizeof(keycode_r),
1026 &fujitsu_hotkey->fifo_lock))
1027 == sizeof(keycode_r)) {
1028 input_report_key(input, keycode_r, 0);
1029 input_sync(input);
1030 vdbg_printk(FUJLAPTOP_DBG_TRACE,
1031 "Pop keycode from ringbuffer [%d]\n",
1032 keycode_r);
1033 }
1034 }
1035 }
1036
1037 break;
1038 default:
1039 keycode = KEY_UNKNOWN;
1040 vdbg_printk(FUJLAPTOP_DBG_WARN,
1041 "Unsupported event [0x%x]\n", event);
1042 input_report_key(input, keycode, 1);
1043 input_sync(input);
1044 input_report_key(input, keycode, 0);
1045 input_sync(input);
1046 break;
1047 }
1048}
1049
1050
1051
1052static const struct acpi_device_id fujitsu_device_ids[] = {
1053 {ACPI_FUJITSU_HID, 0},
1054 {"", 0},
1055};
1056
1057static struct acpi_driver acpi_fujitsu_driver = {
1058 .name = ACPI_FUJITSU_DRIVER_NAME,
1059 .class = ACPI_FUJITSU_CLASS,
1060 .ids = fujitsu_device_ids,
1061 .ops = {
1062 .add = acpi_fujitsu_add,
1063 .remove = acpi_fujitsu_remove,
1064 .notify = acpi_fujitsu_notify,
1065 },
1066};
1067
1068static const struct acpi_device_id fujitsu_hotkey_device_ids[] = {
1069 {ACPI_FUJITSU_HOTKEY_HID, 0},
1070 {"", 0},
1071};
1072
1073static struct acpi_driver acpi_fujitsu_hotkey_driver = {
1074 .name = ACPI_FUJITSU_HOTKEY_DRIVER_NAME,
1075 .class = ACPI_FUJITSU_CLASS,
1076 .ids = fujitsu_hotkey_device_ids,
1077 .ops = {
1078 .add = acpi_fujitsu_hotkey_add,
1079 .remove = acpi_fujitsu_hotkey_remove,
1080 .notify = acpi_fujitsu_hotkey_notify,
1081 },
1082};
1083
1084static int __init fujitsu_init(void)
1085{
1086 int ret, result, max_brightness;
1087
1088 if (acpi_disabled)
1089 return -ENODEV;
1090
1091 fujitsu = kzalloc(sizeof(struct fujitsu_t), GFP_KERNEL);
1092 if (!fujitsu)
1093 return -ENOMEM;
1094 fujitsu->keycode1 = KEY_PROG1;
1095 fujitsu->keycode2 = KEY_PROG2;
1096 fujitsu->keycode3 = KEY_PROG3;
1097 fujitsu->keycode4 = KEY_PROG4;
1098 dmi_check_system(fujitsu_dmi_table);
1099
1100 result = acpi_bus_register_driver(&acpi_fujitsu_driver);
1101 if (result < 0) {
1102 ret = -ENODEV;
1103 goto fail_acpi;
1104 }
1105
1106
1107
1108 fujitsu->pf_device = platform_device_alloc("fujitsu-laptop", -1);
1109 if (!fujitsu->pf_device) {
1110 ret = -ENOMEM;
1111 goto fail_platform_driver;
1112 }
1113
1114 ret = platform_device_add(fujitsu->pf_device);
1115 if (ret)
1116 goto fail_platform_device1;
1117
1118 ret =
1119 sysfs_create_group(&fujitsu->pf_device->dev.kobj,
1120 &fujitsupf_attribute_group);
1121 if (ret)
1122 goto fail_platform_device2;
1123
1124
1125
1126 if (!acpi_video_backlight_support()) {
1127 struct backlight_properties props;
1128
1129 memset(&props, 0, sizeof(struct backlight_properties));
1130 max_brightness = fujitsu->max_brightness;
1131 props.type = BACKLIGHT_PLATFORM;
1132 props.max_brightness = max_brightness - 1;
1133 fujitsu->bl_device = backlight_device_register("fujitsu-laptop",
1134 NULL, NULL,
1135 &fujitsubl_ops,
1136 &props);
1137 if (IS_ERR(fujitsu->bl_device)) {
1138 ret = PTR_ERR(fujitsu->bl_device);
1139 fujitsu->bl_device = NULL;
1140 goto fail_sysfs_group;
1141 }
1142 fujitsu->bl_device->props.brightness = fujitsu->brightness_level;
1143 }
1144
1145 ret = platform_driver_register(&fujitsupf_driver);
1146 if (ret)
1147 goto fail_backlight;
1148
1149
1150
1151 fujitsu_hotkey = kzalloc(sizeof(struct fujitsu_hotkey_t), GFP_KERNEL);
1152 if (!fujitsu_hotkey) {
1153 ret = -ENOMEM;
1154 goto fail_hotkey;
1155 }
1156
1157 result = acpi_bus_register_driver(&acpi_fujitsu_hotkey_driver);
1158 if (result < 0) {
1159 ret = -ENODEV;
1160 goto fail_hotkey1;
1161 }
1162
1163
1164
1165 if (!acpi_video_backlight_support()) {
1166 if (call_fext_func(FUNC_BACKLIGHT, 0x2, 0x4, 0x0) == 3)
1167 fujitsu->bl_device->props.power = 4;
1168 else
1169 fujitsu->bl_device->props.power = 0;
1170 }
1171
1172 pr_info("driver " FUJITSU_DRIVER_VERSION " successfully loaded\n");
1173
1174 return 0;
1175
1176fail_hotkey1:
1177 kfree(fujitsu_hotkey);
1178fail_hotkey:
1179 platform_driver_unregister(&fujitsupf_driver);
1180fail_backlight:
1181 if (fujitsu->bl_device)
1182 backlight_device_unregister(fujitsu->bl_device);
1183fail_sysfs_group:
1184 sysfs_remove_group(&fujitsu->pf_device->dev.kobj,
1185 &fujitsupf_attribute_group);
1186fail_platform_device2:
1187 platform_device_del(fujitsu->pf_device);
1188fail_platform_device1:
1189 platform_device_put(fujitsu->pf_device);
1190fail_platform_driver:
1191 acpi_bus_unregister_driver(&acpi_fujitsu_driver);
1192fail_acpi:
1193 kfree(fujitsu);
1194
1195 return ret;
1196}
1197
1198static void __exit fujitsu_cleanup(void)
1199{
1200 acpi_bus_unregister_driver(&acpi_fujitsu_hotkey_driver);
1201
1202 kfree(fujitsu_hotkey);
1203
1204 platform_driver_unregister(&fujitsupf_driver);
1205
1206 if (fujitsu->bl_device)
1207 backlight_device_unregister(fujitsu->bl_device);
1208
1209 sysfs_remove_group(&fujitsu->pf_device->dev.kobj,
1210 &fujitsupf_attribute_group);
1211
1212 platform_device_unregister(fujitsu->pf_device);
1213
1214 acpi_bus_unregister_driver(&acpi_fujitsu_driver);
1215
1216 kfree(fujitsu);
1217
1218 pr_info("driver unloaded\n");
1219}
1220
1221module_init(fujitsu_init);
1222module_exit(fujitsu_cleanup);
1223
1224module_param(use_alt_lcd_levels, uint, 0644);
1225MODULE_PARM_DESC(use_alt_lcd_levels,
1226 "Use alternative interface for lcd_levels (needed for Lifebook s6410).");
1227module_param(disable_brightness_adjust, uint, 0644);
1228MODULE_PARM_DESC(disable_brightness_adjust, "Disable brightness adjustment .");
1229#ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
1230module_param_named(debug, dbg_level, uint, 0644);
1231MODULE_PARM_DESC(debug, "Sets debug level bit-mask");
1232#endif
1233
1234MODULE_AUTHOR("Jonathan Woithe, Peter Gruber, Tony Vroon");
1235MODULE_DESCRIPTION("Fujitsu laptop extras support");
1236MODULE_VERSION(FUJITSU_DRIVER_VERSION);
1237MODULE_LICENSE("GPL");
1238
1239MODULE_ALIAS("dmi:*:svnFUJITSUSIEMENS:*:pvr:rvnFUJITSU:rnFJNB1D3:*:cvrS6410:*");
1240MODULE_ALIAS("dmi:*:svnFUJITSUSIEMENS:*:pvr:rvnFUJITSU:rnFJNB1E6:*:cvrS6420:*");
1241MODULE_ALIAS("dmi:*:svnFUJITSU:*:pvr:rvnFUJITSU:rnFJNB19C:*:cvrS7020:*");
1242
1243static struct pnp_device_id pnp_ids[] __used = {
1244 {.id = "FUJ02bf"},
1245 {.id = "FUJ02B1"},
1246 {.id = "FUJ02E3"},
1247 {.id = ""}
1248};
1249
1250MODULE_DEVICE_TABLE(pnp, pnp_ids);
1251
