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 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 broken_acpi_video;
360 	bool four_kbd_backlight_levels;
361 	bool enable_kbd_backlight;
362 	bool use_native_backlight;
363 	bool lid_handling;
364 };
365 
366 static struct samsung_quirks samsung_unknown = {};
367 
368 static struct samsung_quirks samsung_broken_acpi_video = {
369 	.broken_acpi_video = true,
370 };
371 
372 static struct samsung_quirks samsung_use_native_backlight = {
373 	.use_native_backlight = true,
374 };
375 
376 static struct samsung_quirks samsung_np740u3e = {
377 	.four_kbd_backlight_levels = true,
378 	.enable_kbd_backlight = true,
379 };
380 
381 static struct samsung_quirks samsung_lid_handling = {
382 	.lid_handling = true,
383 };
384 
385 static bool force;
386 module_param(force, bool, 0);
387 MODULE_PARM_DESC(force,
388 		"Disable the DMI check and forces the driver to be loaded");
389 
390 static bool debug;
391 module_param(debug, bool, S_IRUGO | S_IWUSR);
392 MODULE_PARM_DESC(debug, "Debug enabled or not");
393 
394 static int sabi_command(struct samsung_laptop *samsung, u16 command,
395 			struct sabi_data *in,
396 			struct sabi_data *out)
397 {
398 	const struct sabi_config *config = samsung->config;
399 	int ret = 0;
400 	u16 port = readw(samsung->sabi + config->header_offsets.port);
401 	u8 complete, iface_data;
402 
403 	mutex_lock(&samsung->sabi_mutex);
404 
405 	if (debug) {
406 		if (in)
407 			pr_info("SABI command:0x%04x "
408 				"data:{0x%08x, 0x%08x, 0x%04x, 0x%02x}",
409 				command, in->d0, in->d1, in->d2, in->d3);
410 		else
411 			pr_info("SABI command:0x%04x", command);
412 	}
413 
414 	/* enable memory to be able to write to it */
415 	outb(readb(samsung->sabi + config->header_offsets.en_mem), port);
416 
417 	/* write out the command */
418 	writew(config->main_function, samsung->sabi_iface + SABI_IFACE_MAIN);
419 	writew(command, samsung->sabi_iface + SABI_IFACE_SUB);
420 	writeb(0, samsung->sabi_iface + SABI_IFACE_COMPLETE);
421 	if (in) {
422 		writel(in->d0, samsung->sabi_iface + SABI_IFACE_DATA);
423 		writel(in->d1, samsung->sabi_iface + SABI_IFACE_DATA + 4);
424 		writew(in->d2, samsung->sabi_iface + SABI_IFACE_DATA + 8);
425 		writeb(in->d3, samsung->sabi_iface + SABI_IFACE_DATA + 10);
426 	}
427 	outb(readb(samsung->sabi + config->header_offsets.iface_func), port);
428 
429 	/* write protect memory to make it safe */
430 	outb(readb(samsung->sabi + config->header_offsets.re_mem), port);
431 
432 	/* see if the command actually succeeded */
433 	complete = readb(samsung->sabi_iface + SABI_IFACE_COMPLETE);
434 	iface_data = readb(samsung->sabi_iface + SABI_IFACE_DATA);
435 
436 	/* iface_data = 0xFF happens when a command is not known
437 	 * so we only add a warning in debug mode since we will
438 	 * probably issue some unknown command at startup to find
439 	 * out which features are supported */
440 	if (complete != 0xaa || (iface_data == 0xff && debug))
441 		pr_warn("SABI command 0x%04x failed with"
442 			" completion flag 0x%02x and interface data 0x%02x",
443 			command, complete, iface_data);
444 
445 	if (complete != 0xaa || iface_data == 0xff) {
446 		ret = -EINVAL;
447 		goto exit;
448 	}
449 
450 	if (out) {
451 		out->d0 = readl(samsung->sabi_iface + SABI_IFACE_DATA);
452 		out->d1 = readl(samsung->sabi_iface + SABI_IFACE_DATA + 4);
453 		out->d2 = readw(samsung->sabi_iface + SABI_IFACE_DATA + 2);
454 		out->d3 = readb(samsung->sabi_iface + SABI_IFACE_DATA + 1);
455 	}
456 
457 	if (debug && out) {
458 		pr_info("SABI return data:{0x%08x, 0x%08x, 0x%04x, 0x%02x}",
459 			out->d0, out->d1, out->d2, out->d3);
460 	}
461 
462 exit:
463 	mutex_unlock(&samsung->sabi_mutex);
464 	return ret;
465 }
466 
467 /* simple wrappers usable with most commands */
468 static int sabi_set_commandb(struct samsung_laptop *samsung,
469 			     u16 command, u8 data)
470 {
471 	struct sabi_data in = { { { .d0 = 0, .d1 = 0, .d2 = 0, .d3 = 0 } } };
472 
473 	in.data[0] = data;
474 	return sabi_command(samsung, command, &in, NULL);
475 }
476 
477 static int read_brightness(struct samsung_laptop *samsung)
478 {
479 	const struct sabi_config *config = samsung->config;
480 	const struct sabi_commands *commands = &samsung->config->commands;
481 	struct sabi_data sretval;
482 	int user_brightness = 0;
483 	int retval;
484 
485 	retval = sabi_command(samsung, commands->get_brightness,
486 			      NULL, &sretval);
487 	if (retval)
488 		return retval;
489 
490 	user_brightness = sretval.data[0];
491 	if (user_brightness > config->min_brightness)
492 		user_brightness -= config->min_brightness;
493 	else
494 		user_brightness = 0;
495 
496 	return user_brightness;
497 }
498 
499 static void set_brightness(struct samsung_laptop *samsung, u8 user_brightness)
500 {
501 	const struct sabi_config *config = samsung->config;
502 	const struct sabi_commands *commands = &samsung->config->commands;
503 	u8 user_level = user_brightness + config->min_brightness;
504 
505 	if (samsung->has_stepping_quirk && user_level != 0) {
506 		/*
507 		 * short circuit if the specified level is what's already set
508 		 * to prevent the screen from flickering needlessly
509 		 */
510 		if (user_brightness == read_brightness(samsung))
511 			return;
512 
513 		sabi_set_commandb(samsung, commands->set_brightness, 0);
514 	}
515 
516 	sabi_set_commandb(samsung, commands->set_brightness, user_level);
517 }
518 
519 static int get_brightness(struct backlight_device *bd)
520 {
521 	struct samsung_laptop *samsung = bl_get_data(bd);
522 
523 	return read_brightness(samsung);
524 }
525 
526 static void check_for_stepping_quirk(struct samsung_laptop *samsung)
527 {
528 	int initial_level;
529 	int check_level;
530 	int orig_level = read_brightness(samsung);
531 
532 	/*
533 	 * Some laptops exhibit the strange behaviour of stepping toward
534 	 * (rather than setting) the brightness except when changing to/from
535 	 * brightness level 0. This behaviour is checked for here and worked
536 	 * around in set_brightness.
537 	 */
538 
539 	if (orig_level == 0)
540 		set_brightness(samsung, 1);
541 
542 	initial_level = read_brightness(samsung);
543 
544 	if (initial_level <= 2)
545 		check_level = initial_level + 2;
546 	else
547 		check_level = initial_level - 2;
548 
549 	samsung->has_stepping_quirk = false;
550 	set_brightness(samsung, check_level);
551 
552 	if (read_brightness(samsung) != check_level) {
553 		samsung->has_stepping_quirk = true;
554 		pr_info("enabled workaround for brightness stepping quirk\n");
555 	}
556 
557 	set_brightness(samsung, orig_level);
558 }
559 
560 static int update_status(struct backlight_device *bd)
561 {
562 	struct samsung_laptop *samsung = bl_get_data(bd);
563 	const struct sabi_commands *commands = &samsung->config->commands;
564 
565 	set_brightness(samsung, bd->props.brightness);
566 
567 	if (bd->props.power == FB_BLANK_UNBLANK)
568 		sabi_set_commandb(samsung, commands->set_backlight, 1);
569 	else
570 		sabi_set_commandb(samsung, commands->set_backlight, 0);
571 
572 	return 0;
573 }
574 
575 static const struct backlight_ops backlight_ops = {
576 	.get_brightness	= get_brightness,
577 	.update_status	= update_status,
578 };
579 
580 static int seclinux_rfkill_set(void *data, bool blocked)
581 {
582 	struct samsung_rfkill *srfkill = data;
583 	struct samsung_laptop *samsung = srfkill->samsung;
584 	const struct sabi_commands *commands = &samsung->config->commands;
585 
586 	return sabi_set_commandb(samsung, commands->set_wireless_button,
587 				 !blocked);
588 }
589 
590 static const struct rfkill_ops seclinux_rfkill_ops = {
591 	.set_block = seclinux_rfkill_set,
592 };
593 
594 static int swsmi_wireless_status(struct samsung_laptop *samsung,
595 				 struct sabi_data *data)
596 {
597 	const struct sabi_commands *commands = &samsung->config->commands;
598 
599 	return sabi_command(samsung, commands->get_wireless_status,
600 			    NULL, data);
601 }
602 
603 static int swsmi_rfkill_set(void *priv, bool blocked)
604 {
605 	struct samsung_rfkill *srfkill = priv;
606 	struct samsung_laptop *samsung = srfkill->samsung;
607 	const struct sabi_commands *commands = &samsung->config->commands;
608 	struct sabi_data data;
609 	int ret, i;
610 
611 	ret = swsmi_wireless_status(samsung, &data);
612 	if (ret)
613 		return ret;
614 
615 	/* Don't set the state for non-present devices */
616 	for (i = 0; i < 4; i++)
617 		if (data.data[i] == 0x02)
618 			data.data[1] = 0;
619 
620 	if (srfkill->type == RFKILL_TYPE_WLAN)
621 		data.data[WL_STATUS_WLAN] = !blocked;
622 	else if (srfkill->type == RFKILL_TYPE_BLUETOOTH)
623 		data.data[WL_STATUS_BT] = !blocked;
624 
625 	return sabi_command(samsung, commands->set_wireless_status,
626 			    &data, &data);
627 }
628 
629 static void swsmi_rfkill_query(struct rfkill *rfkill, void *priv)
630 {
631 	struct samsung_rfkill *srfkill = priv;
632 	struct samsung_laptop *samsung = srfkill->samsung;
633 	struct sabi_data data;
634 	int ret;
635 
636 	ret = swsmi_wireless_status(samsung, &data);
637 	if (ret)
638 		return ;
639 
640 	if (srfkill->type == RFKILL_TYPE_WLAN)
641 		ret = data.data[WL_STATUS_WLAN];
642 	else if (srfkill->type == RFKILL_TYPE_BLUETOOTH)
643 		ret = data.data[WL_STATUS_BT];
644 	else
645 		return ;
646 
647 	rfkill_set_sw_state(rfkill, !ret);
648 }
649 
650 static const struct rfkill_ops swsmi_rfkill_ops = {
651 	.set_block = swsmi_rfkill_set,
652 	.query = swsmi_rfkill_query,
653 };
654 
655 static ssize_t get_performance_level(struct device *dev,
656 				     struct device_attribute *attr, char *buf)
657 {
658 	struct samsung_laptop *samsung = dev_get_drvdata(dev);
659 	const struct sabi_config *config = samsung->config;
660 	const struct sabi_commands *commands = &config->commands;
661 	struct sabi_data sretval;
662 	int retval;
663 	int i;
664 
665 	/* Read the state */
666 	retval = sabi_command(samsung, commands->get_performance_level,
667 			      NULL, &sretval);
668 	if (retval)
669 		return retval;
670 
671 	/* The logic is backwards, yeah, lots of fun... */
672 	for (i = 0; config->performance_levels[i].name; ++i) {
673 		if (sretval.data[0] == config->performance_levels[i].value)
674 			return sprintf(buf, "%s\n", config->performance_levels[i].name);
675 	}
676 	return sprintf(buf, "%s\n", "unknown");
677 }
678 
679 static ssize_t set_performance_level(struct device *dev,
680 				struct device_attribute *attr, const char *buf,
681 				size_t count)
682 {
683 	struct samsung_laptop *samsung = dev_get_drvdata(dev);
684 	const struct sabi_config *config = samsung->config;
685 	const struct sabi_commands *commands = &config->commands;
686 	int i;
687 
688 	if (count < 1)
689 		return count;
690 
691 	for (i = 0; config->performance_levels[i].name; ++i) {
692 		const struct sabi_performance_level *level =
693 			&config->performance_levels[i];
694 		if (!strncasecmp(level->name, buf, strlen(level->name))) {
695 			sabi_set_commandb(samsung,
696 					  commands->set_performance_level,
697 					  level->value);
698 			break;
699 		}
700 	}
701 
702 	if (!config->performance_levels[i].name)
703 		return -EINVAL;
704 
705 	return count;
706 }
707 
708 static DEVICE_ATTR(performance_level, S_IWUSR | S_IRUGO,
709 		   get_performance_level, set_performance_level);
710 
711 static int read_battery_life_extender(struct samsung_laptop *samsung)
712 {
713 	const struct sabi_commands *commands = &samsung->config->commands;
714 	struct sabi_data data;
715 	int retval;
716 
717 	if (commands->get_battery_life_extender == 0xFFFF)
718 		return -ENODEV;
719 
720 	memset(&data, 0, sizeof(data));
721 	data.data[0] = 0x80;
722 	retval = sabi_command(samsung, commands->get_battery_life_extender,
723 			      &data, &data);
724 
725 	if (retval)
726 		return retval;
727 
728 	if (data.data[0] != 0 && data.data[0] != 1)
729 		return -ENODEV;
730 
731 	return data.data[0];
732 }
733 
734 static int write_battery_life_extender(struct samsung_laptop *samsung,
735 				       int enabled)
736 {
737 	const struct sabi_commands *commands = &samsung->config->commands;
738 	struct sabi_data data;
739 
740 	memset(&data, 0, sizeof(data));
741 	data.data[0] = 0x80 | enabled;
742 	return sabi_command(samsung, commands->set_battery_life_extender,
743 			    &data, NULL);
744 }
745 
746 static ssize_t get_battery_life_extender(struct device *dev,
747 					 struct device_attribute *attr,
748 					 char *buf)
749 {
750 	struct samsung_laptop *samsung = dev_get_drvdata(dev);
751 	int ret;
752 
753 	ret = read_battery_life_extender(samsung);
754 	if (ret < 0)
755 		return ret;
756 
757 	return sprintf(buf, "%d\n", ret);
758 }
759 
760 static ssize_t set_battery_life_extender(struct device *dev,
761 					struct device_attribute *attr,
762 					const char *buf, size_t count)
763 {
764 	struct samsung_laptop *samsung = dev_get_drvdata(dev);
765 	int ret, value;
766 
767 	if (!count || kstrtoint(buf, 0, &value) != 0)
768 		return -EINVAL;
769 
770 	ret = write_battery_life_extender(samsung, !!value);
771 	if (ret < 0)
772 		return ret;
773 
774 	return count;
775 }
776 
777 static DEVICE_ATTR(battery_life_extender, S_IWUSR | S_IRUGO,
778 		   get_battery_life_extender, set_battery_life_extender);
779 
780 static int read_usb_charge(struct samsung_laptop *samsung)
781 {
782 	const struct sabi_commands *commands = &samsung->config->commands;
783 	struct sabi_data data;
784 	int retval;
785 
786 	if (commands->get_usb_charge == 0xFFFF)
787 		return -ENODEV;
788 
789 	memset(&data, 0, sizeof(data));
790 	data.data[0] = 0x80;
791 	retval = sabi_command(samsung, commands->get_usb_charge,
792 			      &data, &data);
793 
794 	if (retval)
795 		return retval;
796 
797 	if (data.data[0] != 0 && data.data[0] != 1)
798 		return -ENODEV;
799 
800 	return data.data[0];
801 }
802 
803 static int write_usb_charge(struct samsung_laptop *samsung,
804 			    int enabled)
805 {
806 	const struct sabi_commands *commands = &samsung->config->commands;
807 	struct sabi_data data;
808 
809 	memset(&data, 0, sizeof(data));
810 	data.data[0] = 0x80 | enabled;
811 	return sabi_command(samsung, commands->set_usb_charge,
812 			    &data, NULL);
813 }
814 
815 static ssize_t get_usb_charge(struct device *dev,
816 			      struct device_attribute *attr,
817 			      char *buf)
818 {
819 	struct samsung_laptop *samsung = dev_get_drvdata(dev);
820 	int ret;
821 
822 	ret = read_usb_charge(samsung);
823 	if (ret < 0)
824 		return ret;
825 
826 	return sprintf(buf, "%d\n", ret);
827 }
828 
829 static ssize_t set_usb_charge(struct device *dev,
830 			      struct device_attribute *attr,
831 			      const char *buf, size_t count)
832 {
833 	struct samsung_laptop *samsung = dev_get_drvdata(dev);
834 	int ret, value;
835 
836 	if (!count || kstrtoint(buf, 0, &value) != 0)
837 		return -EINVAL;
838 
839 	ret = write_usb_charge(samsung, !!value);
840 	if (ret < 0)
841 		return ret;
842 
843 	return count;
844 }
845 
846 static DEVICE_ATTR(usb_charge, S_IWUSR | S_IRUGO,
847 		   get_usb_charge, set_usb_charge);
848 
849 static int read_lid_handling(struct samsung_laptop *samsung)
850 {
851 	const struct sabi_commands *commands = &samsung->config->commands;
852 	struct sabi_data data;
853 	int retval;
854 
855 	if (commands->get_lid_handling == 0xFFFF)
856 		return -ENODEV;
857 
858 	memset(&data, 0, sizeof(data));
859 	retval = sabi_command(samsung, commands->get_lid_handling,
860 			      &data, &data);
861 
862 	if (retval)
863 		return retval;
864 
865 	return data.data[0] & 0x1;
866 }
867 
868 static int write_lid_handling(struct samsung_laptop *samsung,
869 			      int enabled)
870 {
871 	const struct sabi_commands *commands = &samsung->config->commands;
872 	struct sabi_data data;
873 
874 	memset(&data, 0, sizeof(data));
875 	data.data[0] = 0x80 | enabled;
876 	return sabi_command(samsung, commands->set_lid_handling,
877 			    &data, NULL);
878 }
879 
880 static ssize_t get_lid_handling(struct device *dev,
881 				struct device_attribute *attr,
882 				char *buf)
883 {
884 	struct samsung_laptop *samsung = dev_get_drvdata(dev);
885 	int ret;
886 
887 	ret = read_lid_handling(samsung);
888 	if (ret < 0)
889 		return ret;
890 
891 	return sprintf(buf, "%d\n", ret);
892 }
893 
894 static ssize_t set_lid_handling(struct device *dev,
895 				struct device_attribute *attr,
896 				const char *buf, size_t count)
897 {
898 	struct samsung_laptop *samsung = dev_get_drvdata(dev);
899 	int ret, value;
900 
901 	if (!count || kstrtoint(buf, 0, &value) != 0)
902 		return -EINVAL;
903 
904 	ret = write_lid_handling(samsung, !!value);
905 	if (ret < 0)
906 		return ret;
907 
908 	return count;
909 }
910 
911 static DEVICE_ATTR(lid_handling, S_IWUSR | S_IRUGO,
912 		   get_lid_handling, set_lid_handling);
913 
914 static struct attribute *platform_attributes[] = {
915 	&dev_attr_performance_level.attr,
916 	&dev_attr_battery_life_extender.attr,
917 	&dev_attr_usb_charge.attr,
918 	&dev_attr_lid_handling.attr,
919 	NULL
920 };
921 
922 static int find_signature(void __iomem *memcheck, const char *testStr)
923 {
924 	int i = 0;
925 	int loca;
926 
927 	for (loca = 0; loca < 0xffff; loca++) {
928 		char temp = readb(memcheck + loca);
929 
930 		if (temp == testStr[i]) {
931 			if (i == strlen(testStr)-1)
932 				break;
933 			++i;
934 		} else {
935 			i = 0;
936 		}
937 	}
938 	return loca;
939 }
940 
941 static void samsung_rfkill_exit(struct samsung_laptop *samsung)
942 {
943 	if (samsung->wlan.rfkill) {
944 		rfkill_unregister(samsung->wlan.rfkill);
945 		rfkill_destroy(samsung->wlan.rfkill);
946 		samsung->wlan.rfkill = NULL;
947 	}
948 	if (samsung->bluetooth.rfkill) {
949 		rfkill_unregister(samsung->bluetooth.rfkill);
950 		rfkill_destroy(samsung->bluetooth.rfkill);
951 		samsung->bluetooth.rfkill = NULL;
952 	}
953 }
954 
955 static int samsung_new_rfkill(struct samsung_laptop *samsung,
956 			      struct samsung_rfkill *arfkill,
957 			      const char *name, enum rfkill_type type,
958 			      const struct rfkill_ops *ops,
959 			      int blocked)
960 {
961 	struct rfkill **rfkill = &arfkill->rfkill;
962 	int ret;
963 
964 	arfkill->type = type;
965 	arfkill->samsung = samsung;
966 
967 	*rfkill = rfkill_alloc(name, &samsung->platform_device->dev,
968 			       type, ops, arfkill);
969 
970 	if (!*rfkill)
971 		return -EINVAL;
972 
973 	if (blocked != -1)
974 		rfkill_init_sw_state(*rfkill, blocked);
975 
976 	ret = rfkill_register(*rfkill);
977 	if (ret) {
978 		rfkill_destroy(*rfkill);
979 		*rfkill = NULL;
980 		return ret;
981 	}
982 	return 0;
983 }
984 
985 static int __init samsung_rfkill_init_seclinux(struct samsung_laptop *samsung)
986 {
987 	return samsung_new_rfkill(samsung, &samsung->wlan, "samsung-wlan",
988 				  RFKILL_TYPE_WLAN, &seclinux_rfkill_ops, -1);
989 }
990 
991 static int __init samsung_rfkill_init_swsmi(struct samsung_laptop *samsung)
992 {
993 	struct sabi_data data;
994 	int ret;
995 
996 	ret = swsmi_wireless_status(samsung, &data);
997 	if (ret) {
998 		/* Some swsmi laptops use the old seclinux way to control
999 		 * wireless devices */
1000 		if (ret == -EINVAL)
1001 			ret = samsung_rfkill_init_seclinux(samsung);
1002 		return ret;
1003 	}
1004 
1005 	/* 0x02 seems to mean that the device is no present/available */
1006 
1007 	if (data.data[WL_STATUS_WLAN] != 0x02)
1008 		ret = samsung_new_rfkill(samsung, &samsung->wlan,
1009 					 "samsung-wlan",
1010 					 RFKILL_TYPE_WLAN,
1011 					 &swsmi_rfkill_ops,
1012 					 !data.data[WL_STATUS_WLAN]);
1013 	if (ret)
1014 		goto exit;
1015 
1016 	if (data.data[WL_STATUS_BT] != 0x02)
1017 		ret = samsung_new_rfkill(samsung, &samsung->bluetooth,
1018 					 "samsung-bluetooth",
1019 					 RFKILL_TYPE_BLUETOOTH,
1020 					 &swsmi_rfkill_ops,
1021 					 !data.data[WL_STATUS_BT]);
1022 	if (ret)
1023 		goto exit;
1024 
1025 exit:
1026 	if (ret)
1027 		samsung_rfkill_exit(samsung);
1028 
1029 	return ret;
1030 }
1031 
1032 static int __init samsung_rfkill_init(struct samsung_laptop *samsung)
1033 {
1034 	if (samsung->config->sabi_version == 2)
1035 		return samsung_rfkill_init_seclinux(samsung);
1036 	if (samsung->config->sabi_version == 3)
1037 		return samsung_rfkill_init_swsmi(samsung);
1038 	return 0;
1039 }
1040 
1041 static void samsung_lid_handling_exit(struct samsung_laptop *samsung)
1042 {
1043 	if (samsung->quirks->lid_handling)
1044 		write_lid_handling(samsung, 0);
1045 }
1046 
1047 static int __init samsung_lid_handling_init(struct samsung_laptop *samsung)
1048 {
1049 	int retval = 0;
1050 
1051 	if (samsung->quirks->lid_handling)
1052 		retval = write_lid_handling(samsung, 1);
1053 
1054 	return retval;
1055 }
1056 
1057 static int kbd_backlight_enable(struct samsung_laptop *samsung)
1058 {
1059 	const struct sabi_commands *commands = &samsung->config->commands;
1060 	struct sabi_data data;
1061 	int retval;
1062 
1063 	if (commands->kbd_backlight == 0xFFFF)
1064 		return -ENODEV;
1065 
1066 	memset(&data, 0, sizeof(data));
1067 	data.d0 = 0xaabb;
1068 	retval = sabi_command(samsung, commands->kbd_backlight,
1069 			      &data, &data);
1070 
1071 	if (retval)
1072 		return retval;
1073 
1074 	if (data.d0 != 0xccdd)
1075 		return -ENODEV;
1076 	return 0;
1077 }
1078 
1079 static int kbd_backlight_read(struct samsung_laptop *samsung)
1080 {
1081 	const struct sabi_commands *commands = &samsung->config->commands;
1082 	struct sabi_data data;
1083 	int retval;
1084 
1085 	memset(&data, 0, sizeof(data));
1086 	data.data[0] = 0x81;
1087 	retval = sabi_command(samsung, commands->kbd_backlight,
1088 			      &data, &data);
1089 
1090 	if (retval)
1091 		return retval;
1092 
1093 	return data.data[0];
1094 }
1095 
1096 static int kbd_backlight_write(struct samsung_laptop *samsung, int brightness)
1097 {
1098 	const struct sabi_commands *commands = &samsung->config->commands;
1099 	struct sabi_data data;
1100 
1101 	memset(&data, 0, sizeof(data));
1102 	data.d0 = 0x82 | ((brightness & 0xFF) << 8);
1103 	return sabi_command(samsung, commands->kbd_backlight,
1104 			    &data, NULL);
1105 }
1106 
1107 static void kbd_led_update(struct work_struct *work)
1108 {
1109 	struct samsung_laptop *samsung;
1110 
1111 	samsung = container_of(work, struct samsung_laptop, kbd_led_work);
1112 	kbd_backlight_write(samsung, samsung->kbd_led_wk);
1113 }
1114 
1115 static void kbd_led_set(struct led_classdev *led_cdev,
1116 			enum led_brightness value)
1117 {
1118 	struct samsung_laptop *samsung;
1119 
1120 	samsung = container_of(led_cdev, struct samsung_laptop, kbd_led);
1121 
1122 	if (value > samsung->kbd_led.max_brightness)
1123 		value = samsung->kbd_led.max_brightness;
1124 	else if (value < 0)
1125 		value = 0;
1126 
1127 	samsung->kbd_led_wk = value;
1128 	queue_work(samsung->led_workqueue, &samsung->kbd_led_work);
1129 }
1130 
1131 static enum led_brightness kbd_led_get(struct led_classdev *led_cdev)
1132 {
1133 	struct samsung_laptop *samsung;
1134 
1135 	samsung = container_of(led_cdev, struct samsung_laptop, kbd_led);
1136 	return kbd_backlight_read(samsung);
1137 }
1138 
1139 static void samsung_leds_exit(struct samsung_laptop *samsung)
1140 {
1141 	if (!IS_ERR_OR_NULL(samsung->kbd_led.dev))
1142 		led_classdev_unregister(&samsung->kbd_led);
1143 	if (samsung->led_workqueue)
1144 		destroy_workqueue(samsung->led_workqueue);
1145 }
1146 
1147 static int __init samsung_leds_init(struct samsung_laptop *samsung)
1148 {
1149 	int ret = 0;
1150 
1151 	samsung->led_workqueue = create_singlethread_workqueue("led_workqueue");
1152 	if (!samsung->led_workqueue)
1153 		return -ENOMEM;
1154 
1155 	if (kbd_backlight_enable(samsung) >= 0) {
1156 		INIT_WORK(&samsung->kbd_led_work, kbd_led_update);
1157 
1158 		samsung->kbd_led.name = "samsung::kbd_backlight";
1159 		samsung->kbd_led.brightness_set = kbd_led_set;
1160 		samsung->kbd_led.brightness_get = kbd_led_get;
1161 		samsung->kbd_led.max_brightness = 8;
1162 		if (samsung->quirks->four_kbd_backlight_levels)
1163 			samsung->kbd_led.max_brightness = 4;
1164 
1165 		ret = led_classdev_register(&samsung->platform_device->dev,
1166 					   &samsung->kbd_led);
1167 	}
1168 
1169 	if (ret)
1170 		samsung_leds_exit(samsung);
1171 
1172 	return ret;
1173 }
1174 
1175 static void samsung_backlight_exit(struct samsung_laptop *samsung)
1176 {
1177 	if (samsung->backlight_device) {
1178 		backlight_device_unregister(samsung->backlight_device);
1179 		samsung->backlight_device = NULL;
1180 	}
1181 }
1182 
1183 static int __init samsung_backlight_init(struct samsung_laptop *samsung)
1184 {
1185 	struct backlight_device *bd;
1186 	struct backlight_properties props;
1187 
1188 	if (!samsung->handle_backlight)
1189 		return 0;
1190 
1191 	memset(&props, 0, sizeof(struct backlight_properties));
1192 	props.type = BACKLIGHT_PLATFORM;
1193 	props.max_brightness = samsung->config->max_brightness -
1194 		samsung->config->min_brightness;
1195 
1196 	bd = backlight_device_register("samsung",
1197 				       &samsung->platform_device->dev,
1198 				       samsung, &backlight_ops,
1199 				       &props);
1200 	if (IS_ERR(bd))
1201 		return PTR_ERR(bd);
1202 
1203 	samsung->backlight_device = bd;
1204 	samsung->backlight_device->props.brightness = read_brightness(samsung);
1205 	samsung->backlight_device->props.power = FB_BLANK_UNBLANK;
1206 	backlight_update_status(samsung->backlight_device);
1207 
1208 	return 0;
1209 }
1210 
1211 static umode_t samsung_sysfs_is_visible(struct kobject *kobj,
1212 					struct attribute *attr, int idx)
1213 {
1214 	struct device *dev = container_of(kobj, struct device, kobj);
1215 	struct samsung_laptop *samsung = dev_get_drvdata(dev);
1216 	bool ok = true;
1217 
1218 	if (attr == &dev_attr_performance_level.attr)
1219 		ok = !!samsung->config->performance_levels[0].name;
1220 	if (attr == &dev_attr_battery_life_extender.attr)
1221 		ok = !!(read_battery_life_extender(samsung) >= 0);
1222 	if (attr == &dev_attr_usb_charge.attr)
1223 		ok = !!(read_usb_charge(samsung) >= 0);
1224 	if (attr == &dev_attr_lid_handling.attr)
1225 		ok = !!(read_lid_handling(samsung) >= 0);
1226 
1227 	return ok ? attr->mode : 0;
1228 }
1229 
1230 static const struct attribute_group platform_attribute_group = {
1231 	.is_visible = samsung_sysfs_is_visible,
1232 	.attrs = platform_attributes
1233 };
1234 
1235 static void samsung_sysfs_exit(struct samsung_laptop *samsung)
1236 {
1237 	struct platform_device *device = samsung->platform_device;
1238 
1239 	sysfs_remove_group(&device->dev.kobj, &platform_attribute_group);
1240 }
1241 
1242 static int __init samsung_sysfs_init(struct samsung_laptop *samsung)
1243 {
1244 	struct platform_device *device = samsung->platform_device;
1245 
1246 	return sysfs_create_group(&device->dev.kobj, &platform_attribute_group);
1247 
1248 }
1249 
1250 static int samsung_laptop_call_show(struct seq_file *m, void *data)
1251 {
1252 	struct samsung_laptop *samsung = m->private;
1253 	struct sabi_data *sdata = &samsung->debug.data;
1254 	int ret;
1255 
1256 	seq_printf(m, "SABI 0x%04x {0x%08x, 0x%08x, 0x%04x, 0x%02x}\n",
1257 		   samsung->debug.command,
1258 		   sdata->d0, sdata->d1, sdata->d2, sdata->d3);
1259 
1260 	ret = sabi_command(samsung, samsung->debug.command, sdata, sdata);
1261 
1262 	if (ret) {
1263 		seq_printf(m, "SABI command 0x%04x failed\n",
1264 			   samsung->debug.command);
1265 		return ret;
1266 	}
1267 
1268 	seq_printf(m, "SABI {0x%08x, 0x%08x, 0x%04x, 0x%02x}\n",
1269 		   sdata->d0, sdata->d1, sdata->d2, sdata->d3);
1270 	return 0;
1271 }
1272 DEFINE_SHOW_ATTRIBUTE(samsung_laptop_call);
1273 
1274 static void samsung_debugfs_exit(struct samsung_laptop *samsung)
1275 {
1276 	debugfs_remove_recursive(samsung->debug.root);
1277 }
1278 
1279 static void samsung_debugfs_init(struct samsung_laptop *samsung)
1280 {
1281 	struct dentry *root;
1282 
1283 	root = debugfs_create_dir("samsung-laptop", NULL);
1284 	samsung->debug.root = root;
1285 
1286 	samsung->debug.f0000_wrapper.data = samsung->f0000_segment;
1287 	samsung->debug.f0000_wrapper.size = 0xffff;
1288 
1289 	samsung->debug.data_wrapper.data = &samsung->debug.data;
1290 	samsung->debug.data_wrapper.size = sizeof(samsung->debug.data);
1291 
1292 	samsung->debug.sdiag_wrapper.data = samsung->sdiag;
1293 	samsung->debug.sdiag_wrapper.size = strlen(samsung->sdiag);
1294 
1295 	debugfs_create_u16("command", S_IRUGO | S_IWUSR, root,
1296 			   &samsung->debug.command);
1297 	debugfs_create_u32("d0", S_IRUGO | S_IWUSR, root,
1298 			   &samsung->debug.data.d0);
1299 	debugfs_create_u32("d1", S_IRUGO | S_IWUSR, root,
1300 			   &samsung->debug.data.d1);
1301 	debugfs_create_u16("d2", S_IRUGO | S_IWUSR, root,
1302 			   &samsung->debug.data.d2);
1303 	debugfs_create_u8("d3", S_IRUGO | S_IWUSR, root,
1304 			  &samsung->debug.data.d3);
1305 	debugfs_create_blob("data", S_IRUGO | S_IWUSR, root,
1306 			    &samsung->debug.data_wrapper);
1307 	debugfs_create_blob("f0000_segment", S_IRUSR | S_IWUSR, root,
1308 			    &samsung->debug.f0000_wrapper);
1309 	debugfs_create_file("call", S_IFREG | S_IRUGO, root, samsung,
1310 			    &samsung_laptop_call_fops);
1311 	debugfs_create_blob("sdiag", S_IRUGO | S_IWUSR, root,
1312 			    &samsung->debug.sdiag_wrapper);
1313 }
1314 
1315 static void samsung_sabi_exit(struct samsung_laptop *samsung)
1316 {
1317 	const struct sabi_config *config = samsung->config;
1318 
1319 	/* Turn off "Linux" mode in the BIOS */
1320 	if (config && config->commands.set_linux != 0xff)
1321 		sabi_set_commandb(samsung, config->commands.set_linux, 0x80);
1322 
1323 	if (samsung->sabi_iface) {
1324 		iounmap(samsung->sabi_iface);
1325 		samsung->sabi_iface = NULL;
1326 	}
1327 	if (samsung->f0000_segment) {
1328 		iounmap(samsung->f0000_segment);
1329 		samsung->f0000_segment = NULL;
1330 	}
1331 
1332 	samsung->config = NULL;
1333 }
1334 
1335 static __init void samsung_sabi_infos(struct samsung_laptop *samsung, int loca,
1336 				      unsigned int ifaceP)
1337 {
1338 	const struct sabi_config *config = samsung->config;
1339 
1340 	printk(KERN_DEBUG "This computer supports SABI==%x\n",
1341 	       loca + 0xf0000 - 6);
1342 
1343 	printk(KERN_DEBUG "SABI header:\n");
1344 	printk(KERN_DEBUG " SMI Port Number = 0x%04x\n",
1345 	       readw(samsung->sabi + config->header_offsets.port));
1346 	printk(KERN_DEBUG " SMI Interface Function = 0x%02x\n",
1347 	       readb(samsung->sabi + config->header_offsets.iface_func));
1348 	printk(KERN_DEBUG " SMI enable memory buffer = 0x%02x\n",
1349 	       readb(samsung->sabi + config->header_offsets.en_mem));
1350 	printk(KERN_DEBUG " SMI restore memory buffer = 0x%02x\n",
1351 	       readb(samsung->sabi + config->header_offsets.re_mem));
1352 	printk(KERN_DEBUG " SABI data offset = 0x%04x\n",
1353 	       readw(samsung->sabi + config->header_offsets.data_offset));
1354 	printk(KERN_DEBUG " SABI data segment = 0x%04x\n",
1355 	       readw(samsung->sabi + config->header_offsets.data_segment));
1356 
1357 	printk(KERN_DEBUG " SABI pointer = 0x%08x\n", ifaceP);
1358 }
1359 
1360 static void __init samsung_sabi_diag(struct samsung_laptop *samsung)
1361 {
1362 	int loca = find_signature(samsung->f0000_segment, "SDiaG@");
1363 	int i;
1364 
1365 	if (loca == 0xffff)
1366 		return ;
1367 
1368 	/* Example:
1369 	 * Ident: @SDiaG@686XX-N90X3A/966-SEC-07HL-S90X3A
1370 	 *
1371 	 * Product name: 90X3A
1372 	 * BIOS Version: 07HL
1373 	 */
1374 	loca += 1;
1375 	for (i = 0; loca < 0xffff && i < sizeof(samsung->sdiag) - 1; loca++) {
1376 		char temp = readb(samsung->f0000_segment + loca);
1377 
1378 		if (isalnum(temp) || temp == '/' || temp == '-')
1379 			samsung->sdiag[i++] = temp;
1380 		else
1381 			break ;
1382 	}
1383 
1384 	if (debug && samsung->sdiag[0])
1385 		pr_info("sdiag: %s", samsung->sdiag);
1386 }
1387 
1388 static int __init samsung_sabi_init(struct samsung_laptop *samsung)
1389 {
1390 	const struct sabi_config *config = NULL;
1391 	const struct sabi_commands *commands;
1392 	unsigned int ifaceP;
1393 	int loca = 0xffff;
1394 	int ret = 0;
1395 	int i;
1396 
1397 	samsung->f0000_segment = ioremap(0xf0000, 0xffff);
1398 	if (!samsung->f0000_segment) {
1399 		if (debug || force)
1400 			pr_err("Can't map the segment at 0xf0000\n");
1401 		ret = -EINVAL;
1402 		goto exit;
1403 	}
1404 
1405 	samsung_sabi_diag(samsung);
1406 
1407 	/* Try to find one of the signatures in memory to find the header */
1408 	for (i = 0; sabi_configs[i].test_string != NULL; ++i) {
1409 		samsung->config = &sabi_configs[i];
1410 		loca = find_signature(samsung->f0000_segment,
1411 				      samsung->config->test_string);
1412 		if (loca != 0xffff)
1413 			break;
1414 	}
1415 
1416 	if (loca == 0xffff) {
1417 		if (debug || force)
1418 			pr_err("This computer does not support SABI\n");
1419 		ret = -ENODEV;
1420 		goto exit;
1421 	}
1422 
1423 	config = samsung->config;
1424 	commands = &config->commands;
1425 
1426 	/* point to the SMI port Number */
1427 	loca += 1;
1428 	samsung->sabi = (samsung->f0000_segment + loca);
1429 
1430 	/* Get a pointer to the SABI Interface */
1431 	ifaceP = (readw(samsung->sabi + config->header_offsets.data_segment) & 0x0ffff) << 4;
1432 	ifaceP += readw(samsung->sabi + config->header_offsets.data_offset) & 0x0ffff;
1433 
1434 	if (debug)
1435 		samsung_sabi_infos(samsung, loca, ifaceP);
1436 
1437 	samsung->sabi_iface = ioremap(ifaceP, 16);
1438 	if (!samsung->sabi_iface) {
1439 		pr_err("Can't remap %x\n", ifaceP);
1440 		ret = -EINVAL;
1441 		goto exit;
1442 	}
1443 
1444 	/* Turn on "Linux" mode in the BIOS */
1445 	if (commands->set_linux != 0xff) {
1446 		int retval = sabi_set_commandb(samsung,
1447 					       commands->set_linux, 0x81);
1448 		if (retval) {
1449 			pr_warn("Linux mode was not set!\n");
1450 			ret = -ENODEV;
1451 			goto exit;
1452 		}
1453 	}
1454 
1455 	/* Check for stepping quirk */
1456 	if (samsung->handle_backlight)
1457 		check_for_stepping_quirk(samsung);
1458 
1459 	pr_info("detected SABI interface: %s\n",
1460 		samsung->config->test_string);
1461 
1462 exit:
1463 	if (ret)
1464 		samsung_sabi_exit(samsung);
1465 
1466 	return ret;
1467 }
1468 
1469 static void samsung_platform_exit(struct samsung_laptop *samsung)
1470 {
1471 	if (samsung->platform_device) {
1472 		platform_device_unregister(samsung->platform_device);
1473 		samsung->platform_device = NULL;
1474 	}
1475 }
1476 
1477 static int samsung_pm_notification(struct notifier_block *nb,
1478 				   unsigned long val, void *ptr)
1479 {
1480 	struct samsung_laptop *samsung;
1481 
1482 	samsung = container_of(nb, struct samsung_laptop, pm_nb);
1483 	if (val == PM_POST_HIBERNATION &&
1484 	    samsung->quirks->enable_kbd_backlight)
1485 		kbd_backlight_enable(samsung);
1486 
1487 	if (val == PM_POST_HIBERNATION && samsung->quirks->lid_handling)
1488 		write_lid_handling(samsung, 1);
1489 
1490 	return 0;
1491 }
1492 
1493 static int __init samsung_platform_init(struct samsung_laptop *samsung)
1494 {
1495 	struct platform_device *pdev;
1496 
1497 	pdev = platform_device_register_simple("samsung", -1, NULL, 0);
1498 	if (IS_ERR(pdev))
1499 		return PTR_ERR(pdev);
1500 
1501 	samsung->platform_device = pdev;
1502 	platform_set_drvdata(samsung->platform_device, samsung);
1503 	return 0;
1504 }
1505 
1506 static struct samsung_quirks *quirks;
1507 
1508 static int __init samsung_dmi_matched(const struct dmi_system_id *d)
1509 {
1510 	quirks = d->driver_data;
1511 	return 0;
1512 }
1513 
1514 static const struct dmi_system_id samsung_dmi_table[] __initconst = {
1515 	{
1516 		.matches = {
1517 			DMI_MATCH(DMI_SYS_VENDOR,
1518 					"SAMSUNG ELECTRONICS CO., LTD."),
1519 			DMI_MATCH(DMI_CHASSIS_TYPE, "8"), /* Portable */
1520 		},
1521 	},
1522 	{
1523 		.matches = {
1524 			DMI_MATCH(DMI_SYS_VENDOR,
1525 					"SAMSUNG ELECTRONICS CO., LTD."),
1526 			DMI_MATCH(DMI_CHASSIS_TYPE, "9"), /* Laptop */
1527 		},
1528 	},
1529 	{
1530 		.matches = {
1531 			DMI_MATCH(DMI_SYS_VENDOR,
1532 					"SAMSUNG ELECTRONICS CO., LTD."),
1533 			DMI_MATCH(DMI_CHASSIS_TYPE, "10"), /* Notebook */
1534 		},
1535 	},
1536 	{
1537 		.matches = {
1538 			DMI_MATCH(DMI_SYS_VENDOR,
1539 					"SAMSUNG ELECTRONICS CO., LTD."),
1540 			DMI_MATCH(DMI_CHASSIS_TYPE, "14"), /* Sub-Notebook */
1541 		},
1542 	},
1543 	/* DMI ids for laptops with bad Chassis Type */
1544 	{
1545 	  .ident = "R40/R41",
1546 	  .matches = {
1547 		DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD."),
1548 		DMI_MATCH(DMI_PRODUCT_NAME, "R40/R41"),
1549 		DMI_MATCH(DMI_BOARD_NAME, "R40/R41"),
1550 		},
1551 	},
1552 	/* Specific DMI ids for laptop with quirks */
1553 	{
1554 	 .callback = samsung_dmi_matched,
1555 	 .ident = "N150P",
1556 	 .matches = {
1557 		DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD."),
1558 		DMI_MATCH(DMI_PRODUCT_NAME, "N150P"),
1559 		DMI_MATCH(DMI_BOARD_NAME, "N150P"),
1560 		},
1561 	 .driver_data = &samsung_use_native_backlight,
1562 	},
1563 	{
1564 	 .callback = samsung_dmi_matched,
1565 	 .ident = "N145P/N250P/N260P",
1566 	 .matches = {
1567 		DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD."),
1568 		DMI_MATCH(DMI_PRODUCT_NAME, "N145P/N250P/N260P"),
1569 		DMI_MATCH(DMI_BOARD_NAME, "N145P/N250P/N260P"),
1570 		},
1571 	 .driver_data = &samsung_use_native_backlight,
1572 	},
1573 	{
1574 	 .callback = samsung_dmi_matched,
1575 	 .ident = "N150/N210/N220",
1576 	 .matches = {
1577 		DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD."),
1578 		DMI_MATCH(DMI_PRODUCT_NAME, "N150/N210/N220"),
1579 		DMI_MATCH(DMI_BOARD_NAME, "N150/N210/N220"),
1580 		},
1581 	 .driver_data = &samsung_broken_acpi_video,
1582 	},
1583 	{
1584 	 .callback = samsung_dmi_matched,
1585 	 .ident = "NF110/NF210/NF310",
1586 	 .matches = {
1587 		DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD."),
1588 		DMI_MATCH(DMI_PRODUCT_NAME, "NF110/NF210/NF310"),
1589 		DMI_MATCH(DMI_BOARD_NAME, "NF110/NF210/NF310"),
1590 		},
1591 	 .driver_data = &samsung_broken_acpi_video,
1592 	},
1593 	{
1594 	 .callback = samsung_dmi_matched,
1595 	 .ident = "X360",
1596 	 .matches = {
1597 		DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD."),
1598 		DMI_MATCH(DMI_PRODUCT_NAME, "X360"),
1599 		DMI_MATCH(DMI_BOARD_NAME, "X360"),
1600 		},
1601 	 .driver_data = &samsung_broken_acpi_video,
1602 	},
1603 	{
1604 	 .callback = samsung_dmi_matched,
1605 	 .ident = "N250P",
1606 	 .matches = {
1607 		DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD."),
1608 		DMI_MATCH(DMI_PRODUCT_NAME, "N250P"),
1609 		DMI_MATCH(DMI_BOARD_NAME, "N250P"),
1610 		},
1611 	 .driver_data = &samsung_use_native_backlight,
1612 	},
1613 	{
1614 	 .callback = samsung_dmi_matched,
1615 	 .ident = "NC210",
1616 	 .matches = {
1617 		DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD."),
1618 		DMI_MATCH(DMI_PRODUCT_NAME, "NC210/NC110"),
1619 		DMI_MATCH(DMI_BOARD_NAME, "NC210/NC110"),
1620 		},
1621 	 .driver_data = &samsung_broken_acpi_video,
1622 	},
1623 	{
1624 	 .callback = samsung_dmi_matched,
1625 	 .ident = "730U3E/740U3E",
1626 	 .matches = {
1627 		DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD."),
1628 		DMI_MATCH(DMI_PRODUCT_NAME, "730U3E/740U3E"),
1629 		},
1630 	 .driver_data = &samsung_np740u3e,
1631 	},
1632 	{
1633 	 .callback = samsung_dmi_matched,
1634 	 .ident = "300V3Z/300V4Z/300V5Z",
1635 	 .matches = {
1636 		DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD."),
1637 		DMI_MATCH(DMI_PRODUCT_NAME, "300V3Z/300V4Z/300V5Z"),
1638 		},
1639 	 .driver_data = &samsung_lid_handling,
1640 	},
1641 	{ },
1642 };
1643 MODULE_DEVICE_TABLE(dmi, samsung_dmi_table);
1644 
1645 static struct platform_device *samsung_platform_device;
1646 
1647 static int __init samsung_init(void)
1648 {
1649 	struct samsung_laptop *samsung;
1650 	int ret;
1651 
1652 	if (efi_enabled(EFI_BOOT))
1653 		return -ENODEV;
1654 
1655 	quirks = &samsung_unknown;
1656 	if (!force && !dmi_check_system(samsung_dmi_table))
1657 		return -ENODEV;
1658 
1659 	samsung = kzalloc(sizeof(*samsung), GFP_KERNEL);
1660 	if (!samsung)
1661 		return -ENOMEM;
1662 
1663 	mutex_init(&samsung->sabi_mutex);
1664 	samsung->handle_backlight = true;
1665 	samsung->quirks = quirks;
1666 
1667 #ifdef CONFIG_ACPI
1668 	if (samsung->quirks->broken_acpi_video)
1669 		acpi_video_set_dmi_backlight_type(acpi_backlight_vendor);
1670 	if (samsung->quirks->use_native_backlight)
1671 		acpi_video_set_dmi_backlight_type(acpi_backlight_native);
1672 
1673 	if (acpi_video_get_backlight_type() != acpi_backlight_vendor)
1674 		samsung->handle_backlight = false;
1675 #endif
1676 
1677 	ret = samsung_platform_init(samsung);
1678 	if (ret)
1679 		goto error_platform;
1680 
1681 	ret = samsung_sabi_init(samsung);
1682 	if (ret)
1683 		goto error_sabi;
1684 
1685 	ret = samsung_sysfs_init(samsung);
1686 	if (ret)
1687 		goto error_sysfs;
1688 
1689 	ret = samsung_backlight_init(samsung);
1690 	if (ret)
1691 		goto error_backlight;
1692 
1693 	ret = samsung_rfkill_init(samsung);
1694 	if (ret)
1695 		goto error_rfkill;
1696 
1697 	ret = samsung_leds_init(samsung);
1698 	if (ret)
1699 		goto error_leds;
1700 
1701 	ret = samsung_lid_handling_init(samsung);
1702 	if (ret)
1703 		goto error_lid_handling;
1704 
1705 	samsung_debugfs_init(samsung);
1706 
1707 	samsung->pm_nb.notifier_call = samsung_pm_notification;
1708 	register_pm_notifier(&samsung->pm_nb);
1709 
1710 	samsung_platform_device = samsung->platform_device;
1711 	return ret;
1712 
1713 error_lid_handling:
1714 	samsung_leds_exit(samsung);
1715 error_leds:
1716 	samsung_rfkill_exit(samsung);
1717 error_rfkill:
1718 	samsung_backlight_exit(samsung);
1719 error_backlight:
1720 	samsung_sysfs_exit(samsung);
1721 error_sysfs:
1722 	samsung_sabi_exit(samsung);
1723 error_sabi:
1724 	samsung_platform_exit(samsung);
1725 error_platform:
1726 	kfree(samsung);
1727 	return ret;
1728 }
1729 
1730 static void __exit samsung_exit(void)
1731 {
1732 	struct samsung_laptop *samsung;
1733 
1734 	samsung = platform_get_drvdata(samsung_platform_device);
1735 	unregister_pm_notifier(&samsung->pm_nb);
1736 
1737 	samsung_debugfs_exit(samsung);
1738 	samsung_lid_handling_exit(samsung);
1739 	samsung_leds_exit(samsung);
1740 	samsung_rfkill_exit(samsung);
1741 	samsung_backlight_exit(samsung);
1742 	samsung_sysfs_exit(samsung);
1743 	samsung_sabi_exit(samsung);
1744 	samsung_platform_exit(samsung);
1745 
1746 	kfree(samsung);
1747 	samsung_platform_device = NULL;
1748 }
1749 
1750 module_init(samsung_init);
1751 module_exit(samsung_exit);
1752 
1753 MODULE_AUTHOR("Greg Kroah-Hartman <gregkh@suse.de>");
1754 MODULE_DESCRIPTION("Samsung Backlight driver");
1755 MODULE_LICENSE("GPL");
1756