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