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