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