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 sabi_header_offsets {
65 u8 port;
66 u8 re_mem;
67 u8 iface_func;
68 u8 en_mem;
69 u8 data_offset;
70 u8 data_segment;
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 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
sabi_command(struct samsung_laptop * samsung,u16 command,struct sabi_data * in,struct sabi_data * out)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(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(samsung->sabi + config->header_offsets.en_mem), port);
406
407 /* write out the command */
408 writew(config->main_function, samsung->sabi_iface + SABI_IFACE_MAIN);
409 writew(command, samsung->sabi_iface + SABI_IFACE_SUB);
410 writeb(0, samsung->sabi_iface + SABI_IFACE_COMPLETE);
411 if (in) {
412 writel(in->d0, samsung->sabi_iface + SABI_IFACE_DATA);
413 writel(in->d1, samsung->sabi_iface + SABI_IFACE_DATA + 4);
414 writew(in->d2, samsung->sabi_iface + SABI_IFACE_DATA + 8);
415 writeb(in->d3, samsung->sabi_iface + SABI_IFACE_DATA + 10);
416 }
417 outb(readb(samsung->sabi + config->header_offsets.iface_func), port);
418
419 /* write protect memory to make it safe */
420 outb(readb(samsung->sabi + config->header_offsets.re_mem), port);
421
422 /* see if the command actually succeeded */
423 complete = readb(samsung->sabi_iface + SABI_IFACE_COMPLETE);
424 iface_data = readb(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(samsung->sabi_iface + SABI_IFACE_DATA);
442 out->d1 = readl(samsung->sabi_iface + SABI_IFACE_DATA + 4);
443 out->d2 = readw(samsung->sabi_iface + SABI_IFACE_DATA + 2);
444 out->d3 = readb(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(&samsung->sabi_mutex);
454 return ret;
455 }
456
457 /* simple wrappers usable with most commands */
sabi_set_commandb(struct samsung_laptop * samsung,u16 command,u8 data)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, NULL);
465 }
466
read_brightness(struct samsung_laptop * samsung)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, commands->get_brightness,
476 NULL, &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
set_brightness(struct samsung_laptop * samsung,u8 user_brightness)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, commands->set_brightness, 0);
504 }
505
506 sabi_set_commandb(samsung, commands->set_brightness, user_level);
507 }
508
get_brightness(struct backlight_device * bd)509 static int get_brightness(struct backlight_device *bd)
510 {
511 struct samsung_laptop *samsung = bl_get_data(bd);
512
513 return read_brightness(samsung);
514 }
515
check_for_stepping_quirk(struct samsung_laptop * samsung)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, 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, 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, orig_level);
548 }
549
update_status(struct backlight_device * bd)550 static int update_status(struct backlight_device *bd)
551 {
552 struct samsung_laptop *samsung = bl_get_data(bd);
553 const struct sabi_commands *commands = &samsung->config->commands;
554
555 set_brightness(samsung, bd->props.brightness);
556
557 if (bd->props.power == FB_BLANK_UNBLANK)
558 sabi_set_commandb(samsung, commands->set_backlight, 1);
559 else
560 sabi_set_commandb(samsung, commands->set_backlight, 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
seclinux_rfkill_set(void * data,bool blocked)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, commands->set_wireless_button,
577 !blocked);
578 }
579
580 static const struct rfkill_ops seclinux_rfkill_ops = {
581 .set_block = seclinux_rfkill_set,
582 };
583
swsmi_wireless_status(struct samsung_laptop * samsung,struct sabi_data * data)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, commands->get_wireless_status,
590 NULL, data);
591 }
592
swsmi_rfkill_set(void * priv,bool blocked)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);
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, commands->set_wireless_status,
616 &data, &data);
617 }
618
swsmi_rfkill_query(struct rfkill * rfkill,void * priv)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);
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, !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
get_performance_level(struct device * dev,struct device_attribute * attr,char * buf)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, commands->get_performance_level,
657 NULL, &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, "%s\n", config->performance_levels[i].name);
665 }
666 return sprintf(buf, "%s\n", "unknown");
667 }
668
set_performance_level(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)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(level->name, buf, strlen(level->name))) {
685 sabi_set_commandb(samsung,
686 commands->set_performance_level,
687 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
read_battery_life_extender(struct samsung_laptop * samsung)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, commands->get_battery_life_extender,
713 &data, &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
write_battery_life_extender(struct samsung_laptop * samsung,int enabled)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, commands->set_battery_life_extender,
733 &data, NULL);
734 }
735
get_battery_life_extender(struct device * dev,struct device_attribute * attr,char * buf)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, "%d\n", ret);
748 }
749
set_battery_life_extender(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)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(buf, 0, &value) != 0)
758 return -EINVAL;
759
760 ret = write_battery_life_extender(samsung, !!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
read_usb_charge(struct samsung_laptop * samsung)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, commands->get_usb_charge,
782 &data, &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
write_usb_charge(struct samsung_laptop * samsung,int enabled)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, commands->set_usb_charge,
802 &data, NULL);
803 }
804
get_usb_charge(struct device * dev,struct device_attribute * attr,char * buf)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, "%d\n", ret);
817 }
818
set_usb_charge(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)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(buf, 0, &value) != 0)
827 return -EINVAL;
828
829 ret = write_usb_charge(samsung, !!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
read_lid_handling(struct samsung_laptop * samsung)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, commands->get_lid_handling,
850 &data, &data);
851
852 if (retval)
853 return retval;
854
855 return data.data[0] & 0x1;
856 }
857
write_lid_handling(struct samsung_laptop * samsung,int enabled)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, commands->set_lid_handling,
867 &data, NULL);
868 }
869
get_lid_handling(struct device * dev,struct device_attribute * attr,char * buf)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, "%d\n", ret);
882 }
883
set_lid_handling(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)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(buf, 0, &value) != 0)
892 return -EINVAL;
893
894 ret = write_lid_handling(samsung, !!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
find_signature(void __iomem * memcheck,const char * testStr)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(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
samsung_rfkill_exit(struct samsung_laptop * samsung)931 static void samsung_rfkill_exit(struct samsung_laptop *samsung)
932 {
933 if (samsung->wlan.rfkill) {
934 rfkill_unregister(samsung->wlan.rfkill);
935 rfkill_destroy(samsung->wlan.rfkill);
936 samsung->wlan.rfkill = NULL;
937 }
938 if (samsung->bluetooth.rfkill) {
939 rfkill_unregister(samsung->bluetooth.rfkill);
940 rfkill_destroy(samsung->bluetooth.rfkill);
941 samsung->bluetooth.rfkill = NULL;
942 }
943 }
944
samsung_new_rfkill(struct samsung_laptop * samsung,struct samsung_rfkill * arfkill,const char * name,enum rfkill_type type,const struct rfkill_ops * ops,int blocked)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, &samsung->platform_device->dev,
958 type, ops, arfkill);
959
960 if (!*rfkill)
961 return -EINVAL;
962
963 if (blocked != -1)
964 rfkill_init_sw_state(*rfkill, blocked);
965
966 ret = rfkill_register(*rfkill);
967 if (ret) {
968 rfkill_destroy(*rfkill);
969 *rfkill = NULL;
970 return ret;
971 }
972 return 0;
973 }
974
samsung_rfkill_init_seclinux(struct samsung_laptop * samsung)975 static int __init samsung_rfkill_init_seclinux(struct samsung_laptop *samsung)
976 {
977 return samsung_new_rfkill(samsung, &samsung->wlan, "samsung-wlan",
978 RFKILL_TYPE_WLAN, &seclinux_rfkill_ops, -1);
979 }
980
samsung_rfkill_init_swsmi(struct samsung_laptop * samsung)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);
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, &samsung->wlan,
999 "samsung-wlan",
1000 RFKILL_TYPE_WLAN,
1001 &swsmi_rfkill_ops,
1002 !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, &samsung->bluetooth,
1008 "samsung-bluetooth",
1009 RFKILL_TYPE_BLUETOOTH,
1010 &swsmi_rfkill_ops,
1011 !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
samsung_rfkill_init(struct samsung_laptop * samsung)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
samsung_lid_handling_exit(struct samsung_laptop * samsung)1031 static void samsung_lid_handling_exit(struct samsung_laptop *samsung)
1032 {
1033 if (samsung->quirks->lid_handling)
1034 write_lid_handling(samsung, 0);
1035 }
1036
samsung_lid_handling_init(struct samsung_laptop * samsung)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, 1);
1043
1044 return retval;
1045 }
1046
kbd_backlight_enable(struct samsung_laptop * samsung)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, commands->kbd_backlight,
1059 &data, &data);
1060
1061 if (retval)
1062 return retval;
1063
1064 if (data.d0 != 0xccdd)
1065 return -ENODEV;
1066 return 0;
1067 }
1068
kbd_backlight_read(struct samsung_laptop * samsung)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, commands->kbd_backlight,
1078 &data, &data);
1079
1080 if (retval)
1081 return retval;
1082
1083 return data.data[0];
1084 }
1085
kbd_backlight_write(struct samsung_laptop * samsung,int brightness)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, commands->kbd_backlight,
1094 &data, NULL);
1095 }
1096
kbd_led_update(struct work_struct * work)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, samsung->kbd_led_wk);
1103 }
1104
kbd_led_set(struct led_classdev * led_cdev,enum led_brightness value)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(samsung->led_workqueue, &samsung->kbd_led_work);
1117 }
1118
kbd_led_get(struct led_classdev * led_cdev)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
samsung_leds_exit(struct samsung_laptop * samsung)1127 static void samsung_leds_exit(struct samsung_laptop *samsung)
1128 {
1129 led_classdev_unregister(&samsung->kbd_led);
1130 if (samsung->led_workqueue)
1131 destroy_workqueue(samsung->led_workqueue);
1132 }
1133
samsung_leds_init(struct samsung_laptop * samsung)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(&samsung->platform_device->dev,
1153 &samsung->kbd_led);
1154 }
1155
1156 if (ret)
1157 samsung_leds_exit(samsung);
1158
1159 return ret;
1160 }
1161
samsung_backlight_exit(struct samsung_laptop * samsung)1162 static void samsung_backlight_exit(struct samsung_laptop *samsung)
1163 {
1164 if (samsung->backlight_device) {
1165 backlight_device_unregister(samsung->backlight_device);
1166 samsung->backlight_device = NULL;
1167 }
1168 }
1169
samsung_backlight_init(struct samsung_laptop * samsung)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("samsung",
1184 &samsung->platform_device->dev,
1185 samsung, &backlight_ops,
1186 &props);
1187 if (IS_ERR(bd))
1188 return PTR_ERR(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(samsung->backlight_device);
1194
1195 return 0;
1196 }
1197
samsung_sysfs_is_visible(struct kobject * kobj,struct attribute * attr,int idx)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
samsung_sysfs_exit(struct samsung_laptop * samsung)1222 static void samsung_sysfs_exit(struct samsung_laptop *samsung)
1223 {
1224 struct platform_device *device = samsung->platform_device;
1225
1226 sysfs_remove_group(&device->dev.kobj, &platform_attribute_group);
1227 }
1228
samsung_sysfs_init(struct samsung_laptop * samsung)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(&device->dev.kobj, &platform_attribute_group);
1234
1235 }
1236
samsung_laptop_call_show(struct seq_file * m,void * data)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, "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, samsung->debug.command, sdata, sdata);
1248
1249 if (ret) {
1250 seq_printf(m, "SABI command 0x%04x failed\n",
1251 samsung->debug.command);
1252 return ret;
1253 }
1254
1255 seq_printf(m, "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
samsung_debugfs_exit(struct samsung_laptop * samsung)1261 static void samsung_debugfs_exit(struct samsung_laptop *samsung)
1262 {
1263 debugfs_remove_recursive(samsung->debug.root);
1264 }
1265
samsung_debugfs_init(struct samsung_laptop * samsung)1266 static void samsung_debugfs_init(struct samsung_laptop *samsung)
1267 {
1268 struct dentry *root;
1269
1270 root = debugfs_create_dir("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("command", 0644, root, &samsung->debug.command);
1283 debugfs_create_u32("d0", 0644, root, &samsung->debug.data.d0);
1284 debugfs_create_u32("d1", 0644, root, &samsung->debug.data.d1);
1285 debugfs_create_u16("d2", 0644, root, &samsung->debug.data.d2);
1286 debugfs_create_u8("d3", 0644, root, &samsung->debug.data.d3);
1287 debugfs_create_blob("data", 0444, root, &samsung->debug.data_wrapper);
1288 debugfs_create_blob("f0000_segment", 0400, root,
1289 &samsung->debug.f0000_wrapper);
1290 debugfs_create_file("call", 0444, root, samsung,
1291 &samsung_laptop_call_fops);
1292 debugfs_create_blob("sdiag", 0444, root, &samsung->debug.sdiag_wrapper);
1293 }
1294
samsung_sabi_exit(struct samsung_laptop * samsung)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, config->commands.set_linux, 0x80);
1302
1303 if (samsung->sabi_iface) {
1304 iounmap(samsung->sabi_iface);
1305 samsung->sabi_iface = NULL;
1306 }
1307 if (samsung->f0000_segment) {
1308 iounmap(samsung->f0000_segment);
1309 samsung->f0000_segment = NULL;
1310 }
1311
1312 samsung->config = NULL;
1313 }
1314
samsung_sabi_infos(struct samsung_laptop * samsung,int loca,unsigned int ifaceP)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
samsung_sabi_diag(struct samsung_laptop * samsung)1340 static void __init samsung_sabi_diag(struct samsung_laptop *samsung)
1341 {
1342 int loca = find_signature(samsung->f0000_segment, "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(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
samsung_sabi_init(struct samsung_laptop * samsung)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(0xf0000, 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(samsung->f0000_segment,
1391 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(samsung->sabi + config->header_offsets.data_segment) & 0x0ffff) << 4;
1412 ifaceP += readw(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(ifaceP, 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 commands->set_linux, 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
samsung_platform_exit(struct samsung_laptop * samsung)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
samsung_pm_notification(struct notifier_block * nb,unsigned long val,void * ptr)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, 1);
1469
1470 return 0;
1471 }
1472
samsung_platform_init(struct samsung_laptop * samsung)1473 static int __init samsung_platform_init(struct samsung_laptop *samsung)
1474 {
1475 struct platform_device *pdev;
1476
1477 pdev = platform_device_register_simple("samsung", PLATFORM_DEVID_NONE, NULL, 0);
1478 if (IS_ERR(pdev))
1479 return PTR_ERR(pdev);
1480
1481 samsung->platform_device = pdev;
1482 platform_set_drvdata(samsung->platform_device, samsung);
1483 return 0;
1484 }
1485
1486 static struct samsung_quirks *quirks;
1487
samsung_dmi_matched(const struct dmi_system_id * d)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
samsung_init(void)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(samsung_dmi_table))
1567 return -ENODEV;
1568
1569 samsung = kzalloc(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(&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(samsung);
1630 return ret;
1631 }
1632
samsung_exit(void)1633 static void __exit samsung_exit(void)
1634 {
1635 struct samsung_laptop *samsung;
1636
1637 samsung = platform_get_drvdata(samsung_platform_device);
1638 unregister_pm_notifier(&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(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