1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | /* |
3 | * Samsung Laptop driver |
4 | * |
5 | * Copyright (C) 2009,2011 Greg Kroah-Hartman (gregkh@suse.de) |
6 | * Copyright (C) 2009,2011 Novell Inc. |
7 | */ |
8 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
9 | |
10 | #include <linux/kernel.h> |
11 | #include <linux/init.h> |
12 | #include <linux/module.h> |
13 | #include <linux/delay.h> |
14 | #include <linux/pci.h> |
15 | #include <linux/backlight.h> |
16 | #include <linux/leds.h> |
17 | #include <linux/fb.h> |
18 | #include <linux/dmi.h> |
19 | #include <linux/platform_device.h> |
20 | #include <linux/rfkill.h> |
21 | #include <linux/acpi.h> |
22 | #include <linux/seq_file.h> |
23 | #include <linux/debugfs.h> |
24 | #include <linux/ctype.h> |
25 | #include <linux/efi.h> |
26 | #include <linux/suspend.h> |
27 | #include <acpi/video.h> |
28 | |
29 | /* |
30 | * This driver is needed because a number of Samsung laptops do not hook |
31 | * their control settings through ACPI. So we have to poke around in the |
32 | * BIOS to do things like brightness values, and "special" key controls. |
33 | */ |
34 | |
35 | /* |
36 | * We have 0 - 8 as valid brightness levels. The specs say that level 0 should |
37 | * be reserved by the BIOS (which really doesn't make much sense), we tell |
38 | * userspace that the value is 0 - 7 and then just tell the hardware 1 - 8 |
39 | */ |
40 | #define MAX_BRIGHT 0x07 |
41 | |
42 | |
43 | #define SABI_IFACE_MAIN 0x00 |
44 | #define SABI_IFACE_SUB 0x02 |
45 | #define SABI_IFACE_COMPLETE 0x04 |
46 | #define SABI_IFACE_DATA 0x05 |
47 | |
48 | #define WL_STATUS_WLAN 0x0 |
49 | #define WL_STATUS_BT 0x2 |
50 | |
51 | /* Structure get/set data using sabi */ |
52 | struct sabi_data { |
53 | union { |
54 | struct { |
55 | u32 d0; |
56 | u32 d1; |
57 | u16 d2; |
58 | u8 d3; |
59 | }; |
60 | u8 data[11]; |
61 | }; |
62 | }; |
63 | |
64 | struct { |
65 | u8 ; |
66 | u8 ; |
67 | u8 ; |
68 | u8 ; |
69 | u8 ; |
70 | u8 ; |
71 | }; |
72 | |
73 | struct sabi_commands { |
74 | /* |
75 | * Brightness is 0 - 8, as described above. |
76 | * Value 0 is for the BIOS to use |
77 | */ |
78 | u16 get_brightness; |
79 | u16 set_brightness; |
80 | |
81 | /* |
82 | * first byte: |
83 | * 0x00 - wireless is off |
84 | * 0x01 - wireless is on |
85 | * second byte: |
86 | * 0x02 - 3G is off |
87 | * 0x03 - 3G is on |
88 | * TODO, verify 3G is correct, that doesn't seem right... |
89 | */ |
90 | u16 get_wireless_button; |
91 | u16 set_wireless_button; |
92 | |
93 | /* 0 is off, 1 is on */ |
94 | u16 get_backlight; |
95 | u16 set_backlight; |
96 | |
97 | /* |
98 | * 0x80 or 0x00 - no action |
99 | * 0x81 - recovery key pressed |
100 | */ |
101 | u16 get_recovery_mode; |
102 | u16 set_recovery_mode; |
103 | |
104 | /* |
105 | * on seclinux: 0 is low, 1 is high, |
106 | * on swsmi: 0 is normal, 1 is silent, 2 is turbo |
107 | */ |
108 | u16 get_performance_level; |
109 | u16 set_performance_level; |
110 | |
111 | /* 0x80 is off, 0x81 is on */ |
112 | u16 get_battery_life_extender; |
113 | u16 set_battery_life_extender; |
114 | |
115 | /* 0x80 is off, 0x81 is on */ |
116 | u16 get_usb_charge; |
117 | u16 set_usb_charge; |
118 | |
119 | /* the first byte is for bluetooth and the third one is for wlan */ |
120 | u16 get_wireless_status; |
121 | u16 set_wireless_status; |
122 | |
123 | /* 0x80 is off, 0x81 is on */ |
124 | u16 get_lid_handling; |
125 | u16 set_lid_handling; |
126 | |
127 | /* 0x81 to read, (0x82 | level << 8) to set, 0xaabb to enable */ |
128 | u16 kbd_backlight; |
129 | |
130 | /* |
131 | * Tell the BIOS that Linux is running on this machine. |
132 | * 81 is on, 80 is off |
133 | */ |
134 | u16 set_linux; |
135 | }; |
136 | |
137 | struct sabi_performance_level { |
138 | const char *name; |
139 | u16 value; |
140 | }; |
141 | |
142 | struct sabi_config { |
143 | int sabi_version; |
144 | const char *test_string; |
145 | u16 main_function; |
146 | const struct sabi_header_offsets ; |
147 | const struct sabi_commands commands; |
148 | const struct sabi_performance_level performance_levels[4]; |
149 | u8 min_brightness; |
150 | u8 max_brightness; |
151 | }; |
152 | |
153 | static const struct sabi_config sabi_configs[] = { |
154 | { |
155 | /* I don't know if it is really 2, but it is |
156 | * less than 3 anyway */ |
157 | .sabi_version = 2, |
158 | |
159 | .test_string = "SECLINUX" , |
160 | |
161 | .main_function = 0x4c49, |
162 | |
163 | .header_offsets = { |
164 | .port = 0x00, |
165 | .re_mem = 0x02, |
166 | .iface_func = 0x03, |
167 | .en_mem = 0x04, |
168 | .data_offset = 0x05, |
169 | .data_segment = 0x07, |
170 | }, |
171 | |
172 | .commands = { |
173 | .get_brightness = 0x00, |
174 | .set_brightness = 0x01, |
175 | |
176 | .get_wireless_button = 0x02, |
177 | .set_wireless_button = 0x03, |
178 | |
179 | .get_backlight = 0x04, |
180 | .set_backlight = 0x05, |
181 | |
182 | .get_recovery_mode = 0x06, |
183 | .set_recovery_mode = 0x07, |
184 | |
185 | .get_performance_level = 0x08, |
186 | .set_performance_level = 0x09, |
187 | |
188 | .get_battery_life_extender = 0xFFFF, |
189 | .set_battery_life_extender = 0xFFFF, |
190 | |
191 | .get_usb_charge = 0xFFFF, |
192 | .set_usb_charge = 0xFFFF, |
193 | |
194 | .get_wireless_status = 0xFFFF, |
195 | .set_wireless_status = 0xFFFF, |
196 | |
197 | .get_lid_handling = 0xFFFF, |
198 | .set_lid_handling = 0xFFFF, |
199 | |
200 | .kbd_backlight = 0xFFFF, |
201 | |
202 | .set_linux = 0x0a, |
203 | }, |
204 | |
205 | .performance_levels = { |
206 | { |
207 | .name = "silent" , |
208 | .value = 0, |
209 | }, |
210 | { |
211 | .name = "normal" , |
212 | .value = 1, |
213 | }, |
214 | { }, |
215 | }, |
216 | .min_brightness = 1, |
217 | .max_brightness = 8, |
218 | }, |
219 | { |
220 | .sabi_version = 3, |
221 | |
222 | .test_string = "SwSmi@" , |
223 | |
224 | .main_function = 0x5843, |
225 | |
226 | .header_offsets = { |
227 | .port = 0x00, |
228 | .re_mem = 0x04, |
229 | .iface_func = 0x02, |
230 | .en_mem = 0x03, |
231 | .data_offset = 0x05, |
232 | .data_segment = 0x07, |
233 | }, |
234 | |
235 | .commands = { |
236 | .get_brightness = 0x10, |
237 | .set_brightness = 0x11, |
238 | |
239 | .get_wireless_button = 0x12, |
240 | .set_wireless_button = 0x13, |
241 | |
242 | .get_backlight = 0x2d, |
243 | .set_backlight = 0x2e, |
244 | |
245 | .get_recovery_mode = 0xff, |
246 | .set_recovery_mode = 0xff, |
247 | |
248 | .get_performance_level = 0x31, |
249 | .set_performance_level = 0x32, |
250 | |
251 | .get_battery_life_extender = 0x65, |
252 | .set_battery_life_extender = 0x66, |
253 | |
254 | .get_usb_charge = 0x67, |
255 | .set_usb_charge = 0x68, |
256 | |
257 | .get_wireless_status = 0x69, |
258 | .set_wireless_status = 0x6a, |
259 | |
260 | .get_lid_handling = 0x6d, |
261 | .set_lid_handling = 0x6e, |
262 | |
263 | .kbd_backlight = 0x78, |
264 | |
265 | .set_linux = 0xff, |
266 | }, |
267 | |
268 | .performance_levels = { |
269 | { |
270 | .name = "normal" , |
271 | .value = 0, |
272 | }, |
273 | { |
274 | .name = "silent" , |
275 | .value = 1, |
276 | }, |
277 | { |
278 | .name = "overclock" , |
279 | .value = 2, |
280 | }, |
281 | { }, |
282 | }, |
283 | .min_brightness = 0, |
284 | .max_brightness = 8, |
285 | }, |
286 | { }, |
287 | }; |
288 | |
289 | /* |
290 | * samsung-laptop/ - debugfs root directory |
291 | * f0000_segment - dump f0000 segment |
292 | * command - current command |
293 | * data - current data |
294 | * d0, d1, d2, d3 - data fields |
295 | * call - call SABI using command and data |
296 | * |
297 | * This allow to call arbitrary sabi commands wihout |
298 | * modifying the driver at all. |
299 | * For example, setting the keyboard backlight brightness to 5 |
300 | * |
301 | * echo 0x78 > command |
302 | * echo 0x0582 > d0 |
303 | * echo 0 > d1 |
304 | * echo 0 > d2 |
305 | * echo 0 > d3 |
306 | * cat call |
307 | */ |
308 | |
309 | struct samsung_laptop_debug { |
310 | struct dentry *root; |
311 | struct sabi_data data; |
312 | u16 command; |
313 | |
314 | struct debugfs_blob_wrapper f0000_wrapper; |
315 | struct debugfs_blob_wrapper data_wrapper; |
316 | struct debugfs_blob_wrapper sdiag_wrapper; |
317 | }; |
318 | |
319 | struct samsung_laptop; |
320 | |
321 | struct samsung_rfkill { |
322 | struct samsung_laptop *samsung; |
323 | struct rfkill *rfkill; |
324 | enum rfkill_type type; |
325 | }; |
326 | |
327 | struct samsung_laptop { |
328 | const struct sabi_config *config; |
329 | |
330 | void __iomem *sabi; |
331 | void __iomem *sabi_iface; |
332 | void __iomem *f0000_segment; |
333 | |
334 | struct mutex sabi_mutex; |
335 | |
336 | struct platform_device *platform_device; |
337 | struct backlight_device *backlight_device; |
338 | |
339 | struct samsung_rfkill wlan; |
340 | struct samsung_rfkill bluetooth; |
341 | |
342 | struct led_classdev kbd_led; |
343 | int kbd_led_wk; |
344 | struct workqueue_struct *led_workqueue; |
345 | struct work_struct kbd_led_work; |
346 | |
347 | struct samsung_laptop_debug debug; |
348 | struct samsung_quirks *quirks; |
349 | |
350 | struct notifier_block pm_nb; |
351 | |
352 | bool handle_backlight; |
353 | bool has_stepping_quirk; |
354 | |
355 | char sdiag[64]; |
356 | }; |
357 | |
358 | struct samsung_quirks { |
359 | bool four_kbd_backlight_levels; |
360 | bool enable_kbd_backlight; |
361 | bool lid_handling; |
362 | }; |
363 | |
364 | static struct samsung_quirks samsung_unknown = {}; |
365 | |
366 | static struct samsung_quirks samsung_np740u3e = { |
367 | .four_kbd_backlight_levels = true, |
368 | .enable_kbd_backlight = true, |
369 | }; |
370 | |
371 | static struct samsung_quirks samsung_lid_handling = { |
372 | .lid_handling = true, |
373 | }; |
374 | |
375 | static bool force; |
376 | module_param(force, bool, 0); |
377 | MODULE_PARM_DESC(force, |
378 | "Disable the DMI check and forces the driver to be loaded" ); |
379 | |
380 | static bool debug; |
381 | module_param(debug, bool, 0644); |
382 | MODULE_PARM_DESC(debug, "Debug enabled or not" ); |
383 | |
384 | static int sabi_command(struct samsung_laptop *samsung, u16 command, |
385 | struct sabi_data *in, |
386 | struct sabi_data *out) |
387 | { |
388 | const struct sabi_config *config = samsung->config; |
389 | int ret = 0; |
390 | u16 port = readw(addr: samsung->sabi + config->header_offsets.port); |
391 | u8 complete, iface_data; |
392 | |
393 | mutex_lock(&samsung->sabi_mutex); |
394 | |
395 | if (debug) { |
396 | if (in) |
397 | pr_info("SABI command:0x%04x " |
398 | "data:{0x%08x, 0x%08x, 0x%04x, 0x%02x}" , |
399 | command, in->d0, in->d1, in->d2, in->d3); |
400 | else |
401 | pr_info("SABI command:0x%04x" , command); |
402 | } |
403 | |
404 | /* enable memory to be able to write to it */ |
405 | outb(readb(addr: samsung->sabi + config->header_offsets.en_mem), port); |
406 | |
407 | /* write out the command */ |
408 | writew(val: config->main_function, addr: samsung->sabi_iface + SABI_IFACE_MAIN); |
409 | writew(val: command, addr: samsung->sabi_iface + SABI_IFACE_SUB); |
410 | writeb(val: 0, addr: samsung->sabi_iface + SABI_IFACE_COMPLETE); |
411 | if (in) { |
412 | writel(val: in->d0, addr: samsung->sabi_iface + SABI_IFACE_DATA); |
413 | writel(val: in->d1, addr: samsung->sabi_iface + SABI_IFACE_DATA + 4); |
414 | writew(val: in->d2, addr: samsung->sabi_iface + SABI_IFACE_DATA + 8); |
415 | writeb(val: in->d3, addr: samsung->sabi_iface + SABI_IFACE_DATA + 10); |
416 | } |
417 | outb(readb(addr: samsung->sabi + config->header_offsets.iface_func), port); |
418 | |
419 | /* write protect memory to make it safe */ |
420 | outb(readb(addr: samsung->sabi + config->header_offsets.re_mem), port); |
421 | |
422 | /* see if the command actually succeeded */ |
423 | complete = readb(addr: samsung->sabi_iface + SABI_IFACE_COMPLETE); |
424 | iface_data = readb(addr: samsung->sabi_iface + SABI_IFACE_DATA); |
425 | |
426 | /* iface_data = 0xFF happens when a command is not known |
427 | * so we only add a warning in debug mode since we will |
428 | * probably issue some unknown command at startup to find |
429 | * out which features are supported */ |
430 | if (complete != 0xaa || (iface_data == 0xff && debug)) |
431 | pr_warn("SABI command 0x%04x failed with" |
432 | " completion flag 0x%02x and interface data 0x%02x" , |
433 | command, complete, iface_data); |
434 | |
435 | if (complete != 0xaa || iface_data == 0xff) { |
436 | ret = -EINVAL; |
437 | goto exit; |
438 | } |
439 | |
440 | if (out) { |
441 | out->d0 = readl(addr: samsung->sabi_iface + SABI_IFACE_DATA); |
442 | out->d1 = readl(addr: samsung->sabi_iface + SABI_IFACE_DATA + 4); |
443 | out->d2 = readw(addr: samsung->sabi_iface + SABI_IFACE_DATA + 2); |
444 | out->d3 = readb(addr: samsung->sabi_iface + SABI_IFACE_DATA + 1); |
445 | } |
446 | |
447 | if (debug && out) { |
448 | pr_info("SABI return data:{0x%08x, 0x%08x, 0x%04x, 0x%02x}" , |
449 | out->d0, out->d1, out->d2, out->d3); |
450 | } |
451 | |
452 | exit: |
453 | mutex_unlock(lock: &samsung->sabi_mutex); |
454 | return ret; |
455 | } |
456 | |
457 | /* simple wrappers usable with most commands */ |
458 | static int sabi_set_commandb(struct samsung_laptop *samsung, |
459 | u16 command, u8 data) |
460 | { |
461 | struct sabi_data in = { { { .d0 = 0, .d1 = 0, .d2 = 0, .d3 = 0 } } }; |
462 | |
463 | in.data[0] = data; |
464 | return sabi_command(samsung, command, in: &in, NULL); |
465 | } |
466 | |
467 | static int read_brightness(struct samsung_laptop *samsung) |
468 | { |
469 | const struct sabi_config *config = samsung->config; |
470 | const struct sabi_commands *commands = &samsung->config->commands; |
471 | struct sabi_data sretval; |
472 | int user_brightness = 0; |
473 | int retval; |
474 | |
475 | retval = sabi_command(samsung, command: commands->get_brightness, |
476 | NULL, out: &sretval); |
477 | if (retval) |
478 | return retval; |
479 | |
480 | user_brightness = sretval.data[0]; |
481 | if (user_brightness > config->min_brightness) |
482 | user_brightness -= config->min_brightness; |
483 | else |
484 | user_brightness = 0; |
485 | |
486 | return user_brightness; |
487 | } |
488 | |
489 | static void set_brightness(struct samsung_laptop *samsung, u8 user_brightness) |
490 | { |
491 | const struct sabi_config *config = samsung->config; |
492 | const struct sabi_commands *commands = &samsung->config->commands; |
493 | u8 user_level = user_brightness + config->min_brightness; |
494 | |
495 | if (samsung->has_stepping_quirk && user_level != 0) { |
496 | /* |
497 | * short circuit if the specified level is what's already set |
498 | * to prevent the screen from flickering needlessly |
499 | */ |
500 | if (user_brightness == read_brightness(samsung)) |
501 | return; |
502 | |
503 | sabi_set_commandb(samsung, command: commands->set_brightness, data: 0); |
504 | } |
505 | |
506 | sabi_set_commandb(samsung, command: commands->set_brightness, data: user_level); |
507 | } |
508 | |
509 | static int get_brightness(struct backlight_device *bd) |
510 | { |
511 | struct samsung_laptop *samsung = bl_get_data(bl_dev: bd); |
512 | |
513 | return read_brightness(samsung); |
514 | } |
515 | |
516 | static void check_for_stepping_quirk(struct samsung_laptop *samsung) |
517 | { |
518 | int initial_level; |
519 | int check_level; |
520 | int orig_level = read_brightness(samsung); |
521 | |
522 | /* |
523 | * Some laptops exhibit the strange behaviour of stepping toward |
524 | * (rather than setting) the brightness except when changing to/from |
525 | * brightness level 0. This behaviour is checked for here and worked |
526 | * around in set_brightness. |
527 | */ |
528 | |
529 | if (orig_level == 0) |
530 | set_brightness(samsung, user_brightness: 1); |
531 | |
532 | initial_level = read_brightness(samsung); |
533 | |
534 | if (initial_level <= 2) |
535 | check_level = initial_level + 2; |
536 | else |
537 | check_level = initial_level - 2; |
538 | |
539 | samsung->has_stepping_quirk = false; |
540 | set_brightness(samsung, user_brightness: check_level); |
541 | |
542 | if (read_brightness(samsung) != check_level) { |
543 | samsung->has_stepping_quirk = true; |
544 | pr_info("enabled workaround for brightness stepping quirk\n" ); |
545 | } |
546 | |
547 | set_brightness(samsung, user_brightness: orig_level); |
548 | } |
549 | |
550 | static int update_status(struct backlight_device *bd) |
551 | { |
552 | struct samsung_laptop *samsung = bl_get_data(bl_dev: bd); |
553 | const struct sabi_commands *commands = &samsung->config->commands; |
554 | |
555 | set_brightness(samsung, user_brightness: bd->props.brightness); |
556 | |
557 | if (bd->props.power == FB_BLANK_UNBLANK) |
558 | sabi_set_commandb(samsung, command: commands->set_backlight, data: 1); |
559 | else |
560 | sabi_set_commandb(samsung, command: commands->set_backlight, data: 0); |
561 | |
562 | return 0; |
563 | } |
564 | |
565 | static const struct backlight_ops backlight_ops = { |
566 | .get_brightness = get_brightness, |
567 | .update_status = update_status, |
568 | }; |
569 | |
570 | static int seclinux_rfkill_set(void *data, bool blocked) |
571 | { |
572 | struct samsung_rfkill *srfkill = data; |
573 | struct samsung_laptop *samsung = srfkill->samsung; |
574 | const struct sabi_commands *commands = &samsung->config->commands; |
575 | |
576 | return sabi_set_commandb(samsung, command: commands->set_wireless_button, |
577 | data: !blocked); |
578 | } |
579 | |
580 | static const struct rfkill_ops seclinux_rfkill_ops = { |
581 | .set_block = seclinux_rfkill_set, |
582 | }; |
583 | |
584 | static int swsmi_wireless_status(struct samsung_laptop *samsung, |
585 | struct sabi_data *data) |
586 | { |
587 | const struct sabi_commands *commands = &samsung->config->commands; |
588 | |
589 | return sabi_command(samsung, command: commands->get_wireless_status, |
590 | NULL, out: data); |
591 | } |
592 | |
593 | static int swsmi_rfkill_set(void *priv, bool blocked) |
594 | { |
595 | struct samsung_rfkill *srfkill = priv; |
596 | struct samsung_laptop *samsung = srfkill->samsung; |
597 | const struct sabi_commands *commands = &samsung->config->commands; |
598 | struct sabi_data data; |
599 | int ret, i; |
600 | |
601 | ret = swsmi_wireless_status(samsung, data: &data); |
602 | if (ret) |
603 | return ret; |
604 | |
605 | /* Don't set the state for non-present devices */ |
606 | for (i = 0; i < 4; i++) |
607 | if (data.data[i] == 0x02) |
608 | data.data[1] = 0; |
609 | |
610 | if (srfkill->type == RFKILL_TYPE_WLAN) |
611 | data.data[WL_STATUS_WLAN] = !blocked; |
612 | else if (srfkill->type == RFKILL_TYPE_BLUETOOTH) |
613 | data.data[WL_STATUS_BT] = !blocked; |
614 | |
615 | return sabi_command(samsung, command: commands->set_wireless_status, |
616 | in: &data, out: &data); |
617 | } |
618 | |
619 | static void swsmi_rfkill_query(struct rfkill *rfkill, void *priv) |
620 | { |
621 | struct samsung_rfkill *srfkill = priv; |
622 | struct samsung_laptop *samsung = srfkill->samsung; |
623 | struct sabi_data data; |
624 | int ret; |
625 | |
626 | ret = swsmi_wireless_status(samsung, data: &data); |
627 | if (ret) |
628 | return ; |
629 | |
630 | if (srfkill->type == RFKILL_TYPE_WLAN) |
631 | ret = data.data[WL_STATUS_WLAN]; |
632 | else if (srfkill->type == RFKILL_TYPE_BLUETOOTH) |
633 | ret = data.data[WL_STATUS_BT]; |
634 | else |
635 | return ; |
636 | |
637 | rfkill_set_sw_state(rfkill, blocked: !ret); |
638 | } |
639 | |
640 | static const struct rfkill_ops swsmi_rfkill_ops = { |
641 | .set_block = swsmi_rfkill_set, |
642 | .query = swsmi_rfkill_query, |
643 | }; |
644 | |
645 | static ssize_t get_performance_level(struct device *dev, |
646 | struct device_attribute *attr, char *buf) |
647 | { |
648 | struct samsung_laptop *samsung = dev_get_drvdata(dev); |
649 | const struct sabi_config *config = samsung->config; |
650 | const struct sabi_commands *commands = &config->commands; |
651 | struct sabi_data sretval; |
652 | int retval; |
653 | int i; |
654 | |
655 | /* Read the state */ |
656 | retval = sabi_command(samsung, command: commands->get_performance_level, |
657 | NULL, out: &sretval); |
658 | if (retval) |
659 | return retval; |
660 | |
661 | /* The logic is backwards, yeah, lots of fun... */ |
662 | for (i = 0; config->performance_levels[i].name; ++i) { |
663 | if (sretval.data[0] == config->performance_levels[i].value) |
664 | return sprintf(buf, fmt: "%s\n" , config->performance_levels[i].name); |
665 | } |
666 | return sprintf(buf, fmt: "%s\n" , "unknown" ); |
667 | } |
668 | |
669 | static ssize_t set_performance_level(struct device *dev, |
670 | struct device_attribute *attr, const char *buf, |
671 | size_t count) |
672 | { |
673 | struct samsung_laptop *samsung = dev_get_drvdata(dev); |
674 | const struct sabi_config *config = samsung->config; |
675 | const struct sabi_commands *commands = &config->commands; |
676 | int i; |
677 | |
678 | if (count < 1) |
679 | return count; |
680 | |
681 | for (i = 0; config->performance_levels[i].name; ++i) { |
682 | const struct sabi_performance_level *level = |
683 | &config->performance_levels[i]; |
684 | if (!strncasecmp(s1: level->name, s2: buf, strlen(level->name))) { |
685 | sabi_set_commandb(samsung, |
686 | command: commands->set_performance_level, |
687 | data: level->value); |
688 | break; |
689 | } |
690 | } |
691 | |
692 | if (!config->performance_levels[i].name) |
693 | return -EINVAL; |
694 | |
695 | return count; |
696 | } |
697 | |
698 | static DEVICE_ATTR(performance_level, 0644, |
699 | get_performance_level, set_performance_level); |
700 | |
701 | static int read_battery_life_extender(struct samsung_laptop *samsung) |
702 | { |
703 | const struct sabi_commands *commands = &samsung->config->commands; |
704 | struct sabi_data data; |
705 | int retval; |
706 | |
707 | if (commands->get_battery_life_extender == 0xFFFF) |
708 | return -ENODEV; |
709 | |
710 | memset(&data, 0, sizeof(data)); |
711 | data.data[0] = 0x80; |
712 | retval = sabi_command(samsung, command: commands->get_battery_life_extender, |
713 | in: &data, out: &data); |
714 | |
715 | if (retval) |
716 | return retval; |
717 | |
718 | if (data.data[0] != 0 && data.data[0] != 1) |
719 | return -ENODEV; |
720 | |
721 | return data.data[0]; |
722 | } |
723 | |
724 | static int write_battery_life_extender(struct samsung_laptop *samsung, |
725 | int enabled) |
726 | { |
727 | const struct sabi_commands *commands = &samsung->config->commands; |
728 | struct sabi_data data; |
729 | |
730 | memset(&data, 0, sizeof(data)); |
731 | data.data[0] = 0x80 | enabled; |
732 | return sabi_command(samsung, command: commands->set_battery_life_extender, |
733 | in: &data, NULL); |
734 | } |
735 | |
736 | static ssize_t get_battery_life_extender(struct device *dev, |
737 | struct device_attribute *attr, |
738 | char *buf) |
739 | { |
740 | struct samsung_laptop *samsung = dev_get_drvdata(dev); |
741 | int ret; |
742 | |
743 | ret = read_battery_life_extender(samsung); |
744 | if (ret < 0) |
745 | return ret; |
746 | |
747 | return sprintf(buf, fmt: "%d\n" , ret); |
748 | } |
749 | |
750 | static ssize_t set_battery_life_extender(struct device *dev, |
751 | struct device_attribute *attr, |
752 | const char *buf, size_t count) |
753 | { |
754 | struct samsung_laptop *samsung = dev_get_drvdata(dev); |
755 | int ret, value; |
756 | |
757 | if (!count || kstrtoint(s: buf, base: 0, res: &value) != 0) |
758 | return -EINVAL; |
759 | |
760 | ret = write_battery_life_extender(samsung, enabled: !!value); |
761 | if (ret < 0) |
762 | return ret; |
763 | |
764 | return count; |
765 | } |
766 | |
767 | static DEVICE_ATTR(battery_life_extender, 0644, |
768 | get_battery_life_extender, set_battery_life_extender); |
769 | |
770 | static int read_usb_charge(struct samsung_laptop *samsung) |
771 | { |
772 | const struct sabi_commands *commands = &samsung->config->commands; |
773 | struct sabi_data data; |
774 | int retval; |
775 | |
776 | if (commands->get_usb_charge == 0xFFFF) |
777 | return -ENODEV; |
778 | |
779 | memset(&data, 0, sizeof(data)); |
780 | data.data[0] = 0x80; |
781 | retval = sabi_command(samsung, command: commands->get_usb_charge, |
782 | in: &data, out: &data); |
783 | |
784 | if (retval) |
785 | return retval; |
786 | |
787 | if (data.data[0] != 0 && data.data[0] != 1) |
788 | return -ENODEV; |
789 | |
790 | return data.data[0]; |
791 | } |
792 | |
793 | static int write_usb_charge(struct samsung_laptop *samsung, |
794 | int enabled) |
795 | { |
796 | const struct sabi_commands *commands = &samsung->config->commands; |
797 | struct sabi_data data; |
798 | |
799 | memset(&data, 0, sizeof(data)); |
800 | data.data[0] = 0x80 | enabled; |
801 | return sabi_command(samsung, command: commands->set_usb_charge, |
802 | in: &data, NULL); |
803 | } |
804 | |
805 | static ssize_t get_usb_charge(struct device *dev, |
806 | struct device_attribute *attr, |
807 | char *buf) |
808 | { |
809 | struct samsung_laptop *samsung = dev_get_drvdata(dev); |
810 | int ret; |
811 | |
812 | ret = read_usb_charge(samsung); |
813 | if (ret < 0) |
814 | return ret; |
815 | |
816 | return sprintf(buf, fmt: "%d\n" , ret); |
817 | } |
818 | |
819 | static ssize_t set_usb_charge(struct device *dev, |
820 | struct device_attribute *attr, |
821 | const char *buf, size_t count) |
822 | { |
823 | struct samsung_laptop *samsung = dev_get_drvdata(dev); |
824 | int ret, value; |
825 | |
826 | if (!count || kstrtoint(s: buf, base: 0, res: &value) != 0) |
827 | return -EINVAL; |
828 | |
829 | ret = write_usb_charge(samsung, enabled: !!value); |
830 | if (ret < 0) |
831 | return ret; |
832 | |
833 | return count; |
834 | } |
835 | |
836 | static DEVICE_ATTR(usb_charge, 0644, |
837 | get_usb_charge, set_usb_charge); |
838 | |
839 | static int read_lid_handling(struct samsung_laptop *samsung) |
840 | { |
841 | const struct sabi_commands *commands = &samsung->config->commands; |
842 | struct sabi_data data; |
843 | int retval; |
844 | |
845 | if (commands->get_lid_handling == 0xFFFF) |
846 | return -ENODEV; |
847 | |
848 | memset(&data, 0, sizeof(data)); |
849 | retval = sabi_command(samsung, command: commands->get_lid_handling, |
850 | in: &data, out: &data); |
851 | |
852 | if (retval) |
853 | return retval; |
854 | |
855 | return data.data[0] & 0x1; |
856 | } |
857 | |
858 | static int write_lid_handling(struct samsung_laptop *samsung, |
859 | int enabled) |
860 | { |
861 | const struct sabi_commands *commands = &samsung->config->commands; |
862 | struct sabi_data data; |
863 | |
864 | memset(&data, 0, sizeof(data)); |
865 | data.data[0] = 0x80 | enabled; |
866 | return sabi_command(samsung, command: commands->set_lid_handling, |
867 | in: &data, NULL); |
868 | } |
869 | |
870 | static ssize_t get_lid_handling(struct device *dev, |
871 | struct device_attribute *attr, |
872 | char *buf) |
873 | { |
874 | struct samsung_laptop *samsung = dev_get_drvdata(dev); |
875 | int ret; |
876 | |
877 | ret = read_lid_handling(samsung); |
878 | if (ret < 0) |
879 | return ret; |
880 | |
881 | return sprintf(buf, fmt: "%d\n" , ret); |
882 | } |
883 | |
884 | static ssize_t set_lid_handling(struct device *dev, |
885 | struct device_attribute *attr, |
886 | const char *buf, size_t count) |
887 | { |
888 | struct samsung_laptop *samsung = dev_get_drvdata(dev); |
889 | int ret, value; |
890 | |
891 | if (!count || kstrtoint(s: buf, base: 0, res: &value) != 0) |
892 | return -EINVAL; |
893 | |
894 | ret = write_lid_handling(samsung, enabled: !!value); |
895 | if (ret < 0) |
896 | return ret; |
897 | |
898 | return count; |
899 | } |
900 | |
901 | static DEVICE_ATTR(lid_handling, 0644, |
902 | get_lid_handling, set_lid_handling); |
903 | |
904 | static struct attribute *platform_attributes[] = { |
905 | &dev_attr_performance_level.attr, |
906 | &dev_attr_battery_life_extender.attr, |
907 | &dev_attr_usb_charge.attr, |
908 | &dev_attr_lid_handling.attr, |
909 | NULL |
910 | }; |
911 | |
912 | static int find_signature(void __iomem *memcheck, const char *testStr) |
913 | { |
914 | int i = 0; |
915 | int loca; |
916 | |
917 | for (loca = 0; loca < 0xffff; loca++) { |
918 | char temp = readb(addr: memcheck + loca); |
919 | |
920 | if (temp == testStr[i]) { |
921 | if (i == strlen(testStr)-1) |
922 | break; |
923 | ++i; |
924 | } else { |
925 | i = 0; |
926 | } |
927 | } |
928 | return loca; |
929 | } |
930 | |
931 | static void samsung_rfkill_exit(struct samsung_laptop *samsung) |
932 | { |
933 | if (samsung->wlan.rfkill) { |
934 | rfkill_unregister(rfkill: samsung->wlan.rfkill); |
935 | rfkill_destroy(rfkill: samsung->wlan.rfkill); |
936 | samsung->wlan.rfkill = NULL; |
937 | } |
938 | if (samsung->bluetooth.rfkill) { |
939 | rfkill_unregister(rfkill: samsung->bluetooth.rfkill); |
940 | rfkill_destroy(rfkill: samsung->bluetooth.rfkill); |
941 | samsung->bluetooth.rfkill = NULL; |
942 | } |
943 | } |
944 | |
945 | static int samsung_new_rfkill(struct samsung_laptop *samsung, |
946 | struct samsung_rfkill *arfkill, |
947 | const char *name, enum rfkill_type type, |
948 | const struct rfkill_ops *ops, |
949 | int blocked) |
950 | { |
951 | struct rfkill **rfkill = &arfkill->rfkill; |
952 | int ret; |
953 | |
954 | arfkill->type = type; |
955 | arfkill->samsung = samsung; |
956 | |
957 | *rfkill = rfkill_alloc(name, parent: &samsung->platform_device->dev, |
958 | type, ops, ops_data: arfkill); |
959 | |
960 | if (!*rfkill) |
961 | return -EINVAL; |
962 | |
963 | if (blocked != -1) |
964 | rfkill_init_sw_state(rfkill: *rfkill, blocked); |
965 | |
966 | ret = rfkill_register(rfkill: *rfkill); |
967 | if (ret) { |
968 | rfkill_destroy(rfkill: *rfkill); |
969 | *rfkill = NULL; |
970 | return ret; |
971 | } |
972 | return 0; |
973 | } |
974 | |
975 | static int __init samsung_rfkill_init_seclinux(struct samsung_laptop *samsung) |
976 | { |
977 | return samsung_new_rfkill(samsung, arfkill: &samsung->wlan, name: "samsung-wlan" , |
978 | type: RFKILL_TYPE_WLAN, ops: &seclinux_rfkill_ops, blocked: -1); |
979 | } |
980 | |
981 | static int __init samsung_rfkill_init_swsmi(struct samsung_laptop *samsung) |
982 | { |
983 | struct sabi_data data; |
984 | int ret; |
985 | |
986 | ret = swsmi_wireless_status(samsung, data: &data); |
987 | if (ret) { |
988 | /* Some swsmi laptops use the old seclinux way to control |
989 | * wireless devices */ |
990 | if (ret == -EINVAL) |
991 | ret = samsung_rfkill_init_seclinux(samsung); |
992 | return ret; |
993 | } |
994 | |
995 | /* 0x02 seems to mean that the device is no present/available */ |
996 | |
997 | if (data.data[WL_STATUS_WLAN] != 0x02) |
998 | ret = samsung_new_rfkill(samsung, arfkill: &samsung->wlan, |
999 | name: "samsung-wlan" , |
1000 | type: RFKILL_TYPE_WLAN, |
1001 | ops: &swsmi_rfkill_ops, |
1002 | blocked: !data.data[WL_STATUS_WLAN]); |
1003 | if (ret) |
1004 | goto exit; |
1005 | |
1006 | if (data.data[WL_STATUS_BT] != 0x02) |
1007 | ret = samsung_new_rfkill(samsung, arfkill: &samsung->bluetooth, |
1008 | name: "samsung-bluetooth" , |
1009 | type: RFKILL_TYPE_BLUETOOTH, |
1010 | ops: &swsmi_rfkill_ops, |
1011 | blocked: !data.data[WL_STATUS_BT]); |
1012 | if (ret) |
1013 | goto exit; |
1014 | |
1015 | exit: |
1016 | if (ret) |
1017 | samsung_rfkill_exit(samsung); |
1018 | |
1019 | return ret; |
1020 | } |
1021 | |
1022 | static int __init samsung_rfkill_init(struct samsung_laptop *samsung) |
1023 | { |
1024 | if (samsung->config->sabi_version == 2) |
1025 | return samsung_rfkill_init_seclinux(samsung); |
1026 | if (samsung->config->sabi_version == 3) |
1027 | return samsung_rfkill_init_swsmi(samsung); |
1028 | return 0; |
1029 | } |
1030 | |
1031 | static void samsung_lid_handling_exit(struct samsung_laptop *samsung) |
1032 | { |
1033 | if (samsung->quirks->lid_handling) |
1034 | write_lid_handling(samsung, enabled: 0); |
1035 | } |
1036 | |
1037 | static int __init samsung_lid_handling_init(struct samsung_laptop *samsung) |
1038 | { |
1039 | int retval = 0; |
1040 | |
1041 | if (samsung->quirks->lid_handling) |
1042 | retval = write_lid_handling(samsung, enabled: 1); |
1043 | |
1044 | return retval; |
1045 | } |
1046 | |
1047 | static int kbd_backlight_enable(struct samsung_laptop *samsung) |
1048 | { |
1049 | const struct sabi_commands *commands = &samsung->config->commands; |
1050 | struct sabi_data data; |
1051 | int retval; |
1052 | |
1053 | if (commands->kbd_backlight == 0xFFFF) |
1054 | return -ENODEV; |
1055 | |
1056 | memset(&data, 0, sizeof(data)); |
1057 | data.d0 = 0xaabb; |
1058 | retval = sabi_command(samsung, command: commands->kbd_backlight, |
1059 | in: &data, out: &data); |
1060 | |
1061 | if (retval) |
1062 | return retval; |
1063 | |
1064 | if (data.d0 != 0xccdd) |
1065 | return -ENODEV; |
1066 | return 0; |
1067 | } |
1068 | |
1069 | static int kbd_backlight_read(struct samsung_laptop *samsung) |
1070 | { |
1071 | const struct sabi_commands *commands = &samsung->config->commands; |
1072 | struct sabi_data data; |
1073 | int retval; |
1074 | |
1075 | memset(&data, 0, sizeof(data)); |
1076 | data.data[0] = 0x81; |
1077 | retval = sabi_command(samsung, command: commands->kbd_backlight, |
1078 | in: &data, out: &data); |
1079 | |
1080 | if (retval) |
1081 | return retval; |
1082 | |
1083 | return data.data[0]; |
1084 | } |
1085 | |
1086 | static int kbd_backlight_write(struct samsung_laptop *samsung, int brightness) |
1087 | { |
1088 | const struct sabi_commands *commands = &samsung->config->commands; |
1089 | struct sabi_data data; |
1090 | |
1091 | memset(&data, 0, sizeof(data)); |
1092 | data.d0 = 0x82 | ((brightness & 0xFF) << 8); |
1093 | return sabi_command(samsung, command: commands->kbd_backlight, |
1094 | in: &data, NULL); |
1095 | } |
1096 | |
1097 | static void kbd_led_update(struct work_struct *work) |
1098 | { |
1099 | struct samsung_laptop *samsung; |
1100 | |
1101 | samsung = container_of(work, struct samsung_laptop, kbd_led_work); |
1102 | kbd_backlight_write(samsung, brightness: samsung->kbd_led_wk); |
1103 | } |
1104 | |
1105 | static void kbd_led_set(struct led_classdev *led_cdev, |
1106 | enum led_brightness value) |
1107 | { |
1108 | struct samsung_laptop *samsung; |
1109 | |
1110 | samsung = container_of(led_cdev, struct samsung_laptop, kbd_led); |
1111 | |
1112 | if (value > samsung->kbd_led.max_brightness) |
1113 | value = samsung->kbd_led.max_brightness; |
1114 | |
1115 | samsung->kbd_led_wk = value; |
1116 | queue_work(wq: samsung->led_workqueue, work: &samsung->kbd_led_work); |
1117 | } |
1118 | |
1119 | static enum led_brightness kbd_led_get(struct led_classdev *led_cdev) |
1120 | { |
1121 | struct samsung_laptop *samsung; |
1122 | |
1123 | samsung = container_of(led_cdev, struct samsung_laptop, kbd_led); |
1124 | return kbd_backlight_read(samsung); |
1125 | } |
1126 | |
1127 | static void samsung_leds_exit(struct samsung_laptop *samsung) |
1128 | { |
1129 | led_classdev_unregister(led_cdev: &samsung->kbd_led); |
1130 | if (samsung->led_workqueue) |
1131 | destroy_workqueue(wq: samsung->led_workqueue); |
1132 | } |
1133 | |
1134 | static int __init samsung_leds_init(struct samsung_laptop *samsung) |
1135 | { |
1136 | int ret = 0; |
1137 | |
1138 | samsung->led_workqueue = create_singlethread_workqueue("led_workqueue" ); |
1139 | if (!samsung->led_workqueue) |
1140 | return -ENOMEM; |
1141 | |
1142 | if (kbd_backlight_enable(samsung) >= 0) { |
1143 | INIT_WORK(&samsung->kbd_led_work, kbd_led_update); |
1144 | |
1145 | samsung->kbd_led.name = "samsung::kbd_backlight" ; |
1146 | samsung->kbd_led.brightness_set = kbd_led_set; |
1147 | samsung->kbd_led.brightness_get = kbd_led_get; |
1148 | samsung->kbd_led.max_brightness = 8; |
1149 | if (samsung->quirks->four_kbd_backlight_levels) |
1150 | samsung->kbd_led.max_brightness = 4; |
1151 | |
1152 | ret = led_classdev_register(parent: &samsung->platform_device->dev, |
1153 | led_cdev: &samsung->kbd_led); |
1154 | } |
1155 | |
1156 | if (ret) |
1157 | samsung_leds_exit(samsung); |
1158 | |
1159 | return ret; |
1160 | } |
1161 | |
1162 | static void samsung_backlight_exit(struct samsung_laptop *samsung) |
1163 | { |
1164 | if (samsung->backlight_device) { |
1165 | backlight_device_unregister(bd: samsung->backlight_device); |
1166 | samsung->backlight_device = NULL; |
1167 | } |
1168 | } |
1169 | |
1170 | static int __init samsung_backlight_init(struct samsung_laptop *samsung) |
1171 | { |
1172 | struct backlight_device *bd; |
1173 | struct backlight_properties props; |
1174 | |
1175 | if (!samsung->handle_backlight) |
1176 | return 0; |
1177 | |
1178 | memset(&props, 0, sizeof(struct backlight_properties)); |
1179 | props.type = BACKLIGHT_PLATFORM; |
1180 | props.max_brightness = samsung->config->max_brightness - |
1181 | samsung->config->min_brightness; |
1182 | |
1183 | bd = backlight_device_register(name: "samsung" , |
1184 | dev: &samsung->platform_device->dev, |
1185 | devdata: samsung, ops: &backlight_ops, |
1186 | props: &props); |
1187 | if (IS_ERR(ptr: bd)) |
1188 | return PTR_ERR(ptr: bd); |
1189 | |
1190 | samsung->backlight_device = bd; |
1191 | samsung->backlight_device->props.brightness = read_brightness(samsung); |
1192 | samsung->backlight_device->props.power = FB_BLANK_UNBLANK; |
1193 | backlight_update_status(bd: samsung->backlight_device); |
1194 | |
1195 | return 0; |
1196 | } |
1197 | |
1198 | static umode_t samsung_sysfs_is_visible(struct kobject *kobj, |
1199 | struct attribute *attr, int idx) |
1200 | { |
1201 | struct device *dev = kobj_to_dev(kobj); |
1202 | struct samsung_laptop *samsung = dev_get_drvdata(dev); |
1203 | bool ok = true; |
1204 | |
1205 | if (attr == &dev_attr_performance_level.attr) |
1206 | ok = !!samsung->config->performance_levels[0].name; |
1207 | if (attr == &dev_attr_battery_life_extender.attr) |
1208 | ok = !!(read_battery_life_extender(samsung) >= 0); |
1209 | if (attr == &dev_attr_usb_charge.attr) |
1210 | ok = !!(read_usb_charge(samsung) >= 0); |
1211 | if (attr == &dev_attr_lid_handling.attr) |
1212 | ok = !!(read_lid_handling(samsung) >= 0); |
1213 | |
1214 | return ok ? attr->mode : 0; |
1215 | } |
1216 | |
1217 | static const struct attribute_group platform_attribute_group = { |
1218 | .is_visible = samsung_sysfs_is_visible, |
1219 | .attrs = platform_attributes |
1220 | }; |
1221 | |
1222 | static void samsung_sysfs_exit(struct samsung_laptop *samsung) |
1223 | { |
1224 | struct platform_device *device = samsung->platform_device; |
1225 | |
1226 | sysfs_remove_group(kobj: &device->dev.kobj, grp: &platform_attribute_group); |
1227 | } |
1228 | |
1229 | static int __init samsung_sysfs_init(struct samsung_laptop *samsung) |
1230 | { |
1231 | struct platform_device *device = samsung->platform_device; |
1232 | |
1233 | return sysfs_create_group(kobj: &device->dev.kobj, grp: &platform_attribute_group); |
1234 | |
1235 | } |
1236 | |
1237 | static int samsung_laptop_call_show(struct seq_file *m, void *data) |
1238 | { |
1239 | struct samsung_laptop *samsung = m->private; |
1240 | struct sabi_data *sdata = &samsung->debug.data; |
1241 | int ret; |
1242 | |
1243 | seq_printf(m, fmt: "SABI 0x%04x {0x%08x, 0x%08x, 0x%04x, 0x%02x}\n" , |
1244 | samsung->debug.command, |
1245 | sdata->d0, sdata->d1, sdata->d2, sdata->d3); |
1246 | |
1247 | ret = sabi_command(samsung, command: samsung->debug.command, in: sdata, out: sdata); |
1248 | |
1249 | if (ret) { |
1250 | seq_printf(m, fmt: "SABI command 0x%04x failed\n" , |
1251 | samsung->debug.command); |
1252 | return ret; |
1253 | } |
1254 | |
1255 | seq_printf(m, fmt: "SABI {0x%08x, 0x%08x, 0x%04x, 0x%02x}\n" , |
1256 | sdata->d0, sdata->d1, sdata->d2, sdata->d3); |
1257 | return 0; |
1258 | } |
1259 | DEFINE_SHOW_ATTRIBUTE(samsung_laptop_call); |
1260 | |
1261 | static void samsung_debugfs_exit(struct samsung_laptop *samsung) |
1262 | { |
1263 | debugfs_remove_recursive(dentry: samsung->debug.root); |
1264 | } |
1265 | |
1266 | static void samsung_debugfs_init(struct samsung_laptop *samsung) |
1267 | { |
1268 | struct dentry *root; |
1269 | |
1270 | root = debugfs_create_dir(name: "samsung-laptop" , NULL); |
1271 | samsung->debug.root = root; |
1272 | |
1273 | samsung->debug.f0000_wrapper.data = samsung->f0000_segment; |
1274 | samsung->debug.f0000_wrapper.size = 0xffff; |
1275 | |
1276 | samsung->debug.data_wrapper.data = &samsung->debug.data; |
1277 | samsung->debug.data_wrapper.size = sizeof(samsung->debug.data); |
1278 | |
1279 | samsung->debug.sdiag_wrapper.data = samsung->sdiag; |
1280 | samsung->debug.sdiag_wrapper.size = strlen(samsung->sdiag); |
1281 | |
1282 | debugfs_create_u16(name: "command" , mode: 0644, parent: root, value: &samsung->debug.command); |
1283 | debugfs_create_u32(name: "d0" , mode: 0644, parent: root, value: &samsung->debug.data.d0); |
1284 | debugfs_create_u32(name: "d1" , mode: 0644, parent: root, value: &samsung->debug.data.d1); |
1285 | debugfs_create_u16(name: "d2" , mode: 0644, parent: root, value: &samsung->debug.data.d2); |
1286 | debugfs_create_u8(name: "d3" , mode: 0644, parent: root, value: &samsung->debug.data.d3); |
1287 | debugfs_create_blob(name: "data" , mode: 0444, parent: root, blob: &samsung->debug.data_wrapper); |
1288 | debugfs_create_blob(name: "f0000_segment" , mode: 0400, parent: root, |
1289 | blob: &samsung->debug.f0000_wrapper); |
1290 | debugfs_create_file(name: "call" , mode: 0444, parent: root, data: samsung, |
1291 | fops: &samsung_laptop_call_fops); |
1292 | debugfs_create_blob(name: "sdiag" , mode: 0444, parent: root, blob: &samsung->debug.sdiag_wrapper); |
1293 | } |
1294 | |
1295 | static void samsung_sabi_exit(struct samsung_laptop *samsung) |
1296 | { |
1297 | const struct sabi_config *config = samsung->config; |
1298 | |
1299 | /* Turn off "Linux" mode in the BIOS */ |
1300 | if (config && config->commands.set_linux != 0xff) |
1301 | sabi_set_commandb(samsung, command: config->commands.set_linux, data: 0x80); |
1302 | |
1303 | if (samsung->sabi_iface) { |
1304 | iounmap(addr: samsung->sabi_iface); |
1305 | samsung->sabi_iface = NULL; |
1306 | } |
1307 | if (samsung->f0000_segment) { |
1308 | iounmap(addr: samsung->f0000_segment); |
1309 | samsung->f0000_segment = NULL; |
1310 | } |
1311 | |
1312 | samsung->config = NULL; |
1313 | } |
1314 | |
1315 | static __init void samsung_sabi_infos(struct samsung_laptop *samsung, int loca, |
1316 | unsigned int ifaceP) |
1317 | { |
1318 | const struct sabi_config *config = samsung->config; |
1319 | |
1320 | printk(KERN_DEBUG "This computer supports SABI==%x\n" , |
1321 | loca + 0xf0000 - 6); |
1322 | |
1323 | printk(KERN_DEBUG "SABI header:\n" ); |
1324 | printk(KERN_DEBUG " SMI Port Number = 0x%04x\n" , |
1325 | readw(samsung->sabi + config->header_offsets.port)); |
1326 | printk(KERN_DEBUG " SMI Interface Function = 0x%02x\n" , |
1327 | readb(samsung->sabi + config->header_offsets.iface_func)); |
1328 | printk(KERN_DEBUG " SMI enable memory buffer = 0x%02x\n" , |
1329 | readb(samsung->sabi + config->header_offsets.en_mem)); |
1330 | printk(KERN_DEBUG " SMI restore memory buffer = 0x%02x\n" , |
1331 | readb(samsung->sabi + config->header_offsets.re_mem)); |
1332 | printk(KERN_DEBUG " SABI data offset = 0x%04x\n" , |
1333 | readw(samsung->sabi + config->header_offsets.data_offset)); |
1334 | printk(KERN_DEBUG " SABI data segment = 0x%04x\n" , |
1335 | readw(samsung->sabi + config->header_offsets.data_segment)); |
1336 | |
1337 | printk(KERN_DEBUG " SABI pointer = 0x%08x\n" , ifaceP); |
1338 | } |
1339 | |
1340 | static void __init samsung_sabi_diag(struct samsung_laptop *samsung) |
1341 | { |
1342 | int loca = find_signature(memcheck: samsung->f0000_segment, testStr: "SDiaG@" ); |
1343 | int i; |
1344 | |
1345 | if (loca == 0xffff) |
1346 | return ; |
1347 | |
1348 | /* Example: |
1349 | * Ident: @SDiaG@686XX-N90X3A/966-SEC-07HL-S90X3A |
1350 | * |
1351 | * Product name: 90X3A |
1352 | * BIOS Version: 07HL |
1353 | */ |
1354 | loca += 1; |
1355 | for (i = 0; loca < 0xffff && i < sizeof(samsung->sdiag) - 1; loca++) { |
1356 | char temp = readb(addr: samsung->f0000_segment + loca); |
1357 | |
1358 | if (isalnum(temp) || temp == '/' || temp == '-') |
1359 | samsung->sdiag[i++] = temp; |
1360 | else |
1361 | break ; |
1362 | } |
1363 | |
1364 | if (debug && samsung->sdiag[0]) |
1365 | pr_info("sdiag: %s" , samsung->sdiag); |
1366 | } |
1367 | |
1368 | static int __init samsung_sabi_init(struct samsung_laptop *samsung) |
1369 | { |
1370 | const struct sabi_config *config = NULL; |
1371 | const struct sabi_commands *commands; |
1372 | unsigned int ifaceP; |
1373 | int loca = 0xffff; |
1374 | int ret = 0; |
1375 | int i; |
1376 | |
1377 | samsung->f0000_segment = ioremap(offset: 0xf0000, size: 0xffff); |
1378 | if (!samsung->f0000_segment) { |
1379 | if (debug || force) |
1380 | pr_err("Can't map the segment at 0xf0000\n" ); |
1381 | ret = -EINVAL; |
1382 | goto exit; |
1383 | } |
1384 | |
1385 | samsung_sabi_diag(samsung); |
1386 | |
1387 | /* Try to find one of the signatures in memory to find the header */ |
1388 | for (i = 0; sabi_configs[i].test_string != NULL; ++i) { |
1389 | samsung->config = &sabi_configs[i]; |
1390 | loca = find_signature(memcheck: samsung->f0000_segment, |
1391 | testStr: samsung->config->test_string); |
1392 | if (loca != 0xffff) |
1393 | break; |
1394 | } |
1395 | |
1396 | if (loca == 0xffff) { |
1397 | if (debug || force) |
1398 | pr_err("This computer does not support SABI\n" ); |
1399 | ret = -ENODEV; |
1400 | goto exit; |
1401 | } |
1402 | |
1403 | config = samsung->config; |
1404 | commands = &config->commands; |
1405 | |
1406 | /* point to the SMI port Number */ |
1407 | loca += 1; |
1408 | samsung->sabi = (samsung->f0000_segment + loca); |
1409 | |
1410 | /* Get a pointer to the SABI Interface */ |
1411 | ifaceP = (readw(addr: samsung->sabi + config->header_offsets.data_segment) & 0x0ffff) << 4; |
1412 | ifaceP += readw(addr: samsung->sabi + config->header_offsets.data_offset) & 0x0ffff; |
1413 | |
1414 | if (debug) |
1415 | samsung_sabi_infos(samsung, loca, ifaceP); |
1416 | |
1417 | samsung->sabi_iface = ioremap(offset: ifaceP, size: 16); |
1418 | if (!samsung->sabi_iface) { |
1419 | pr_err("Can't remap %x\n" , ifaceP); |
1420 | ret = -EINVAL; |
1421 | goto exit; |
1422 | } |
1423 | |
1424 | /* Turn on "Linux" mode in the BIOS */ |
1425 | if (commands->set_linux != 0xff) { |
1426 | int retval = sabi_set_commandb(samsung, |
1427 | command: commands->set_linux, data: 0x81); |
1428 | if (retval) { |
1429 | pr_warn("Linux mode was not set!\n" ); |
1430 | ret = -ENODEV; |
1431 | goto exit; |
1432 | } |
1433 | } |
1434 | |
1435 | /* Check for stepping quirk */ |
1436 | if (samsung->handle_backlight) |
1437 | check_for_stepping_quirk(samsung); |
1438 | |
1439 | pr_info("detected SABI interface: %s\n" , |
1440 | samsung->config->test_string); |
1441 | |
1442 | exit: |
1443 | if (ret) |
1444 | samsung_sabi_exit(samsung); |
1445 | |
1446 | return ret; |
1447 | } |
1448 | |
1449 | static void samsung_platform_exit(struct samsung_laptop *samsung) |
1450 | { |
1451 | if (samsung->platform_device) { |
1452 | platform_device_unregister(samsung->platform_device); |
1453 | samsung->platform_device = NULL; |
1454 | } |
1455 | } |
1456 | |
1457 | static int samsung_pm_notification(struct notifier_block *nb, |
1458 | unsigned long val, void *ptr) |
1459 | { |
1460 | struct samsung_laptop *samsung; |
1461 | |
1462 | samsung = container_of(nb, struct samsung_laptop, pm_nb); |
1463 | if (val == PM_POST_HIBERNATION && |
1464 | samsung->quirks->enable_kbd_backlight) |
1465 | kbd_backlight_enable(samsung); |
1466 | |
1467 | if (val == PM_POST_HIBERNATION && samsung->quirks->lid_handling) |
1468 | write_lid_handling(samsung, enabled: 1); |
1469 | |
1470 | return 0; |
1471 | } |
1472 | |
1473 | static int __init samsung_platform_init(struct samsung_laptop *samsung) |
1474 | { |
1475 | struct platform_device *pdev; |
1476 | |
1477 | pdev = platform_device_register_simple(name: "samsung" , PLATFORM_DEVID_NONE, NULL, num: 0); |
1478 | if (IS_ERR(ptr: pdev)) |
1479 | return PTR_ERR(ptr: pdev); |
1480 | |
1481 | samsung->platform_device = pdev; |
1482 | platform_set_drvdata(pdev: samsung->platform_device, data: samsung); |
1483 | return 0; |
1484 | } |
1485 | |
1486 | static struct samsung_quirks *quirks; |
1487 | |
1488 | static int __init samsung_dmi_matched(const struct dmi_system_id *d) |
1489 | { |
1490 | quirks = d->driver_data; |
1491 | return 0; |
1492 | } |
1493 | |
1494 | static const struct dmi_system_id samsung_dmi_table[] __initconst = { |
1495 | { |
1496 | .matches = { |
1497 | DMI_MATCH(DMI_SYS_VENDOR, |
1498 | "SAMSUNG ELECTRONICS CO., LTD." ), |
1499 | DMI_MATCH(DMI_CHASSIS_TYPE, "8" ), /* Portable */ |
1500 | }, |
1501 | }, |
1502 | { |
1503 | .matches = { |
1504 | DMI_MATCH(DMI_SYS_VENDOR, |
1505 | "SAMSUNG ELECTRONICS CO., LTD." ), |
1506 | DMI_MATCH(DMI_CHASSIS_TYPE, "9" ), /* Laptop */ |
1507 | }, |
1508 | }, |
1509 | { |
1510 | .matches = { |
1511 | DMI_MATCH(DMI_SYS_VENDOR, |
1512 | "SAMSUNG ELECTRONICS CO., LTD." ), |
1513 | DMI_MATCH(DMI_CHASSIS_TYPE, "10" ), /* Notebook */ |
1514 | }, |
1515 | }, |
1516 | { |
1517 | .matches = { |
1518 | DMI_MATCH(DMI_SYS_VENDOR, |
1519 | "SAMSUNG ELECTRONICS CO., LTD." ), |
1520 | DMI_MATCH(DMI_CHASSIS_TYPE, "14" ), /* Sub-Notebook */ |
1521 | }, |
1522 | }, |
1523 | /* DMI ids for laptops with bad Chassis Type */ |
1524 | { |
1525 | .ident = "R40/R41" , |
1526 | .matches = { |
1527 | DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD." ), |
1528 | DMI_MATCH(DMI_PRODUCT_NAME, "R40/R41" ), |
1529 | DMI_MATCH(DMI_BOARD_NAME, "R40/R41" ), |
1530 | }, |
1531 | }, |
1532 | /* Specific DMI ids for laptop with quirks */ |
1533 | { |
1534 | .callback = samsung_dmi_matched, |
1535 | .ident = "730U3E/740U3E" , |
1536 | .matches = { |
1537 | DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD." ), |
1538 | DMI_MATCH(DMI_PRODUCT_NAME, "730U3E/740U3E" ), |
1539 | }, |
1540 | .driver_data = &samsung_np740u3e, |
1541 | }, |
1542 | { |
1543 | .callback = samsung_dmi_matched, |
1544 | .ident = "300V3Z/300V4Z/300V5Z" , |
1545 | .matches = { |
1546 | DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD." ), |
1547 | DMI_MATCH(DMI_PRODUCT_NAME, "300V3Z/300V4Z/300V5Z" ), |
1548 | }, |
1549 | .driver_data = &samsung_lid_handling, |
1550 | }, |
1551 | { }, |
1552 | }; |
1553 | MODULE_DEVICE_TABLE(dmi, samsung_dmi_table); |
1554 | |
1555 | static struct platform_device *samsung_platform_device; |
1556 | |
1557 | static int __init samsung_init(void) |
1558 | { |
1559 | struct samsung_laptop *samsung; |
1560 | int ret; |
1561 | |
1562 | if (efi_enabled(EFI_BOOT)) |
1563 | return -ENODEV; |
1564 | |
1565 | quirks = &samsung_unknown; |
1566 | if (!force && !dmi_check_system(list: samsung_dmi_table)) |
1567 | return -ENODEV; |
1568 | |
1569 | samsung = kzalloc(size: sizeof(*samsung), GFP_KERNEL); |
1570 | if (!samsung) |
1571 | return -ENOMEM; |
1572 | |
1573 | mutex_init(&samsung->sabi_mutex); |
1574 | samsung->handle_backlight = true; |
1575 | samsung->quirks = quirks; |
1576 | |
1577 | if (acpi_video_get_backlight_type() != acpi_backlight_vendor) |
1578 | samsung->handle_backlight = false; |
1579 | |
1580 | ret = samsung_platform_init(samsung); |
1581 | if (ret) |
1582 | goto error_platform; |
1583 | |
1584 | ret = samsung_sabi_init(samsung); |
1585 | if (ret) |
1586 | goto error_sabi; |
1587 | |
1588 | ret = samsung_sysfs_init(samsung); |
1589 | if (ret) |
1590 | goto error_sysfs; |
1591 | |
1592 | ret = samsung_backlight_init(samsung); |
1593 | if (ret) |
1594 | goto error_backlight; |
1595 | |
1596 | ret = samsung_rfkill_init(samsung); |
1597 | if (ret) |
1598 | goto error_rfkill; |
1599 | |
1600 | ret = samsung_leds_init(samsung); |
1601 | if (ret) |
1602 | goto error_leds; |
1603 | |
1604 | ret = samsung_lid_handling_init(samsung); |
1605 | if (ret) |
1606 | goto error_lid_handling; |
1607 | |
1608 | samsung_debugfs_init(samsung); |
1609 | |
1610 | samsung->pm_nb.notifier_call = samsung_pm_notification; |
1611 | register_pm_notifier(nb: &samsung->pm_nb); |
1612 | |
1613 | samsung_platform_device = samsung->platform_device; |
1614 | return ret; |
1615 | |
1616 | error_lid_handling: |
1617 | samsung_leds_exit(samsung); |
1618 | error_leds: |
1619 | samsung_rfkill_exit(samsung); |
1620 | error_rfkill: |
1621 | samsung_backlight_exit(samsung); |
1622 | error_backlight: |
1623 | samsung_sysfs_exit(samsung); |
1624 | error_sysfs: |
1625 | samsung_sabi_exit(samsung); |
1626 | error_sabi: |
1627 | samsung_platform_exit(samsung); |
1628 | error_platform: |
1629 | kfree(objp: samsung); |
1630 | return ret; |
1631 | } |
1632 | |
1633 | static void __exit samsung_exit(void) |
1634 | { |
1635 | struct samsung_laptop *samsung; |
1636 | |
1637 | samsung = platform_get_drvdata(pdev: samsung_platform_device); |
1638 | unregister_pm_notifier(nb: &samsung->pm_nb); |
1639 | |
1640 | samsung_debugfs_exit(samsung); |
1641 | samsung_lid_handling_exit(samsung); |
1642 | samsung_leds_exit(samsung); |
1643 | samsung_rfkill_exit(samsung); |
1644 | samsung_backlight_exit(samsung); |
1645 | samsung_sysfs_exit(samsung); |
1646 | samsung_sabi_exit(samsung); |
1647 | samsung_platform_exit(samsung); |
1648 | |
1649 | kfree(objp: samsung); |
1650 | samsung_platform_device = NULL; |
1651 | } |
1652 | |
1653 | module_init(samsung_init); |
1654 | module_exit(samsung_exit); |
1655 | |
1656 | MODULE_AUTHOR("Greg Kroah-Hartman <gregkh@suse.de>" ); |
1657 | MODULE_DESCRIPTION("Samsung Backlight driver" ); |
1658 | MODULE_LICENSE("GPL" ); |
1659 | |