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