Linux Audio

Check our new training course

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