Loading...
1// SPDX-License-Identifier: GPL-2.0-or-later
2/*-*-linux-c-*-*/
3
4/*
5 Copyright (C) 2007,2008 Jonathan Woithe <jwoithe@just42.net>
6 Copyright (C) 2008 Peter Gruber <nokos@gmx.net>
7 Copyright (C) 2008 Tony Vroon <tony@linx.net>
8 Based on earlier work:
9 Copyright (C) 2003 Shane Spencer <shane@bogomip.com>
10 Adrian Yee <brewt-fujitsu@brewt.org>
11
12 Templated from msi-laptop.c and thinkpad_acpi.c which is copyright
13 by its respective authors.
14
15 */
16
17/*
18 * fujitsu-laptop.c - Fujitsu laptop support, providing access to additional
19 * features made available on a range of Fujitsu laptops including the
20 * P2xxx/P5xxx/S6xxx/S7xxx series.
21 *
22 * This driver implements a vendor-specific backlight control interface for
23 * Fujitsu laptops and provides support for hotkeys present on certain Fujitsu
24 * laptops.
25 *
26 * This driver has been tested on a Fujitsu Lifebook S6410, S7020 and
27 * P8010. It should work on most P-series and S-series Lifebooks, but
28 * YMMV.
29 *
30 * The module parameter use_alt_lcd_levels switches between different ACPI
31 * brightness controls which are used by different Fujitsu laptops. In most
32 * cases the correct method is automatically detected. "use_alt_lcd_levels=1"
33 * is applicable for a Fujitsu Lifebook S6410 if autodetection fails.
34 *
35 */
36
37#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
38
39#include <linux/module.h>
40#include <linux/kernel.h>
41#include <linux/init.h>
42#include <linux/acpi.h>
43#include <linux/bitops.h>
44#include <linux/dmi.h>
45#include <linux/backlight.h>
46#include <linux/fb.h>
47#include <linux/input.h>
48#include <linux/input/sparse-keymap.h>
49#include <linux/kfifo.h>
50#include <linux/leds.h>
51#include <linux/platform_device.h>
52#include <acpi/video.h>
53
54#define FUJITSU_DRIVER_VERSION "0.6.0"
55
56#define FUJITSU_LCD_N_LEVELS 8
57
58#define ACPI_FUJITSU_CLASS "fujitsu"
59#define ACPI_FUJITSU_BL_HID "FUJ02B1"
60#define ACPI_FUJITSU_BL_DRIVER_NAME "Fujitsu laptop FUJ02B1 ACPI brightness driver"
61#define ACPI_FUJITSU_BL_DEVICE_NAME "Fujitsu FUJ02B1"
62#define ACPI_FUJITSU_LAPTOP_HID "FUJ02E3"
63#define ACPI_FUJITSU_LAPTOP_DRIVER_NAME "Fujitsu laptop FUJ02E3 ACPI hotkeys driver"
64#define ACPI_FUJITSU_LAPTOP_DEVICE_NAME "Fujitsu FUJ02E3"
65
66#define ACPI_FUJITSU_NOTIFY_CODE 0x80
67
68/* FUNC interface - command values */
69#define FUNC_FLAGS BIT(12)
70#define FUNC_LEDS (BIT(12) | BIT(0))
71#define FUNC_BUTTONS (BIT(12) | BIT(1))
72#define FUNC_BACKLIGHT (BIT(12) | BIT(2))
73
74/* FUNC interface - responses */
75#define UNSUPPORTED_CMD 0x80000000
76
77/* FUNC interface - status flags */
78#define FLAG_RFKILL BIT(5)
79#define FLAG_LID BIT(8)
80#define FLAG_DOCK BIT(9)
81#define FLAG_TOUCHPAD_TOGGLE BIT(26)
82#define FLAG_MICMUTE BIT(29)
83#define FLAG_SOFTKEYS (FLAG_RFKILL | FLAG_TOUCHPAD_TOGGLE | FLAG_MICMUTE)
84
85/* FUNC interface - LED control */
86#define FUNC_LED_OFF BIT(0)
87#define FUNC_LED_ON (BIT(0) | BIT(16) | BIT(17))
88#define LOGOLAMP_POWERON BIT(13)
89#define LOGOLAMP_ALWAYS BIT(14)
90#define KEYBOARD_LAMPS BIT(8)
91#define RADIO_LED_ON BIT(5)
92#define ECO_LED BIT(16)
93#define ECO_LED_ON BIT(19)
94
95/* FUNC interface - backlight power control */
96#define BACKLIGHT_PARAM_POWER BIT(2)
97#define BACKLIGHT_OFF (BIT(0) | BIT(1))
98#define BACKLIGHT_ON 0
99
100/* Scancodes read from the GIRB register */
101#define KEY1_CODE 0x410
102#define KEY2_CODE 0x411
103#define KEY3_CODE 0x412
104#define KEY4_CODE 0x413
105#define KEY5_CODE 0x420
106
107/* Hotkey ringbuffer limits */
108#define MAX_HOTKEY_RINGBUFFER_SIZE 100
109#define RINGBUFFERSIZE 40
110
111/* Module parameters */
112static int use_alt_lcd_levels = -1;
113static bool disable_brightness_adjust;
114
115/* Device controlling the backlight and associated keys */
116struct fujitsu_bl {
117 struct input_dev *input;
118 char phys[32];
119 struct backlight_device *bl_device;
120 unsigned int max_brightness;
121 unsigned int brightness_level;
122};
123
124static struct fujitsu_bl *fujitsu_bl;
125
126/* Device used to access hotkeys and other features on the laptop */
127struct fujitsu_laptop {
128 struct input_dev *input;
129 char phys[32];
130 struct platform_device *pf_device;
131 struct kfifo fifo;
132 spinlock_t fifo_lock;
133 int flags_supported;
134 int flags_state;
135};
136
137static struct acpi_device *fext;
138
139/* Fujitsu ACPI interface function */
140
141static int call_fext_func(struct acpi_device *device,
142 int func, int op, int feature, int state)
143{
144 union acpi_object params[4] = {
145 { .integer.type = ACPI_TYPE_INTEGER, .integer.value = func },
146 { .integer.type = ACPI_TYPE_INTEGER, .integer.value = op },
147 { .integer.type = ACPI_TYPE_INTEGER, .integer.value = feature },
148 { .integer.type = ACPI_TYPE_INTEGER, .integer.value = state }
149 };
150 struct acpi_object_list arg_list = { 4, params };
151 unsigned long long value;
152 acpi_status status;
153
154 status = acpi_evaluate_integer(device->handle, "FUNC", &arg_list,
155 &value);
156 if (ACPI_FAILURE(status)) {
157 acpi_handle_err(device->handle, "Failed to evaluate FUNC\n");
158 return -ENODEV;
159 }
160
161 acpi_handle_debug(device->handle,
162 "FUNC 0x%x (args 0x%x, 0x%x, 0x%x) returned 0x%x\n",
163 func, op, feature, state, (int)value);
164 return value;
165}
166
167/* Hardware access for LCD brightness control */
168
169static int set_lcd_level(struct acpi_device *device, int level)
170{
171 struct fujitsu_bl *priv = acpi_driver_data(device);
172 acpi_status status;
173 char *method;
174
175 switch (use_alt_lcd_levels) {
176 case -1:
177 if (acpi_has_method(device->handle, "SBL2"))
178 method = "SBL2";
179 else
180 method = "SBLL";
181 break;
182 case 1:
183 method = "SBL2";
184 break;
185 default:
186 method = "SBLL";
187 break;
188 }
189
190 acpi_handle_debug(device->handle, "set lcd level via %s [%d]\n", method,
191 level);
192
193 if (level < 0 || level >= priv->max_brightness)
194 return -EINVAL;
195
196 status = acpi_execute_simple_method(device->handle, method, level);
197 if (ACPI_FAILURE(status)) {
198 acpi_handle_err(device->handle, "Failed to evaluate %s\n",
199 method);
200 return -ENODEV;
201 }
202
203 priv->brightness_level = level;
204
205 return 0;
206}
207
208static int get_lcd_level(struct acpi_device *device)
209{
210 struct fujitsu_bl *priv = acpi_driver_data(device);
211 unsigned long long state = 0;
212 acpi_status status = AE_OK;
213
214 acpi_handle_debug(device->handle, "get lcd level via GBLL\n");
215
216 status = acpi_evaluate_integer(device->handle, "GBLL", NULL, &state);
217 if (ACPI_FAILURE(status))
218 return 0;
219
220 priv->brightness_level = state & 0x0fffffff;
221
222 return priv->brightness_level;
223}
224
225static int get_max_brightness(struct acpi_device *device)
226{
227 struct fujitsu_bl *priv = acpi_driver_data(device);
228 unsigned long long state = 0;
229 acpi_status status = AE_OK;
230
231 acpi_handle_debug(device->handle, "get max lcd level via RBLL\n");
232
233 status = acpi_evaluate_integer(device->handle, "RBLL", NULL, &state);
234 if (ACPI_FAILURE(status))
235 return -1;
236
237 priv->max_brightness = state;
238
239 return priv->max_brightness;
240}
241
242/* Backlight device stuff */
243
244static int bl_get_brightness(struct backlight_device *b)
245{
246 struct acpi_device *device = bl_get_data(b);
247
248 return b->props.power == FB_BLANK_POWERDOWN ? 0 : get_lcd_level(device);
249}
250
251static int bl_update_status(struct backlight_device *b)
252{
253 struct acpi_device *device = bl_get_data(b);
254
255 if (fext) {
256 if (b->props.power == FB_BLANK_POWERDOWN)
257 call_fext_func(fext, FUNC_BACKLIGHT, 0x1,
258 BACKLIGHT_PARAM_POWER, BACKLIGHT_OFF);
259 else
260 call_fext_func(fext, FUNC_BACKLIGHT, 0x1,
261 BACKLIGHT_PARAM_POWER, BACKLIGHT_ON);
262 }
263
264 return set_lcd_level(device, b->props.brightness);
265}
266
267static const struct backlight_ops fujitsu_bl_ops = {
268 .get_brightness = bl_get_brightness,
269 .update_status = bl_update_status,
270};
271
272static ssize_t lid_show(struct device *dev, struct device_attribute *attr,
273 char *buf)
274{
275 struct fujitsu_laptop *priv = dev_get_drvdata(dev);
276
277 if (!(priv->flags_supported & FLAG_LID))
278 return sprintf(buf, "unknown\n");
279 if (priv->flags_state & FLAG_LID)
280 return sprintf(buf, "open\n");
281 else
282 return sprintf(buf, "closed\n");
283}
284
285static ssize_t dock_show(struct device *dev, struct device_attribute *attr,
286 char *buf)
287{
288 struct fujitsu_laptop *priv = dev_get_drvdata(dev);
289
290 if (!(priv->flags_supported & FLAG_DOCK))
291 return sprintf(buf, "unknown\n");
292 if (priv->flags_state & FLAG_DOCK)
293 return sprintf(buf, "docked\n");
294 else
295 return sprintf(buf, "undocked\n");
296}
297
298static ssize_t radios_show(struct device *dev, struct device_attribute *attr,
299 char *buf)
300{
301 struct fujitsu_laptop *priv = dev_get_drvdata(dev);
302
303 if (!(priv->flags_supported & FLAG_RFKILL))
304 return sprintf(buf, "unknown\n");
305 if (priv->flags_state & FLAG_RFKILL)
306 return sprintf(buf, "on\n");
307 else
308 return sprintf(buf, "killed\n");
309}
310
311static DEVICE_ATTR_RO(lid);
312static DEVICE_ATTR_RO(dock);
313static DEVICE_ATTR_RO(radios);
314
315static struct attribute *fujitsu_pf_attributes[] = {
316 &dev_attr_lid.attr,
317 &dev_attr_dock.attr,
318 &dev_attr_radios.attr,
319 NULL
320};
321
322static const struct attribute_group fujitsu_pf_attribute_group = {
323 .attrs = fujitsu_pf_attributes
324};
325
326static struct platform_driver fujitsu_pf_driver = {
327 .driver = {
328 .name = "fujitsu-laptop",
329 }
330};
331
332/* ACPI device for LCD brightness control */
333
334static const struct key_entry keymap_backlight[] = {
335 { KE_KEY, true, { KEY_BRIGHTNESSUP } },
336 { KE_KEY, false, { KEY_BRIGHTNESSDOWN } },
337 { KE_END, 0 }
338};
339
340static int acpi_fujitsu_bl_input_setup(struct acpi_device *device)
341{
342 struct fujitsu_bl *priv = acpi_driver_data(device);
343 int ret;
344
345 priv->input = devm_input_allocate_device(&device->dev);
346 if (!priv->input)
347 return -ENOMEM;
348
349 snprintf(priv->phys, sizeof(priv->phys), "%s/video/input0",
350 acpi_device_hid(device));
351
352 priv->input->name = acpi_device_name(device);
353 priv->input->phys = priv->phys;
354 priv->input->id.bustype = BUS_HOST;
355 priv->input->id.product = 0x06;
356
357 ret = sparse_keymap_setup(priv->input, keymap_backlight, NULL);
358 if (ret)
359 return ret;
360
361 return input_register_device(priv->input);
362}
363
364static int fujitsu_backlight_register(struct acpi_device *device)
365{
366 struct fujitsu_bl *priv = acpi_driver_data(device);
367 const struct backlight_properties props = {
368 .brightness = priv->brightness_level,
369 .max_brightness = priv->max_brightness - 1,
370 .type = BACKLIGHT_PLATFORM
371 };
372 struct backlight_device *bd;
373
374 bd = devm_backlight_device_register(&device->dev, "fujitsu-laptop",
375 &device->dev, device,
376 &fujitsu_bl_ops, &props);
377 if (IS_ERR(bd))
378 return PTR_ERR(bd);
379
380 priv->bl_device = bd;
381
382 return 0;
383}
384
385static int acpi_fujitsu_bl_add(struct acpi_device *device)
386{
387 struct fujitsu_bl *priv;
388 int ret;
389
390 if (acpi_video_get_backlight_type() != acpi_backlight_vendor)
391 return -ENODEV;
392
393 priv = devm_kzalloc(&device->dev, sizeof(*priv), GFP_KERNEL);
394 if (!priv)
395 return -ENOMEM;
396
397 fujitsu_bl = priv;
398 strcpy(acpi_device_name(device), ACPI_FUJITSU_BL_DEVICE_NAME);
399 strcpy(acpi_device_class(device), ACPI_FUJITSU_CLASS);
400 device->driver_data = priv;
401
402 pr_info("ACPI: %s [%s]\n",
403 acpi_device_name(device), acpi_device_bid(device));
404
405 if (get_max_brightness(device) <= 0)
406 priv->max_brightness = FUJITSU_LCD_N_LEVELS;
407 get_lcd_level(device);
408
409 ret = acpi_fujitsu_bl_input_setup(device);
410 if (ret)
411 return ret;
412
413 return fujitsu_backlight_register(device);
414}
415
416/* Brightness notify */
417
418static void acpi_fujitsu_bl_notify(struct acpi_device *device, u32 event)
419{
420 struct fujitsu_bl *priv = acpi_driver_data(device);
421 int oldb, newb;
422
423 if (event != ACPI_FUJITSU_NOTIFY_CODE) {
424 acpi_handle_info(device->handle, "unsupported event [0x%x]\n",
425 event);
426 sparse_keymap_report_event(priv->input, -1, 1, true);
427 return;
428 }
429
430 oldb = priv->brightness_level;
431 get_lcd_level(device);
432 newb = priv->brightness_level;
433
434 acpi_handle_debug(device->handle,
435 "brightness button event [%i -> %i]\n", oldb, newb);
436
437 if (oldb == newb)
438 return;
439
440 if (!disable_brightness_adjust)
441 set_lcd_level(device, newb);
442
443 sparse_keymap_report_event(priv->input, oldb < newb, 1, true);
444}
445
446/* ACPI device for hotkey handling */
447
448static const struct key_entry keymap_default[] = {
449 { KE_KEY, KEY1_CODE, { KEY_PROG1 } },
450 { KE_KEY, KEY2_CODE, { KEY_PROG2 } },
451 { KE_KEY, KEY3_CODE, { KEY_PROG3 } },
452 { KE_KEY, KEY4_CODE, { KEY_PROG4 } },
453 { KE_KEY, KEY5_CODE, { KEY_RFKILL } },
454 /* Soft keys read from status flags */
455 { KE_KEY, FLAG_RFKILL, { KEY_RFKILL } },
456 { KE_KEY, FLAG_TOUCHPAD_TOGGLE, { KEY_TOUCHPAD_TOGGLE } },
457 { KE_KEY, FLAG_MICMUTE, { KEY_MICMUTE } },
458 { KE_END, 0 }
459};
460
461static const struct key_entry keymap_s64x0[] = {
462 { KE_KEY, KEY1_CODE, { KEY_SCREENLOCK } }, /* "Lock" */
463 { KE_KEY, KEY2_CODE, { KEY_HELP } }, /* "Mobility Center */
464 { KE_KEY, KEY3_CODE, { KEY_PROG3 } },
465 { KE_KEY, KEY4_CODE, { KEY_PROG4 } },
466 { KE_END, 0 }
467};
468
469static const struct key_entry keymap_p8010[] = {
470 { KE_KEY, KEY1_CODE, { KEY_HELP } }, /* "Support" */
471 { KE_KEY, KEY2_CODE, { KEY_PROG2 } },
472 { KE_KEY, KEY3_CODE, { KEY_SWITCHVIDEOMODE } }, /* "Presentation" */
473 { KE_KEY, KEY4_CODE, { KEY_WWW } }, /* "WWW" */
474 { KE_END, 0 }
475};
476
477static const struct key_entry *keymap = keymap_default;
478
479static int fujitsu_laptop_dmi_keymap_override(const struct dmi_system_id *id)
480{
481 pr_info("Identified laptop model '%s'\n", id->ident);
482 keymap = id->driver_data;
483 return 1;
484}
485
486static const struct dmi_system_id fujitsu_laptop_dmi_table[] = {
487 {
488 .callback = fujitsu_laptop_dmi_keymap_override,
489 .ident = "Fujitsu Siemens S6410",
490 .matches = {
491 DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
492 DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6410"),
493 },
494 .driver_data = (void *)keymap_s64x0
495 },
496 {
497 .callback = fujitsu_laptop_dmi_keymap_override,
498 .ident = "Fujitsu Siemens S6420",
499 .matches = {
500 DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
501 DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6420"),
502 },
503 .driver_data = (void *)keymap_s64x0
504 },
505 {
506 .callback = fujitsu_laptop_dmi_keymap_override,
507 .ident = "Fujitsu LifeBook P8010",
508 .matches = {
509 DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"),
510 DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook P8010"),
511 },
512 .driver_data = (void *)keymap_p8010
513 },
514 {}
515};
516
517static int acpi_fujitsu_laptop_input_setup(struct acpi_device *device)
518{
519 struct fujitsu_laptop *priv = acpi_driver_data(device);
520 int ret;
521
522 priv->input = devm_input_allocate_device(&device->dev);
523 if (!priv->input)
524 return -ENOMEM;
525
526 snprintf(priv->phys, sizeof(priv->phys), "%s/input0",
527 acpi_device_hid(device));
528
529 priv->input->name = acpi_device_name(device);
530 priv->input->phys = priv->phys;
531 priv->input->id.bustype = BUS_HOST;
532
533 dmi_check_system(fujitsu_laptop_dmi_table);
534 ret = sparse_keymap_setup(priv->input, keymap, NULL);
535 if (ret)
536 return ret;
537
538 return input_register_device(priv->input);
539}
540
541static int fujitsu_laptop_platform_add(struct acpi_device *device)
542{
543 struct fujitsu_laptop *priv = acpi_driver_data(device);
544 int ret;
545
546 priv->pf_device = platform_device_alloc("fujitsu-laptop", PLATFORM_DEVID_NONE);
547 if (!priv->pf_device)
548 return -ENOMEM;
549
550 platform_set_drvdata(priv->pf_device, priv);
551
552 ret = platform_device_add(priv->pf_device);
553 if (ret)
554 goto err_put_platform_device;
555
556 ret = sysfs_create_group(&priv->pf_device->dev.kobj,
557 &fujitsu_pf_attribute_group);
558 if (ret)
559 goto err_del_platform_device;
560
561 return 0;
562
563err_del_platform_device:
564 platform_device_del(priv->pf_device);
565err_put_platform_device:
566 platform_device_put(priv->pf_device);
567
568 return ret;
569}
570
571static void fujitsu_laptop_platform_remove(struct acpi_device *device)
572{
573 struct fujitsu_laptop *priv = acpi_driver_data(device);
574
575 sysfs_remove_group(&priv->pf_device->dev.kobj,
576 &fujitsu_pf_attribute_group);
577 platform_device_unregister(priv->pf_device);
578}
579
580static int logolamp_set(struct led_classdev *cdev,
581 enum led_brightness brightness)
582{
583 struct acpi_device *device = to_acpi_device(cdev->dev->parent);
584 int poweron = FUNC_LED_ON, always = FUNC_LED_ON;
585 int ret;
586
587 if (brightness < LED_HALF)
588 poweron = FUNC_LED_OFF;
589
590 if (brightness < LED_FULL)
591 always = FUNC_LED_OFF;
592
593 ret = call_fext_func(device, FUNC_LEDS, 0x1, LOGOLAMP_POWERON, poweron);
594 if (ret < 0)
595 return ret;
596
597 return call_fext_func(device, FUNC_LEDS, 0x1, LOGOLAMP_ALWAYS, always);
598}
599
600static enum led_brightness logolamp_get(struct led_classdev *cdev)
601{
602 struct acpi_device *device = to_acpi_device(cdev->dev->parent);
603 int ret;
604
605 ret = call_fext_func(device, FUNC_LEDS, 0x2, LOGOLAMP_ALWAYS, 0x0);
606 if (ret == FUNC_LED_ON)
607 return LED_FULL;
608
609 ret = call_fext_func(device, FUNC_LEDS, 0x2, LOGOLAMP_POWERON, 0x0);
610 if (ret == FUNC_LED_ON)
611 return LED_HALF;
612
613 return LED_OFF;
614}
615
616static int kblamps_set(struct led_classdev *cdev,
617 enum led_brightness brightness)
618{
619 struct acpi_device *device = to_acpi_device(cdev->dev->parent);
620
621 if (brightness >= LED_FULL)
622 return call_fext_func(device, FUNC_LEDS, 0x1, KEYBOARD_LAMPS,
623 FUNC_LED_ON);
624 else
625 return call_fext_func(device, FUNC_LEDS, 0x1, KEYBOARD_LAMPS,
626 FUNC_LED_OFF);
627}
628
629static enum led_brightness kblamps_get(struct led_classdev *cdev)
630{
631 struct acpi_device *device = to_acpi_device(cdev->dev->parent);
632 enum led_brightness brightness = LED_OFF;
633
634 if (call_fext_func(device,
635 FUNC_LEDS, 0x2, KEYBOARD_LAMPS, 0x0) == FUNC_LED_ON)
636 brightness = LED_FULL;
637
638 return brightness;
639}
640
641static int radio_led_set(struct led_classdev *cdev,
642 enum led_brightness brightness)
643{
644 struct acpi_device *device = to_acpi_device(cdev->dev->parent);
645
646 if (brightness >= LED_FULL)
647 return call_fext_func(device, FUNC_FLAGS, 0x5, RADIO_LED_ON,
648 RADIO_LED_ON);
649 else
650 return call_fext_func(device, FUNC_FLAGS, 0x5, RADIO_LED_ON,
651 0x0);
652}
653
654static enum led_brightness radio_led_get(struct led_classdev *cdev)
655{
656 struct acpi_device *device = to_acpi_device(cdev->dev->parent);
657 enum led_brightness brightness = LED_OFF;
658
659 if (call_fext_func(device, FUNC_FLAGS, 0x4, 0x0, 0x0) & RADIO_LED_ON)
660 brightness = LED_FULL;
661
662 return brightness;
663}
664
665static int eco_led_set(struct led_classdev *cdev,
666 enum led_brightness brightness)
667{
668 struct acpi_device *device = to_acpi_device(cdev->dev->parent);
669 int curr;
670
671 curr = call_fext_func(device, FUNC_LEDS, 0x2, ECO_LED, 0x0);
672 if (brightness >= LED_FULL)
673 return call_fext_func(device, FUNC_LEDS, 0x1, ECO_LED,
674 curr | ECO_LED_ON);
675 else
676 return call_fext_func(device, FUNC_LEDS, 0x1, ECO_LED,
677 curr & ~ECO_LED_ON);
678}
679
680static enum led_brightness eco_led_get(struct led_classdev *cdev)
681{
682 struct acpi_device *device = to_acpi_device(cdev->dev->parent);
683 enum led_brightness brightness = LED_OFF;
684
685 if (call_fext_func(device, FUNC_LEDS, 0x2, ECO_LED, 0x0) & ECO_LED_ON)
686 brightness = LED_FULL;
687
688 return brightness;
689}
690
691static int acpi_fujitsu_laptop_leds_register(struct acpi_device *device)
692{
693 struct fujitsu_laptop *priv = acpi_driver_data(device);
694 struct led_classdev *led;
695 int ret;
696
697 if (call_fext_func(device,
698 FUNC_LEDS, 0x0, 0x0, 0x0) & LOGOLAMP_POWERON) {
699 led = devm_kzalloc(&device->dev, sizeof(*led), GFP_KERNEL);
700 if (!led)
701 return -ENOMEM;
702
703 led->name = "fujitsu::logolamp";
704 led->brightness_set_blocking = logolamp_set;
705 led->brightness_get = logolamp_get;
706 ret = devm_led_classdev_register(&device->dev, led);
707 if (ret)
708 return ret;
709 }
710
711 if ((call_fext_func(device,
712 FUNC_LEDS, 0x0, 0x0, 0x0) & KEYBOARD_LAMPS) &&
713 (call_fext_func(device, FUNC_BUTTONS, 0x0, 0x0, 0x0) == 0x0)) {
714 led = devm_kzalloc(&device->dev, sizeof(*led), GFP_KERNEL);
715 if (!led)
716 return -ENOMEM;
717
718 led->name = "fujitsu::kblamps";
719 led->brightness_set_blocking = kblamps_set;
720 led->brightness_get = kblamps_get;
721 ret = devm_led_classdev_register(&device->dev, led);
722 if (ret)
723 return ret;
724 }
725
726 /*
727 * Some Fujitsu laptops have a radio toggle button in place of a slide
728 * switch and all such machines appear to also have an RF LED. Based on
729 * comparing DSDT tables of four Fujitsu Lifebook models (E744, E751,
730 * S7110, S8420; the first one has a radio toggle button, the other
731 * three have slide switches), bit 17 of flags_supported (the value
732 * returned by method S000 of ACPI device FUJ02E3) seems to indicate
733 * whether given model has a radio toggle button.
734 */
735 if (priv->flags_supported & BIT(17)) {
736 led = devm_kzalloc(&device->dev, sizeof(*led), GFP_KERNEL);
737 if (!led)
738 return -ENOMEM;
739
740 led->name = "fujitsu::radio_led";
741 led->brightness_set_blocking = radio_led_set;
742 led->brightness_get = radio_led_get;
743 led->default_trigger = "rfkill-any";
744 ret = devm_led_classdev_register(&device->dev, led);
745 if (ret)
746 return ret;
747 }
748
749 /* Support for eco led is not always signaled in bit corresponding
750 * to the bit used to control the led. According to the DSDT table,
751 * bit 14 seems to indicate presence of said led as well.
752 * Confirm by testing the status.
753 */
754 if ((call_fext_func(device, FUNC_LEDS, 0x0, 0x0, 0x0) & BIT(14)) &&
755 (call_fext_func(device,
756 FUNC_LEDS, 0x2, ECO_LED, 0x0) != UNSUPPORTED_CMD)) {
757 led = devm_kzalloc(&device->dev, sizeof(*led), GFP_KERNEL);
758 if (!led)
759 return -ENOMEM;
760
761 led->name = "fujitsu::eco_led";
762 led->brightness_set_blocking = eco_led_set;
763 led->brightness_get = eco_led_get;
764 ret = devm_led_classdev_register(&device->dev, led);
765 if (ret)
766 return ret;
767 }
768
769 return 0;
770}
771
772static int acpi_fujitsu_laptop_add(struct acpi_device *device)
773{
774 struct fujitsu_laptop *priv;
775 int ret, i = 0;
776
777 priv = devm_kzalloc(&device->dev, sizeof(*priv), GFP_KERNEL);
778 if (!priv)
779 return -ENOMEM;
780
781 WARN_ONCE(fext, "More than one FUJ02E3 ACPI device was found. Driver may not work as intended.");
782 fext = device;
783
784 strcpy(acpi_device_name(device), ACPI_FUJITSU_LAPTOP_DEVICE_NAME);
785 strcpy(acpi_device_class(device), ACPI_FUJITSU_CLASS);
786 device->driver_data = priv;
787
788 /* kfifo */
789 spin_lock_init(&priv->fifo_lock);
790 ret = kfifo_alloc(&priv->fifo, RINGBUFFERSIZE * sizeof(int),
791 GFP_KERNEL);
792 if (ret)
793 return ret;
794
795 pr_info("ACPI: %s [%s]\n",
796 acpi_device_name(device), acpi_device_bid(device));
797
798 while (call_fext_func(device, FUNC_BUTTONS, 0x1, 0x0, 0x0) != 0 &&
799 i++ < MAX_HOTKEY_RINGBUFFER_SIZE)
800 ; /* No action, result is discarded */
801 acpi_handle_debug(device->handle, "Discarded %i ringbuffer entries\n",
802 i);
803
804 priv->flags_supported = call_fext_func(device, FUNC_FLAGS, 0x0, 0x0,
805 0x0);
806
807 /* Make sure our bitmask of supported functions is cleared if the
808 RFKILL function block is not implemented, like on the S7020. */
809 if (priv->flags_supported == UNSUPPORTED_CMD)
810 priv->flags_supported = 0;
811
812 if (priv->flags_supported)
813 priv->flags_state = call_fext_func(device, FUNC_FLAGS, 0x4, 0x0,
814 0x0);
815
816 /* Suspect this is a keymap of the application panel, print it */
817 acpi_handle_info(device->handle, "BTNI: [0x%x]\n",
818 call_fext_func(device, FUNC_BUTTONS, 0x0, 0x0, 0x0));
819
820 /* Sync backlight power status */
821 if (fujitsu_bl && fujitsu_bl->bl_device &&
822 acpi_video_get_backlight_type() == acpi_backlight_vendor) {
823 if (call_fext_func(fext, FUNC_BACKLIGHT, 0x2,
824 BACKLIGHT_PARAM_POWER, 0x0) == BACKLIGHT_OFF)
825 fujitsu_bl->bl_device->props.power = FB_BLANK_POWERDOWN;
826 else
827 fujitsu_bl->bl_device->props.power = FB_BLANK_UNBLANK;
828 }
829
830 ret = acpi_fujitsu_laptop_input_setup(device);
831 if (ret)
832 goto err_free_fifo;
833
834 ret = acpi_fujitsu_laptop_leds_register(device);
835 if (ret)
836 goto err_free_fifo;
837
838 ret = fujitsu_laptop_platform_add(device);
839 if (ret)
840 goto err_free_fifo;
841
842 return 0;
843
844err_free_fifo:
845 kfifo_free(&priv->fifo);
846
847 return ret;
848}
849
850static void acpi_fujitsu_laptop_remove(struct acpi_device *device)
851{
852 struct fujitsu_laptop *priv = acpi_driver_data(device);
853
854 fujitsu_laptop_platform_remove(device);
855
856 kfifo_free(&priv->fifo);
857}
858
859static void acpi_fujitsu_laptop_press(struct acpi_device *device, int scancode)
860{
861 struct fujitsu_laptop *priv = acpi_driver_data(device);
862 int ret;
863
864 ret = kfifo_in_locked(&priv->fifo, (unsigned char *)&scancode,
865 sizeof(scancode), &priv->fifo_lock);
866 if (ret != sizeof(scancode)) {
867 dev_info(&priv->input->dev, "Could not push scancode [0x%x]\n",
868 scancode);
869 return;
870 }
871 sparse_keymap_report_event(priv->input, scancode, 1, false);
872 dev_dbg(&priv->input->dev, "Push scancode into ringbuffer [0x%x]\n",
873 scancode);
874}
875
876static void acpi_fujitsu_laptop_release(struct acpi_device *device)
877{
878 struct fujitsu_laptop *priv = acpi_driver_data(device);
879 int scancode, ret;
880
881 while (true) {
882 ret = kfifo_out_locked(&priv->fifo, (unsigned char *)&scancode,
883 sizeof(scancode), &priv->fifo_lock);
884 if (ret != sizeof(scancode))
885 return;
886 sparse_keymap_report_event(priv->input, scancode, 0, false);
887 dev_dbg(&priv->input->dev,
888 "Pop scancode from ringbuffer [0x%x]\n", scancode);
889 }
890}
891
892static void acpi_fujitsu_laptop_notify(struct acpi_device *device, u32 event)
893{
894 struct fujitsu_laptop *priv = acpi_driver_data(device);
895 unsigned long flags;
896 int scancode, i = 0;
897 unsigned int irb;
898
899 if (event != ACPI_FUJITSU_NOTIFY_CODE) {
900 acpi_handle_info(device->handle, "Unsupported event [0x%x]\n",
901 event);
902 sparse_keymap_report_event(priv->input, -1, 1, true);
903 return;
904 }
905
906 if (priv->flags_supported)
907 priv->flags_state = call_fext_func(device, FUNC_FLAGS, 0x4, 0x0,
908 0x0);
909
910 while ((irb = call_fext_func(device,
911 FUNC_BUTTONS, 0x1, 0x0, 0x0)) != 0 &&
912 i++ < MAX_HOTKEY_RINGBUFFER_SIZE) {
913 scancode = irb & 0x4ff;
914 if (sparse_keymap_entry_from_scancode(priv->input, scancode))
915 acpi_fujitsu_laptop_press(device, scancode);
916 else if (scancode == 0)
917 acpi_fujitsu_laptop_release(device);
918 else
919 acpi_handle_info(device->handle,
920 "Unknown GIRB result [%x]\n", irb);
921 }
922
923 /*
924 * First seen on the Skylake-based Lifebook E736/E746/E756), the
925 * touchpad toggle hotkey (Fn+F4) is handled in software. Other models
926 * have since added additional "soft keys". These are reported in the
927 * status flags queried using FUNC_FLAGS.
928 */
929 if (priv->flags_supported & (FLAG_SOFTKEYS)) {
930 flags = call_fext_func(device, FUNC_FLAGS, 0x1, 0x0, 0x0);
931 flags &= (FLAG_SOFTKEYS);
932 for_each_set_bit(i, &flags, BITS_PER_LONG)
933 sparse_keymap_report_event(priv->input, BIT(i), 1, true);
934 }
935}
936
937/* Initialization */
938
939static const struct acpi_device_id fujitsu_bl_device_ids[] = {
940 {ACPI_FUJITSU_BL_HID, 0},
941 {"", 0},
942};
943
944static struct acpi_driver acpi_fujitsu_bl_driver = {
945 .name = ACPI_FUJITSU_BL_DRIVER_NAME,
946 .class = ACPI_FUJITSU_CLASS,
947 .ids = fujitsu_bl_device_ids,
948 .ops = {
949 .add = acpi_fujitsu_bl_add,
950 .notify = acpi_fujitsu_bl_notify,
951 },
952};
953
954static const struct acpi_device_id fujitsu_laptop_device_ids[] = {
955 {ACPI_FUJITSU_LAPTOP_HID, 0},
956 {"", 0},
957};
958
959static struct acpi_driver acpi_fujitsu_laptop_driver = {
960 .name = ACPI_FUJITSU_LAPTOP_DRIVER_NAME,
961 .class = ACPI_FUJITSU_CLASS,
962 .ids = fujitsu_laptop_device_ids,
963 .ops = {
964 .add = acpi_fujitsu_laptop_add,
965 .remove = acpi_fujitsu_laptop_remove,
966 .notify = acpi_fujitsu_laptop_notify,
967 },
968};
969
970static const struct acpi_device_id fujitsu_ids[] __used = {
971 {ACPI_FUJITSU_BL_HID, 0},
972 {ACPI_FUJITSU_LAPTOP_HID, 0},
973 {"", 0}
974};
975MODULE_DEVICE_TABLE(acpi, fujitsu_ids);
976
977static int __init fujitsu_init(void)
978{
979 int ret;
980
981 ret = acpi_bus_register_driver(&acpi_fujitsu_bl_driver);
982 if (ret)
983 return ret;
984
985 /* Register platform stuff */
986
987 ret = platform_driver_register(&fujitsu_pf_driver);
988 if (ret)
989 goto err_unregister_acpi;
990
991 /* Register laptop driver */
992
993 ret = acpi_bus_register_driver(&acpi_fujitsu_laptop_driver);
994 if (ret)
995 goto err_unregister_platform_driver;
996
997 pr_info("driver " FUJITSU_DRIVER_VERSION " successfully loaded\n");
998
999 return 0;
1000
1001err_unregister_platform_driver:
1002 platform_driver_unregister(&fujitsu_pf_driver);
1003err_unregister_acpi:
1004 acpi_bus_unregister_driver(&acpi_fujitsu_bl_driver);
1005
1006 return ret;
1007}
1008
1009static void __exit fujitsu_cleanup(void)
1010{
1011 acpi_bus_unregister_driver(&acpi_fujitsu_laptop_driver);
1012
1013 platform_driver_unregister(&fujitsu_pf_driver);
1014
1015 acpi_bus_unregister_driver(&acpi_fujitsu_bl_driver);
1016
1017 pr_info("driver unloaded\n");
1018}
1019
1020module_init(fujitsu_init);
1021module_exit(fujitsu_cleanup);
1022
1023module_param(use_alt_lcd_levels, int, 0644);
1024MODULE_PARM_DESC(use_alt_lcd_levels, "Interface used for setting LCD brightness level (-1 = auto, 0 = force SBLL, 1 = force SBL2)");
1025module_param(disable_brightness_adjust, bool, 0644);
1026MODULE_PARM_DESC(disable_brightness_adjust, "Disable LCD brightness adjustment");
1027
1028MODULE_AUTHOR("Jonathan Woithe, Peter Gruber, Tony Vroon");
1029MODULE_DESCRIPTION("Fujitsu laptop extras support");
1030MODULE_VERSION(FUJITSU_DRIVER_VERSION);
1031MODULE_LICENSE("GPL");
1/*-*-linux-c-*-*/
2
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>
10
11 Templated from msi-laptop.c and thinkpad_acpi.c which is copyright
12 by its respective authors.
13
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.
18
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.
23
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.
28 */
29
30/*
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.
34 *
35 * This driver exports a few files in /sys/devices/platform/fujitsu-laptop/;
36 * others may be added at a later date.
37 *
38 * lcd_level - Screen brightness: contains a single integer in the
39 * range 0..7. (rw)
40 *
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/.
44 *
45 * Hotkeys present on certain Fujitsu laptops (eg: the S6xxx series) are
46 * also supported by this driver.
47 *
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.
51 *
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.
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/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
74
75#define FUJITSU_DRIVER_VERSION "0.6.0"
76
77#define FUJITSU_LCD_N_LEVELS 8
78
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"
86
87#define ACPI_FUJITSU_NOTIFY_CODE1 0x80
88
89#define ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS 0x86
90#define ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS 0x87
91
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
97
98/* FUNC interface - responses */
99#define UNSUPPORTED_CMD 0x80000000
100
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
109
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
115
116#define MAX_HOTKEY_RINGBUFFER_SIZE 100
117#define RINGBUFFERSIZE 40
118
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
125
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
131
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
142
143/* Device controlling the backlight and associated keys */
144struct 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;
152
153 unsigned int max_brightness;
154 unsigned int brightness_changed;
155 unsigned int brightness_level;
156};
157
158static struct fujitsu_t *fujitsu;
159static int use_alt_lcd_levels = -1;
160static int disable_brightness_adjust = -1;
161
162/* Device used to access other hotkeys on the laptop */
163struct 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;
175};
176
177static struct fujitsu_hotkey_t *fujitsu_hotkey;
178
179static void acpi_fujitsu_hotkey_notify(struct acpi_device *device, u32 event);
180
181#if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
182static enum led_brightness logolamp_get(struct led_classdev *cdev);
183static void logolamp_set(struct led_classdev *cdev,
184 enum led_brightness brightness);
185
186static struct led_classdev logolamp_led = {
187 .name = "fujitsu::logolamp",
188 .brightness_get = logolamp_get,
189 .brightness_set = logolamp_set
190};
191
192static enum led_brightness kblamps_get(struct led_classdev *cdev);
193static void kblamps_set(struct led_classdev *cdev,
194 enum led_brightness brightness);
195
196static struct led_classdev kblamps_led = {
197 .name = "fujitsu::kblamps",
198 .brightness_get = kblamps_get,
199 .brightness_set = kblamps_set
200};
201#endif
202
203#ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
204static u32 dbg_level = 0x03;
205#endif
206
207static void acpi_fujitsu_notify(struct acpi_device *device, u32 event);
208
209/* Fujitsu ACPI interface function */
210
211static int call_fext_func(int cmd, int arg0, int arg1, int arg2)
212{
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 }
219 };
220 struct acpi_object_list arg_list = { 4, ¶ms[0] };
221 unsigned long long value;
222 acpi_handle handle = NULL;
223
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;
229 }
230
231 params[0].integer.value = cmd;
232 params[1].integer.value = arg0;
233 params[2].integer.value = arg1;
234 params[3].integer.value = arg2;
235
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;
242 }
243
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;
248}
249
250#if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
251/* LED class callbacks */
252
253static void logolamp_set(struct led_classdev *cdev,
254 enum led_brightness brightness)
255{
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);
264 }
265}
266
267static void kblamps_set(struct led_classdev *cdev,
268 enum led_brightness brightness)
269{
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);
274}
275
276static enum led_brightness logolamp_get(struct led_classdev *cdev)
277{
278 enum led_brightness brightness = LED_OFF;
279 int poweron, always;
280
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;
287 }
288 return brightness;
289}
290
291static enum led_brightness kblamps_get(struct led_classdev *cdev)
292{
293 enum led_brightness brightness = LED_OFF;
294
295 if (call_fext_func(FUNC_LEDS, 0x2, KEYBOARD_LAMPS, 0x0) == FUNC_LED_ON)
296 brightness = LED_FULL;
297
298 return brightness;
299}
300#endif
301
302/* Hardware access for LCD brightness control */
303
304static int set_lcd_level(int level)
305{
306 acpi_status status = AE_OK;
307 acpi_handle handle = NULL;
308
309 vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBLL [%d]\n",
310 level);
311
312 if (level < 0 || level >= fujitsu->max_brightness)
313 return -EINVAL;
314
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;
319 }
320
321
322 status = acpi_execute_simple_method(handle, NULL, level);
323 if (ACPI_FAILURE(status))
324 return -ENODEV;
325
326 return 0;
327}
328
329static int set_lcd_level_alt(int level)
330{
331 acpi_status status = AE_OK;
332 acpi_handle handle = NULL;
333
334 vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBL2 [%d]\n",
335 level);
336
337 if (level < 0 || level >= fujitsu->max_brightness)
338 return -EINVAL;
339
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;
344 }
345
346 status = acpi_execute_simple_method(handle, NULL, level);
347 if (ACPI_FAILURE(status))
348 return -ENODEV;
349
350 return 0;
351}
352
353static int get_lcd_level(void)
354{
355 unsigned long long state = 0;
356 acpi_status status = AE_OK;
357
358 vdbg_printk(FUJLAPTOP_DBG_TRACE, "get lcd level via GBLL\n");
359
360 status =
361 acpi_evaluate_integer(fujitsu->acpi_handle, "GBLL", NULL, &state);
362 if (ACPI_FAILURE(status))
363 return 0;
364
365 fujitsu->brightness_level = state & 0x0fffffff;
366
367 if (state & 0x80000000)
368 fujitsu->brightness_changed = 1;
369 else
370 fujitsu->brightness_changed = 0;
371
372 return fujitsu->brightness_level;
373}
374
375static int get_max_brightness(void)
376{
377 unsigned long long state = 0;
378 acpi_status status = AE_OK;
379
380 vdbg_printk(FUJLAPTOP_DBG_TRACE, "get max lcd level via RBLL\n");
381
382 status =
383 acpi_evaluate_integer(fujitsu->acpi_handle, "RBLL", NULL, &state);
384 if (ACPI_FAILURE(status))
385 return -1;
386
387 fujitsu->max_brightness = state;
388
389 return fujitsu->max_brightness;
390}
391
392/* Backlight device stuff */
393
394static int bl_get_brightness(struct backlight_device *b)
395{
396 return get_lcd_level();
397}
398
399static int bl_update_status(struct backlight_device *b)
400{
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);
410
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;
420}
421
422static const struct backlight_ops fujitsubl_ops = {
423 .get_brightness = bl_get_brightness,
424 .update_status = bl_update_status,
425};
426
427/* Platform LCD brightness device */
428
429static ssize_t
430show_max_brightness(struct device *dev,
431 struct device_attribute *attr, char *buf)
432{
433
434 int ret;
435
436 ret = get_max_brightness();
437 if (ret < 0)
438 return ret;
439
440 return sprintf(buf, "%i\n", ret);
441}
442
443static ssize_t
444show_brightness_changed(struct device *dev,
445 struct device_attribute *attr, char *buf)
446{
447
448 int ret;
449
450 ret = fujitsu->brightness_changed;
451 if (ret < 0)
452 return ret;
453
454 return sprintf(buf, "%i\n", ret);
455}
456
457static ssize_t show_lcd_level(struct device *dev,
458 struct device_attribute *attr, char *buf)
459{
460
461 int ret;
462
463 ret = get_lcd_level();
464 if (ret < 0)
465 return ret;
466
467 return sprintf(buf, "%i\n", ret);
468}
469
470static ssize_t store_lcd_level(struct device *dev,
471 struct device_attribute *attr, const char *buf,
472 size_t count)
473{
474
475 int level, ret;
476
477 if (sscanf(buf, "%i", &level) != 1
478 || (level < 0 || level >= fujitsu->max_brightness))
479 return -EINVAL;
480
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;
487
488 ret = get_lcd_level();
489 if (ret < 0)
490 return ret;
491
492 return count;
493}
494
495static ssize_t
496ignore_store(struct device *dev,
497 struct device_attribute *attr, const char *buf, size_t count)
498{
499 return count;
500}
501
502static ssize_t
503show_lid_state(struct device *dev,
504 struct device_attribute *attr, char *buf)
505{
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");
512}
513
514static ssize_t
515show_dock_state(struct device *dev,
516 struct device_attribute *attr, char *buf)
517{
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");
524}
525
526static ssize_t
527show_radios_state(struct device *dev,
528 struct device_attribute *attr, char *buf)
529{
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");
536}
537
538static DEVICE_ATTR(max_brightness, 0444, show_max_brightness, ignore_store);
539static DEVICE_ATTR(brightness_changed, 0444, show_brightness_changed,
540 ignore_store);
541static DEVICE_ATTR(lcd_level, 0644, show_lcd_level, store_lcd_level);
542static DEVICE_ATTR(lid, 0444, show_lid_state, ignore_store);
543static DEVICE_ATTR(dock, 0444, show_dock_state, ignore_store);
544static DEVICE_ATTR(radios, 0444, show_radios_state, ignore_store);
545
546static 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
554};
555
556static struct attribute_group fujitsupf_attribute_group = {
557 .attrs = fujitsupf_attributes
558};
559
560static struct platform_driver fujitsupf_driver = {
561 .driver = {
562 .name = "fujitsu-laptop",
563 .owner = THIS_MODULE,
564 }
565};
566
567static void dmi_check_cb_common(const struct dmi_system_id *id)
568{
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);
578 }
579}
580
581static int dmi_check_cb_s6410(const struct dmi_system_id *id)
582{
583 dmi_check_cb_common(id);
584 fujitsu->keycode1 = KEY_SCREENLOCK; /* "Lock" */
585 fujitsu->keycode2 = KEY_HELP; /* "Mobility Center" */
586 return 1;
587}
588
589static int dmi_check_cb_s6420(const struct dmi_system_id *id)
590{
591 dmi_check_cb_common(id);
592 fujitsu->keycode1 = KEY_SCREENLOCK; /* "Lock" */
593 fujitsu->keycode2 = KEY_HELP; /* "Mobility Center" */
594 return 1;
595}
596
597static int dmi_check_cb_p8010(const struct dmi_system_id *id)
598{
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;
604}
605
606static struct dmi_system_id fujitsu_dmi_table[] = {
607 {
608 .ident = "Fujitsu Siemens S6410",
609 .matches = {
610 DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
611 DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6410"),
612 },
613 .callback = dmi_check_cb_s6410},
614 {
615 .ident = "Fujitsu Siemens S6420",
616 .matches = {
617 DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
618 DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6420"),
619 },
620 .callback = dmi_check_cb_s6420},
621 {
622 .ident = "Fujitsu LifeBook P8010",
623 .matches = {
624 DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"),
625 DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook P8010"),
626 },
627 .callback = dmi_check_cb_p8010},
628 {}
629};
630
631/* ACPI device for LCD brightness control */
632
633static int acpi_fujitsu_add(struct acpi_device *device)
634{
635 int state = 0;
636 struct input_dev *input;
637 int error;
638
639 if (!device)
640 return -EINVAL;
641
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;
646
647 fujitsu->input = input = input_allocate_device();
648 if (!input) {
649 error = -ENOMEM;
650 goto err_stop;
651 }
652
653 snprintf(fujitsu->phys, sizeof(fujitsu->phys),
654 "%s/video/input0", acpi_device_hid(device));
655
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);
665
666 error = input_register_device(input);
667 if (error)
668 goto err_free_input_dev;
669
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;
674 }
675
676 pr_info("ACPI: %s [%s] (%s)\n",
677 acpi_device_name(device), acpi_device_bid(device),
678 !device->power.state ? "on" : "off");
679
680 fujitsu->dev = device;
681
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");
688 }
689
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);
696
697 if (get_max_brightness() <= 0)
698 fujitsu->max_brightness = FUJITSU_LCD_N_LEVELS;
699 get_lcd_level();
700
701 return 0;
702
703err_unregister_input_dev:
704 input_unregister_device(input);
705 input = NULL;
706err_free_input_dev:
707 input_free_device(input);
708err_stop:
709 return error;
710}
711
712static int acpi_fujitsu_remove(struct acpi_device *device)
713{
714 struct fujitsu_t *fujitsu = acpi_driver_data(device);
715 struct input_dev *input = fujitsu->input;
716
717 input_unregister_device(input);
718
719 fujitsu->acpi_handle = NULL;
720
721 return 0;
722}
723
724/* Brightness notify */
725
726static void acpi_fujitsu_notify(struct acpi_device *device, u32 event)
727{
728 struct input_dev *input;
729 int keycode;
730 int oldb, newb;
731
732 input = fujitsu->input;
733
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;
740
741 vdbg_printk(FUJLAPTOP_DBG_TRACE,
742 "brightness button event [%i -> %i (%i)]\n",
743 oldb, newb, fujitsu->brightness_changed);
744
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);
751 }
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);
759 }
760 keycode = KEY_BRIGHTNESSDOWN;
761 }
762 break;
763 default:
764 keycode = KEY_UNKNOWN;
765 vdbg_printk(FUJLAPTOP_DBG_WARN,
766 "unsupported event [0x%x]\n", event);
767 break;
768 }
769
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);
775 }
776}
777
778/* ACPI device for hotkey handling */
779
780static int acpi_fujitsu_hotkey_add(struct acpi_device *device)
781{
782 int result = 0;
783 int state = 0;
784 struct input_dev *input;
785 int error;
786 int i;
787
788 if (!device)
789 return -EINVAL;
790
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;
796
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;
804 }
805
806 fujitsu_hotkey->input = input = input_allocate_device();
807 if (!input) {
808 error = -ENOMEM;
809 goto err_free_fifo;
810 }
811
812 snprintf(fujitsu_hotkey->phys, sizeof(fujitsu_hotkey->phys),
813 "%s/video/input0", acpi_device_hid(device));
814
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;
820
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);
827
828 error = input_register_device(input);
829 if (error)
830 goto err_free_input_dev;
831
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;
836 }
837
838 pr_info("ACPI: %s [%s] (%s)\n",
839 acpi_device_name(device), acpi_device_bid(device),
840 !device->power.state ? "on" : "off");
841
842 fujitsu_hotkey->dev = device;
843
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");
850 }
851
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);
857
858 fujitsu_hotkey->rfkill_supported =
859 call_fext_func(FUNC_RFKILL, 0x0, 0x0, 0x0);
860
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;
865
866 if (fujitsu_hotkey->rfkill_supported)
867 fujitsu_hotkey->rfkill_state =
868 call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
869
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));
872
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);
882 }
883 }
884
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);
894 }
895 }
896#endif
897
898 return result;
899
900err_unregister_input_dev:
901 input_unregister_device(input);
902 input = NULL;
903err_free_input_dev:
904 input_free_device(input);
905err_free_fifo:
906 kfifo_free(&fujitsu_hotkey->fifo);
907err_stop:
908 return error;
909}
910
911static int acpi_fujitsu_hotkey_remove(struct acpi_device *device)
912{
913 struct fujitsu_hotkey_t *fujitsu_hotkey = acpi_driver_data(device);
914 struct input_dev *input = fujitsu_hotkey->input;
915
916#if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
917 if (fujitsu_hotkey->logolamp_registered)
918 led_classdev_unregister(&logolamp_led);
919
920 if (fujitsu_hotkey->kblamps_registered)
921 led_classdev_unregister(&kblamps_led);
922#endif
923
924 input_unregister_device(input);
925
926 kfifo_free(&fujitsu_hotkey->fifo);
927
928 fujitsu_hotkey->acpi_handle = NULL;
929
930 return 0;
931}
932
933static void acpi_fujitsu_hotkey_notify(struct acpi_device *device, u32 event)
934{
935 struct input_dev *input;
936 int keycode, keycode_r;
937 unsigned int irb = 1;
938 int i, status;
939
940 input = fujitsu_hotkey->input;
941
942 if (fujitsu_hotkey->rfkill_supported)
943 fujitsu_hotkey->rfkill_state =
944 call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
945
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;
973 }
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);
989 }
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);
1003 }
1004 }
1005 }
1006
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;
1017 }
1018}
1019
1020/* Initialization */
1021
1022static const struct acpi_device_id fujitsu_device_ids[] = {
1023 {ACPI_FUJITSU_HID, 0},
1024 {"", 0},
1025};
1026
1027static 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,
1035 },
1036};
1037
1038static const struct acpi_device_id fujitsu_hotkey_device_ids[] = {
1039 {ACPI_FUJITSU_HOTKEY_HID, 0},
1040 {"", 0},
1041};
1042
1043static 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,
1051 },
1052};
1053
1054static int __init fujitsu_init(void)
1055{
1056 int ret, result, max_brightness;
1057
1058 if (acpi_disabled)
1059 return -ENODEV;
1060
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);
1069
1070 result = acpi_bus_register_driver(&acpi_fujitsu_driver);
1071 if (result < 0) {
1072 ret = -ENODEV;
1073 goto fail_acpi;
1074 }
1075
1076 /* Register platform stuff */
1077
1078 fujitsu->pf_device = platform_device_alloc("fujitsu-laptop", -1);
1079 if (!fujitsu->pf_device) {
1080 ret = -ENOMEM;
1081 goto fail_platform_driver;
1082 }
1083
1084 ret = platform_device_add(fujitsu->pf_device);
1085 if (ret)
1086 goto fail_platform_device1;
1087
1088 ret =
1089 sysfs_create_group(&fujitsu->pf_device->dev.kobj,
1090 &fujitsupf_attribute_group);
1091 if (ret)
1092 goto fail_platform_device2;
1093
1094 /* Register backlight stuff */
1095
1096 if (!acpi_video_backlight_support()) {
1097 struct backlight_properties props;
1098
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;
1111 }
1112 fujitsu->bl_device->props.brightness = fujitsu->brightness_level;
1113 }
1114
1115 ret = platform_driver_register(&fujitsupf_driver);
1116 if (ret)
1117 goto fail_backlight;
1118
1119 /* Register hotkey driver */
1120
1121 fujitsu_hotkey = kzalloc(sizeof(struct fujitsu_hotkey_t), GFP_KERNEL);
1122 if (!fujitsu_hotkey) {
1123 ret = -ENOMEM;
1124 goto fail_hotkey;
1125 }
1126
1127 result = acpi_bus_register_driver(&acpi_fujitsu_hotkey_driver);
1128 if (result < 0) {
1129 ret = -ENODEV;
1130 goto fail_hotkey1;
1131 }
1132
1133 /* Sync backlight power status (needs FUJ02E3 device, hence deferred) */
1134
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;
1140 }
1141
1142 pr_info("driver " FUJITSU_DRIVER_VERSION " successfully loaded\n");
1143
1144 return 0;
1145
1146fail_hotkey1:
1147 kfree(fujitsu_hotkey);
1148fail_hotkey:
1149 platform_driver_unregister(&fujitsupf_driver);
1150fail_backlight:
1151 if (fujitsu->bl_device)
1152 backlight_device_unregister(fujitsu->bl_device);
1153fail_sysfs_group:
1154 sysfs_remove_group(&fujitsu->pf_device->dev.kobj,
1155 &fujitsupf_attribute_group);
1156fail_platform_device2:
1157 platform_device_del(fujitsu->pf_device);
1158fail_platform_device1:
1159 platform_device_put(fujitsu->pf_device);
1160fail_platform_driver:
1161 acpi_bus_unregister_driver(&acpi_fujitsu_driver);
1162fail_acpi:
1163 kfree(fujitsu);
1164
1165 return ret;
1166}
1167
1168static void __exit fujitsu_cleanup(void)
1169{
1170 acpi_bus_unregister_driver(&acpi_fujitsu_hotkey_driver);
1171
1172 kfree(fujitsu_hotkey);
1173
1174 platform_driver_unregister(&fujitsupf_driver);
1175
1176 if (fujitsu->bl_device)
1177 backlight_device_unregister(fujitsu->bl_device);
1178
1179 sysfs_remove_group(&fujitsu->pf_device->dev.kobj,
1180 &fujitsupf_attribute_group);
1181
1182 platform_device_unregister(fujitsu->pf_device);
1183
1184 acpi_bus_unregister_driver(&acpi_fujitsu_driver);
1185
1186 kfree(fujitsu);
1187
1188 pr_info("driver unloaded\n");
1189}
1190
1191module_init(fujitsu_init);
1192module_exit(fujitsu_cleanup);
1193
1194module_param(use_alt_lcd_levels, uint, 0644);
1195MODULE_PARM_DESC(use_alt_lcd_levels,
1196 "Use alternative interface for lcd_levels (needed for Lifebook s6410).");
1197module_param(disable_brightness_adjust, uint, 0644);
1198MODULE_PARM_DESC(disable_brightness_adjust, "Disable brightness adjustment .");
1199#ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
1200module_param_named(debug, dbg_level, uint, 0644);
1201MODULE_PARM_DESC(debug, "Sets debug level bit-mask");
1202#endif
1203
1204MODULE_AUTHOR("Jonathan Woithe, Peter Gruber, Tony Vroon");
1205MODULE_DESCRIPTION("Fujitsu laptop extras support");
1206MODULE_VERSION(FUJITSU_DRIVER_VERSION);
1207MODULE_LICENSE("GPL");
1208
1209MODULE_ALIAS("dmi:*:svnFUJITSUSIEMENS:*:pvr:rvnFUJITSU:rnFJNB1D3:*:cvrS6410:*");
1210MODULE_ALIAS("dmi:*:svnFUJITSUSIEMENS:*:pvr:rvnFUJITSU:rnFJNB1E6:*:cvrS6420:*");
1211MODULE_ALIAS("dmi:*:svnFUJITSU:*:pvr:rvnFUJITSU:rnFJNB19C:*:cvrS7020:*");
1212
1213static struct pnp_device_id pnp_ids[] __used = {
1214 {.id = "FUJ02bf"},
1215 {.id = "FUJ02B1"},
1216 {.id = "FUJ02E3"},
1217 {.id = ""}
1218};
1219
1220MODULE_DEVICE_TABLE(pnp, pnp_ids);