Linux Audio

Check our new training course

Open-source upstreaming

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