toshiba_acpi.c 32.9 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5
/*
 *  toshiba_acpi.c - Toshiba Laptop ACPI Extras
 *
 *
 *  Copyright (C) 2002-2004 John Belmonte
6
 *  Copyright (C) 2008 Philip Langdale
7
 *  Copyright (C) 2010 Pierre Ducroquet
L
Linus Torvalds 已提交
8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 *
 *
 *  The devolpment page for this driver is located at
 *  http://memebeam.org/toys/ToshibaAcpiDriver.
 *
 *  Credits:
 *	Jonathan A. Buzzard - Toshiba HCI info, and critical tips on reverse
 *		engineering the Windows drivers
 *	Yasushi Nagato - changes for linux kernel 2.4 -> 2.5
 *	Rob Miller - TV out and hotkeys help
 *
 *
 *  TODO
 *
 */

38 39
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

40
#define TOSHIBA_ACPI_VERSION	"0.19"
L
Linus Torvalds 已提交
41 42 43 44 45 46 47
#define PROC_INTERFACE_VERSION	1

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/types.h>
#include <linux/proc_fs.h>
48
#include <linux/seq_file.h>
49
#include <linux/backlight.h>
50
#include <linux/rfkill.h>
51
#include <linux/input.h>
52
#include <linux/input/sparse-keymap.h>
53
#include <linux/leds.h>
54
#include <linux/slab.h>
55 56
#include <linux/workqueue.h>
#include <linux/i8042.h>
57
#include <linux/acpi.h>
L
Linus Torvalds 已提交
58 59 60 61 62 63
#include <asm/uaccess.h>

MODULE_AUTHOR("John Belmonte");
MODULE_DESCRIPTION("Toshiba Laptop ACPI Extras Driver");
MODULE_LICENSE("GPL");

64 65
#define TOSHIBA_WMI_EVENT_GUID "59142400-C6A3-40FA-BADB-8A2652834100"

66 67 68
/* Scan code for Fn key on TOS1900 models */
#define TOS1900_FN_SCAN		0x6e

L
Linus Torvalds 已提交
69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95
/* Toshiba ACPI method paths */
#define METHOD_VIDEO_OUT	"\\_SB_.VALX.DSSX"

/* Toshiba HCI interface definitions
 *
 * HCI is Toshiba's "Hardware Control Interface" which is supposed to
 * be uniform across all their models.  Ideally we would just call
 * dedicated ACPI methods instead of using this primitive interface.
 * However the ACPI methods seem to be incomplete in some areas (for
 * example they allow setting, but not reading, the LCD brightness value),
 * so this is still useful.
 */

#define HCI_WORDS			6

/* operations */
#define HCI_SET				0xff00
#define HCI_GET				0xfe00

/* return codes */
#define HCI_SUCCESS			0x0000
#define HCI_FAILURE			0x1000
#define HCI_NOT_SUPPORTED		0x8000
#define HCI_EMPTY			0x8c00

/* registers */
#define HCI_FAN				0x0004
96
#define HCI_TR_BACKLIGHT		0x0005
L
Linus Torvalds 已提交
97 98 99 100
#define HCI_SYSTEM_EVENT		0x0016
#define HCI_VIDEO_OUT			0x001c
#define HCI_HOTKEY_EVENT		0x001e
#define HCI_LCD_BRIGHTNESS		0x002a
101
#define HCI_WIRELESS			0x0056
L
Linus Torvalds 已提交
102 103

/* field definitions */
104 105
#define HCI_HOTKEY_DISABLE		0x0b
#define HCI_HOTKEY_ENABLE		0x09
L
Linus Torvalds 已提交
106 107 108 109 110 111
#define HCI_LCD_BRIGHTNESS_BITS		3
#define HCI_LCD_BRIGHTNESS_SHIFT	(16-HCI_LCD_BRIGHTNESS_BITS)
#define HCI_LCD_BRIGHTNESS_LEVELS	(1 << HCI_LCD_BRIGHTNESS_BITS)
#define HCI_VIDEO_OUT_LCD		0x1
#define HCI_VIDEO_OUT_CRT		0x2
#define HCI_VIDEO_OUT_TV		0x4
112 113 114 115
#define HCI_WIRELESS_KILL_SWITCH	0x01
#define HCI_WIRELESS_BT_PRESENT		0x0f
#define HCI_WIRELESS_BT_ATTACH		0x40
#define HCI_WIRELESS_BT_POWER		0x80
L
Linus Torvalds 已提交
116

117 118 119 120 121
struct toshiba_acpi_dev {
	struct acpi_device *acpi_dev;
	const char *method_hci;
	struct rfkill *bt_rfk;
	struct input_dev *hotkey_dev;
122
	struct work_struct hotkey_work;
123 124
	struct backlight_device *backlight_dev;
	struct led_classdev led_dev;
125

126 127 128 129
	int force_fan;
	int last_key_event;
	int key_event_valid;

130 131 132 133
	unsigned int illumination_supported:1;
	unsigned int video_supported:1;
	unsigned int fan_supported:1;
	unsigned int system_event_supported:1;
134 135
	unsigned int ntfy_supported:1;
	unsigned int info_supported:1;
136
	unsigned int tr_backlight_supported:1;
137

138 139 140
	struct mutex mutex;
};

141 142
static struct toshiba_acpi_dev *toshiba_acpi;

143 144
static const struct acpi_device_id toshiba_device_ids[] = {
	{"TOS6200", 0},
145
	{"TOS6208", 0},
146 147 148 149 150
	{"TOS1900", 0},
	{"", 0},
};
MODULE_DEVICE_TABLE(acpi, toshiba_device_ids);

151
static const struct key_entry toshiba_acpi_keymap[] = {
152
	{ KE_KEY, 0x9e, { KEY_RFKILL } },
153 154 155
	{ KE_KEY, 0x101, { KEY_MUTE } },
	{ KE_KEY, 0x102, { KEY_ZOOMOUT } },
	{ KE_KEY, 0x103, { KEY_ZOOMIN } },
156 157
	{ KE_KEY, 0x12c, { KEY_KBDILLUMTOGGLE } },
	{ KE_KEY, 0x139, { KEY_ZOOMRESET } },
158 159 160 161 162 163 164 165
	{ KE_KEY, 0x13b, { KEY_COFFEE } },
	{ KE_KEY, 0x13c, { KEY_BATTERY } },
	{ KE_KEY, 0x13d, { KEY_SLEEP } },
	{ KE_KEY, 0x13e, { KEY_SUSPEND } },
	{ KE_KEY, 0x13f, { KEY_SWITCHVIDEOMODE } },
	{ KE_KEY, 0x140, { KEY_BRIGHTNESSDOWN } },
	{ KE_KEY, 0x141, { KEY_BRIGHTNESSUP } },
	{ KE_KEY, 0x142, { KEY_WLAN } },
166
	{ KE_KEY, 0x143, { KEY_TOUCHPAD_TOGGLE } },
167
	{ KE_KEY, 0x17f, { KEY_FN } },
168 169 170 171 172 173 174 175
	{ KE_KEY, 0xb05, { KEY_PROG2 } },
	{ KE_KEY, 0xb06, { KEY_WWW } },
	{ KE_KEY, 0xb07, { KEY_MAIL } },
	{ KE_KEY, 0xb30, { KEY_STOP } },
	{ KE_KEY, 0xb31, { KEY_PREVIOUSSONG } },
	{ KE_KEY, 0xb32, { KEY_NEXTSONG } },
	{ KE_KEY, 0xb33, { KEY_PLAYPAUSE } },
	{ KE_KEY, 0xb5a, { KEY_MEDIA } },
176
	{ KE_IGNORE, 0x1430, { KEY_RESERVED } },
177
	{ KE_END, 0 },
178 179
};

L
Linus Torvalds 已提交
180 181 182
/* utility
 */

L
Len Brown 已提交
183
static __inline__ void _set_bit(u32 * word, u32 mask, int value)
L
Linus Torvalds 已提交
184 185 186 187 188 189 190
{
	*word = (*word & ~mask) | (mask * value);
}

/* acpi interface wrappers
 */

L
Len Brown 已提交
191
static int write_acpi_int(const char *methodName, int val)
L
Linus Torvalds 已提交
192 193 194
{
	acpi_status status;

195
	status = acpi_execute_simple_method(NULL, (char *)methodName, val);
S
Seth Forshee 已提交
196
	return (status == AE_OK) ? 0 : -EIO;
L
Linus Torvalds 已提交
197 198 199 200 201
}

/* Perform a raw HCI call.  Here we don't care about input or output buffer
 * format.
 */
202 203
static acpi_status hci_raw(struct toshiba_acpi_dev *dev,
			   const u32 in[HCI_WORDS], u32 out[HCI_WORDS])
L
Linus Torvalds 已提交
204 205 206 207
{
	struct acpi_object_list params;
	union acpi_object in_objs[HCI_WORDS];
	struct acpi_buffer results;
L
Len Brown 已提交
208
	union acpi_object out_objs[HCI_WORDS + 1];
L
Linus Torvalds 已提交
209 210 211 212 213 214 215 216 217 218 219 220 221
	acpi_status status;
	int i;

	params.count = HCI_WORDS;
	params.pointer = in_objs;
	for (i = 0; i < HCI_WORDS; ++i) {
		in_objs[i].type = ACPI_TYPE_INTEGER;
		in_objs[i].integer.value = in[i];
	}

	results.length = sizeof(out_objs);
	results.pointer = out_objs;

222 223
	status = acpi_evaluate_object(dev->acpi_dev->handle,
				      (char *)dev->method_hci, &params,
L
Len Brown 已提交
224
				      &results);
L
Linus Torvalds 已提交
225 226 227 228 229 230 231 232 233
	if ((status == AE_OK) && (out_objs->package.count <= HCI_WORDS)) {
		for (i = 0; i < out_objs->package.count; ++i) {
			out[i] = out_objs->package.elements[i].integer.value;
		}
	}

	return status;
}

234
/* common hci tasks (get or set one or two value)
L
Linus Torvalds 已提交
235 236 237 238 239
 *
 * In addition to the ACPI status, the HCI system returns a result which
 * may be useful (such as "not supported").
 */

240 241
static acpi_status hci_write1(struct toshiba_acpi_dev *dev, u32 reg,
			      u32 in1, u32 *result)
L
Linus Torvalds 已提交
242 243 244
{
	u32 in[HCI_WORDS] = { HCI_SET, reg, in1, 0, 0, 0 };
	u32 out[HCI_WORDS];
245
	acpi_status status = hci_raw(dev, in, out);
L
Linus Torvalds 已提交
246 247 248 249
	*result = (status == AE_OK) ? out[0] : HCI_FAILURE;
	return status;
}

250 251
static acpi_status hci_read1(struct toshiba_acpi_dev *dev, u32 reg,
			     u32 *out1, u32 *result)
L
Linus Torvalds 已提交
252 253 254
{
	u32 in[HCI_WORDS] = { HCI_GET, reg, 0, 0, 0, 0 };
	u32 out[HCI_WORDS];
255
	acpi_status status = hci_raw(dev, in, out);
L
Linus Torvalds 已提交
256 257 258 259 260
	*out1 = out[2];
	*result = (status == AE_OK) ? out[0] : HCI_FAILURE;
	return status;
}

261 262
static acpi_status hci_write2(struct toshiba_acpi_dev *dev, u32 reg,
			      u32 in1, u32 in2, u32 *result)
263 264 265
{
	u32 in[HCI_WORDS] = { HCI_SET, reg, in1, in2, 0, 0 };
	u32 out[HCI_WORDS];
266
	acpi_status status = hci_raw(dev, in, out);
267 268 269 270
	*result = (status == AE_OK) ? out[0] : HCI_FAILURE;
	return status;
}

271 272
static acpi_status hci_read2(struct toshiba_acpi_dev *dev, u32 reg,
			     u32 *out1, u32 *out2, u32 *result)
273 274 275
{
	u32 in[HCI_WORDS] = { HCI_GET, reg, *out1, *out2, 0, 0 };
	u32 out[HCI_WORDS];
276
	acpi_status status = hci_raw(dev, in, out);
277 278 279 280 281 282
	*out1 = out[2];
	*out2 = out[3];
	*result = (status == AE_OK) ? out[0] : HCI_FAILURE;
	return status;
}

283
/* Illumination support */
284
static int toshiba_illumination_available(struct toshiba_acpi_dev *dev)
285 286 287 288 289 290
{
	u32 in[HCI_WORDS] = { 0, 0, 0, 0, 0, 0 };
	u32 out[HCI_WORDS];
	acpi_status status;

	in[0] = 0xf100;
291
	status = hci_raw(dev, in, out);
292
	if (ACPI_FAILURE(status)) {
293
		pr_info("Illumination device not available\n");
294 295 296
		return 0;
	}
	in[0] = 0xf400;
297
	status = hci_raw(dev, in, out);
298 299 300 301 302 303
	return 1;
}

static void toshiba_illumination_set(struct led_classdev *cdev,
				     enum led_brightness brightness)
{
304 305
	struct toshiba_acpi_dev *dev = container_of(cdev,
			struct toshiba_acpi_dev, led_dev);
306 307 308 309 310 311
	u32 in[HCI_WORDS] = { 0, 0, 0, 0, 0, 0 };
	u32 out[HCI_WORDS];
	acpi_status status;

	/* First request : initialize communication. */
	in[0] = 0xf100;
312
	status = hci_raw(dev, in, out);
313
	if (ACPI_FAILURE(status)) {
314
		pr_info("Illumination device not available\n");
315 316 317 318 319 320 321 322
		return;
	}

	if (brightness) {
		/* Switch the illumination on */
		in[0] = 0xf400;
		in[1] = 0x14e;
		in[2] = 1;
323
		status = hci_raw(dev, in, out);
324
		if (ACPI_FAILURE(status)) {
325
			pr_info("ACPI call for illumination failed\n");
326 327 328 329 330 331 332
			return;
		}
	} else {
		/* Switch the illumination off */
		in[0] = 0xf400;
		in[1] = 0x14e;
		in[2] = 0;
333
		status = hci_raw(dev, in, out);
334
		if (ACPI_FAILURE(status)) {
335
			pr_info("ACPI call for illumination failed.\n");
336 337 338 339 340 341 342 343
			return;
		}
	}

	/* Last request : close communication. */
	in[0] = 0xf200;
	in[1] = 0;
	in[2] = 0;
344
	hci_raw(dev, in, out);
345 346 347 348
}

static enum led_brightness toshiba_illumination_get(struct led_classdev *cdev)
{
349 350
	struct toshiba_acpi_dev *dev = container_of(cdev,
			struct toshiba_acpi_dev, led_dev);
351 352 353 354 355 356 357
	u32 in[HCI_WORDS] = { 0, 0, 0, 0, 0, 0 };
	u32 out[HCI_WORDS];
	acpi_status status;
	enum led_brightness result;

	/* First request : initialize communication. */
	in[0] = 0xf100;
358
	status = hci_raw(dev, in, out);
359
	if (ACPI_FAILURE(status)) {
360
		pr_info("Illumination device not available\n");
361 362 363 364 365 366
		return LED_OFF;
	}

	/* Check the illumination */
	in[0] = 0xf300;
	in[1] = 0x14e;
367
	status = hci_raw(dev, in, out);
368
	if (ACPI_FAILURE(status)) {
369
		pr_info("ACPI call for illumination failed.\n");
370 371 372 373 374 375 376 377 378
		return LED_OFF;
	}

	result = out[2] ? LED_FULL : LED_OFF;

	/* Last request : close communication. */
	in[0] = 0xf200;
	in[1] = 0;
	in[2] = 0;
379
	hci_raw(dev, in, out);
380 381 382 383

	return result;
}

384 385
/* Bluetooth rfkill handlers */

386
static u32 hci_get_bt_present(struct toshiba_acpi_dev *dev, bool *present)
387 388 389 390 391 392
{
	u32 hci_result;
	u32 value, value2;

	value = 0;
	value2 = 0;
393
	hci_read2(dev, HCI_WIRELESS, &value, &value2, &hci_result);
394 395 396 397 398 399
	if (hci_result == HCI_SUCCESS)
		*present = (value & HCI_WIRELESS_BT_PRESENT) ? true : false;

	return hci_result;
}

400
static u32 hci_get_radio_state(struct toshiba_acpi_dev *dev, bool *radio_state)
401 402 403 404 405 406
{
	u32 hci_result;
	u32 value, value2;

	value = 0;
	value2 = 0x0001;
407
	hci_read2(dev, HCI_WIRELESS, &value, &value2, &hci_result);
408 409 410 411 412

	*radio_state = value & HCI_WIRELESS_KILL_SWITCH;
	return hci_result;
}

J
Johannes Berg 已提交
413
static int bt_rfkill_set_block(void *data, bool blocked)
414
{
J
Johannes Berg 已提交
415
	struct toshiba_acpi_dev *dev = data;
416 417
	u32 result1, result2;
	u32 value;
J
Johannes Berg 已提交
418
	int err;
419 420
	bool radio_state;

J
Johannes Berg 已提交
421
	value = (blocked == false);
422

J
Johannes Berg 已提交
423
	mutex_lock(&dev->mutex);
424
	if (hci_get_radio_state(dev, &radio_state) != HCI_SUCCESS) {
S
Seth Forshee 已提交
425
		err = -EIO;
J
Johannes Berg 已提交
426 427
		goto out;
	}
428

J
Johannes Berg 已提交
429 430 431
	if (!radio_state) {
		err = 0;
		goto out;
432 433
	}

434 435
	hci_write2(dev, HCI_WIRELESS, value, HCI_WIRELESS_BT_POWER, &result1);
	hci_write2(dev, HCI_WIRELESS, value, HCI_WIRELESS_BT_ATTACH, &result2);
436 437

	if (result1 != HCI_SUCCESS || result2 != HCI_SUCCESS)
S
Seth Forshee 已提交
438
		err = -EIO;
J
Johannes Berg 已提交
439 440 441 442 443
	else
		err = 0;
 out:
	mutex_unlock(&dev->mutex);
	return err;
444 445
}

J
Johannes Berg 已提交
446
static void bt_rfkill_poll(struct rfkill *rfkill, void *data)
447 448 449 450
{
	bool new_rfk_state;
	bool value;
	u32 hci_result;
J
Johannes Berg 已提交
451 452 453
	struct toshiba_acpi_dev *dev = data;

	mutex_lock(&dev->mutex);
454

455
	hci_result = hci_get_radio_state(dev, &value);
J
Johannes Berg 已提交
456 457 458
	if (hci_result != HCI_SUCCESS) {
		/* Can't do anything useful */
		mutex_unlock(&dev->mutex);
J
Jiri Slaby 已提交
459
		return;
J
Johannes Berg 已提交
460
	}
461 462 463 464 465

	new_rfk_state = value;

	mutex_unlock(&dev->mutex);

J
Johannes Berg 已提交
466 467
	if (rfkill_set_hw_state(rfkill, !new_rfk_state))
		bt_rfkill_set_block(data, true);
468 469
}

J
Johannes Berg 已提交
470 471 472 473 474
static const struct rfkill_ops toshiba_rfk_ops = {
	.set_block = bt_rfkill_set_block,
	.poll = bt_rfkill_poll,
};

475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493
static int get_tr_backlight_status(struct toshiba_acpi_dev *dev, bool *enabled)
{
	u32 hci_result;
	u32 status;

	hci_read1(dev, HCI_TR_BACKLIGHT, &status, &hci_result);
	*enabled = !status;
	return hci_result == HCI_SUCCESS ? 0 : -EIO;
}

static int set_tr_backlight_status(struct toshiba_acpi_dev *dev, bool enable)
{
	u32 hci_result;
	u32 value = !enable;

	hci_write1(dev, HCI_TR_BACKLIGHT, value, &hci_result);
	return hci_result == HCI_SUCCESS ? 0 : -EIO;
}

L
Len Brown 已提交
494
static struct proc_dir_entry *toshiba_proc_dir /*= 0*/ ;
L
Linus Torvalds 已提交
495

496
static int __get_lcd_brightness(struct toshiba_acpi_dev *dev)
L
Linus Torvalds 已提交
497 498 499
{
	u32 hci_result;
	u32 value;
500 501 502 503 504 505 506 507 508 509 510
	int brightness = 0;

	if (dev->tr_backlight_supported) {
		bool enabled;
		int ret = get_tr_backlight_status(dev, &enabled);
		if (ret)
			return ret;
		if (enabled)
			return 0;
		brightness++;
	}
L
Linus Torvalds 已提交
511

512
	hci_read1(dev, HCI_LCD_BRIGHTNESS, &value, &hci_result);
S
Seth Forshee 已提交
513
	if (hci_result == HCI_SUCCESS)
514
		return brightness + (value >> HCI_LCD_BRIGHTNESS_SHIFT);
S
Seth Forshee 已提交
515 516

	return -EIO;
517 518
}

519 520 521 522 523 524
static int get_lcd_brightness(struct backlight_device *bd)
{
	struct toshiba_acpi_dev *dev = bl_get_data(bd);
	return __get_lcd_brightness(dev);
}

525
static int lcd_proc_show(struct seq_file *m, void *v)
526
{
527 528
	struct toshiba_acpi_dev *dev = m->private;
	int value;
529
	int levels;
530 531 532

	if (!dev->backlight_dev)
		return -ENODEV;
533

534
	levels = dev->backlight_dev->props.max_brightness + 1;
535
	value = get_lcd_brightness(dev->backlight_dev);
536
	if (value >= 0) {
537
		seq_printf(m, "brightness:              %d\n", value);
538
		seq_printf(m, "brightness_levels:       %d\n", levels);
S
Seth Forshee 已提交
539
		return 0;
L
Linus Torvalds 已提交
540 541
	}

S
Seth Forshee 已提交
542 543
	pr_err("Error reading LCD brightness\n");
	return -EIO;
544 545 546 547
}

static int lcd_proc_open(struct inode *inode, struct file *file)
{
A
Al Viro 已提交
548
	return single_open(file, lcd_proc_show, PDE_DATA(inode));
L
Linus Torvalds 已提交
549 550
}

551
static int set_lcd_brightness(struct toshiba_acpi_dev *dev, int value)
552 553 554
{
	u32 hci_result;

555 556 557 558 559 560 561 562 563
	if (dev->tr_backlight_supported) {
		bool enable = !value;
		int ret = set_tr_backlight_status(dev, enable);
		if (ret)
			return ret;
		if (value)
			value--;
	}

564
	value = value << HCI_LCD_BRIGHTNESS_SHIFT;
565
	hci_write1(dev, HCI_LCD_BRIGHTNESS, value, &hci_result);
S
Seth Forshee 已提交
566
	return hci_result == HCI_SUCCESS ? 0 : -EIO;
567 568 569 570
}

static int set_lcd_status(struct backlight_device *bd)
{
571
	struct toshiba_acpi_dev *dev = bl_get_data(bd);
572
	return set_lcd_brightness(dev, bd->props.brightness);
573 574
}

575 576
static ssize_t lcd_proc_write(struct file *file, const char __user *buf,
			      size_t count, loff_t *pos)
L
Linus Torvalds 已提交
577
{
A
Al Viro 已提交
578
	struct toshiba_acpi_dev *dev = PDE_DATA(file_inode(file));
579 580
	char cmd[42];
	size_t len;
L
Linus Torvalds 已提交
581
	int value;
582
	int ret;
583
	int levels = dev->backlight_dev->props.max_brightness + 1;
L
Linus Torvalds 已提交
584

585 586 587 588 589 590
	len = min(count, sizeof(cmd) - 1);
	if (copy_from_user(cmd, buf, len))
		return -EFAULT;
	cmd[len] = '\0';

	if (sscanf(cmd, " brightness : %i", &value) == 1 &&
591
	    value >= 0 && value < levels) {
592
		ret = set_lcd_brightness(dev, value);
593 594 595
		if (ret == 0)
			ret = count;
	} else {
596
		ret = -EINVAL;
597
	}
598
	return ret;
L
Linus Torvalds 已提交
599 600
}

601 602 603 604 605 606 607 608 609
static const struct file_operations lcd_proc_fops = {
	.owner		= THIS_MODULE,
	.open		= lcd_proc_open,
	.read		= seq_read,
	.llseek		= seq_lseek,
	.release	= single_release,
	.write		= lcd_proc_write,
};

610 611 612 613 614 615 616 617
static int get_video_status(struct toshiba_acpi_dev *dev, u32 *status)
{
	u32 hci_result;

	hci_read1(dev, HCI_VIDEO_OUT, status, &hci_result);
	return hci_result == HCI_SUCCESS ? 0 : -EIO;
}

618
static int video_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
619
{
620
	struct toshiba_acpi_dev *dev = m->private;
L
Linus Torvalds 已提交
621
	u32 value;
622
	int ret;
L
Linus Torvalds 已提交
623

624 625
	ret = get_video_status(dev, &value);
	if (!ret) {
L
Linus Torvalds 已提交
626 627
		int is_lcd = (value & HCI_VIDEO_OUT_LCD) ? 1 : 0;
		int is_crt = (value & HCI_VIDEO_OUT_CRT) ? 1 : 0;
L
Len Brown 已提交
628
		int is_tv = (value & HCI_VIDEO_OUT_TV) ? 1 : 0;
629 630 631
		seq_printf(m, "lcd_out:                 %d\n", is_lcd);
		seq_printf(m, "crt_out:                 %d\n", is_crt);
		seq_printf(m, "tv_out:                  %d\n", is_tv);
L
Linus Torvalds 已提交
632 633
	}

634
	return ret;
L
Linus Torvalds 已提交
635 636
}

637
static int video_proc_open(struct inode *inode, struct file *file)
L
Linus Torvalds 已提交
638
{
A
Al Viro 已提交
639
	return single_open(file, video_proc_show, PDE_DATA(inode));
640 641 642 643 644
}

static ssize_t video_proc_write(struct file *file, const char __user *buf,
				size_t count, loff_t *pos)
{
A
Al Viro 已提交
645
	struct toshiba_acpi_dev *dev = PDE_DATA(file_inode(file));
646
	char *cmd, *buffer;
647
	int ret;
L
Linus Torvalds 已提交
648 649 650 651 652
	int value;
	int remain = count;
	int lcd_out = -1;
	int crt_out = -1;
	int tv_out = -1;
A
Al Viro 已提交
653
	u32 video_out;
L
Linus Torvalds 已提交
654

655 656 657 658 659 660 661 662 663 664 665
	cmd = kmalloc(count + 1, GFP_KERNEL);
	if (!cmd)
		return -ENOMEM;
	if (copy_from_user(cmd, buf, count)) {
		kfree(cmd);
		return -EFAULT;
	}
	cmd[count] = '\0';

	buffer = cmd;

L
Linus Torvalds 已提交
666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681
	/* scan expression.  Multiple expressions may be delimited with ;
	 *
	 *  NOTE: to keep scanning simple, invalid fields are ignored
	 */
	while (remain) {
		if (sscanf(buffer, " lcd_out : %i", &value) == 1)
			lcd_out = value & 1;
		else if (sscanf(buffer, " crt_out : %i", &value) == 1)
			crt_out = value & 1;
		else if (sscanf(buffer, " tv_out : %i", &value) == 1)
			tv_out = value & 1;
		/* advance to one character past the next ; */
		do {
			++buffer;
			--remain;
		}
L
Len Brown 已提交
682
		while (remain && *(buffer - 1) != ';');
L
Linus Torvalds 已提交
683 684
	}

685 686
	kfree(cmd);

687 688
	ret = get_video_status(dev, &video_out);
	if (!ret) {
689
		unsigned int new_video_out = video_out;
L
Linus Torvalds 已提交
690 691 692 693 694 695 696 697 698
		if (lcd_out != -1)
			_set_bit(&new_video_out, HCI_VIDEO_OUT_LCD, lcd_out);
		if (crt_out != -1)
			_set_bit(&new_video_out, HCI_VIDEO_OUT_CRT, crt_out);
		if (tv_out != -1)
			_set_bit(&new_video_out, HCI_VIDEO_OUT_TV, tv_out);
		/* To avoid unnecessary video disruption, only write the new
		 * video setting if something changed. */
		if (new_video_out != video_out)
S
Seth Forshee 已提交
699
			ret = write_acpi_int(METHOD_VIDEO_OUT, new_video_out);
L
Linus Torvalds 已提交
700 701
	}

S
Seth Forshee 已提交
702
	return ret ? ret : count;
L
Linus Torvalds 已提交
703 704
}

705 706 707 708 709 710 711 712 713
static const struct file_operations video_proc_fops = {
	.owner		= THIS_MODULE,
	.open		= video_proc_open,
	.read		= seq_read,
	.llseek		= seq_lseek,
	.release	= single_release,
	.write		= video_proc_write,
};

714 715 716 717 718 719 720 721
static int get_fan_status(struct toshiba_acpi_dev *dev, u32 *status)
{
	u32 hci_result;

	hci_read1(dev, HCI_FAN, status, &hci_result);
	return hci_result == HCI_SUCCESS ? 0 : -EIO;
}

722
static int fan_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
723
{
724
	struct toshiba_acpi_dev *dev = m->private;
725
	int ret;
L
Linus Torvalds 已提交
726 727
	u32 value;

728 729
	ret = get_fan_status(dev, &value);
	if (!ret) {
730
		seq_printf(m, "running:                 %d\n", (value > 0));
731
		seq_printf(m, "force_on:                %d\n", dev->force_fan);
L
Linus Torvalds 已提交
732 733
	}

734
	return ret;
735 736 737 738
}

static int fan_proc_open(struct inode *inode, struct file *file)
{
A
Al Viro 已提交
739
	return single_open(file, fan_proc_show, PDE_DATA(inode));
L
Linus Torvalds 已提交
740 741
}

742 743
static ssize_t fan_proc_write(struct file *file, const char __user *buf,
			      size_t count, loff_t *pos)
L
Linus Torvalds 已提交
744
{
A
Al Viro 已提交
745
	struct toshiba_acpi_dev *dev = PDE_DATA(file_inode(file));
746 747
	char cmd[42];
	size_t len;
L
Linus Torvalds 已提交
748 749 750
	int value;
	u32 hci_result;

751 752 753 754 755 756
	len = min(count, sizeof(cmd) - 1);
	if (copy_from_user(cmd, buf, len))
		return -EFAULT;
	cmd[len] = '\0';

	if (sscanf(cmd, " force_on : %i", &value) == 1 &&
L
Len Brown 已提交
757
	    value >= 0 && value <= 1) {
758
		hci_write1(dev, HCI_FAN, value, &hci_result);
L
Linus Torvalds 已提交
759
		if (hci_result != HCI_SUCCESS)
S
Seth Forshee 已提交
760
			return -EIO;
L
Linus Torvalds 已提交
761
		else
762
			dev->force_fan = value;
L
Linus Torvalds 已提交
763 764 765 766 767 768 769
	} else {
		return -EINVAL;
	}

	return count;
}

770 771 772 773 774 775 776 777 778 779
static const struct file_operations fan_proc_fops = {
	.owner		= THIS_MODULE,
	.open		= fan_proc_open,
	.read		= seq_read,
	.llseek		= seq_lseek,
	.release	= single_release,
	.write		= fan_proc_write,
};

static int keys_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
780
{
781
	struct toshiba_acpi_dev *dev = m->private;
L
Linus Torvalds 已提交
782 783 784
	u32 hci_result;
	u32 value;

785
	if (!dev->key_event_valid && dev->system_event_supported) {
786
		hci_read1(dev, HCI_SYSTEM_EVENT, &value, &hci_result);
L
Linus Torvalds 已提交
787
		if (hci_result == HCI_SUCCESS) {
788 789
			dev->key_event_valid = 1;
			dev->last_key_event = value;
L
Linus Torvalds 已提交
790 791 792 793 794 795
		} else if (hci_result == HCI_EMPTY) {
			/* better luck next time */
		} else if (hci_result == HCI_NOT_SUPPORTED) {
			/* This is a workaround for an unresolved issue on
			 * some machines where system events sporadically
			 * become disabled. */
796
			hci_write1(dev, HCI_SYSTEM_EVENT, 1, &hci_result);
797
			pr_notice("Re-enabled hotkeys\n");
L
Linus Torvalds 已提交
798
		} else {
799
			pr_err("Error reading hotkey status\n");
S
Seth Forshee 已提交
800
			return -EIO;
L
Linus Torvalds 已提交
801 802 803
		}
	}

804 805
	seq_printf(m, "hotkey_ready:            %d\n", dev->key_event_valid);
	seq_printf(m, "hotkey:                  0x%04x\n", dev->last_key_event);
806 807
	return 0;
}
L
Linus Torvalds 已提交
808

809 810
static int keys_proc_open(struct inode *inode, struct file *file)
{
A
Al Viro 已提交
811
	return single_open(file, keys_proc_show, PDE_DATA(inode));
L
Linus Torvalds 已提交
812 813
}

814 815
static ssize_t keys_proc_write(struct file *file, const char __user *buf,
			       size_t count, loff_t *pos)
L
Linus Torvalds 已提交
816
{
A
Al Viro 已提交
817
	struct toshiba_acpi_dev *dev = PDE_DATA(file_inode(file));
818 819
	char cmd[42];
	size_t len;
L
Linus Torvalds 已提交
820 821
	int value;

822 823 824 825 826 827
	len = min(count, sizeof(cmd) - 1);
	if (copy_from_user(cmd, buf, len))
		return -EFAULT;
	cmd[len] = '\0';

	if (sscanf(cmd, " hotkey_ready : %i", &value) == 1 && value == 0) {
828
		dev->key_event_valid = 0;
L
Linus Torvalds 已提交
829 830 831 832 833 834 835
	} else {
		return -EINVAL;
	}

	return count;
}

836 837 838 839 840 841 842 843 844 845
static const struct file_operations keys_proc_fops = {
	.owner		= THIS_MODULE,
	.open		= keys_proc_open,
	.read		= seq_read,
	.llseek		= seq_lseek,
	.release	= single_release,
	.write		= keys_proc_write,
};

static int version_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
846
{
847 848 849
	seq_printf(m, "driver:                  %s\n", TOSHIBA_ACPI_VERSION);
	seq_printf(m, "proc_interface:          %d\n", PROC_INTERFACE_VERSION);
	return 0;
L
Linus Torvalds 已提交
850 851
}

852 853
static int version_proc_open(struct inode *inode, struct file *file)
{
A
Al Viro 已提交
854
	return single_open(file, version_proc_show, PDE_DATA(inode));
855 856 857 858 859 860 861 862 863 864
}

static const struct file_operations version_proc_fops = {
	.owner		= THIS_MODULE,
	.open		= version_proc_open,
	.read		= seq_read,
	.llseek		= seq_lseek,
	.release	= single_release,
};

L
Linus Torvalds 已提交
865 866 867 868 869
/* proc and module init
 */

#define PROC_TOSHIBA		"toshiba"

870
static void create_toshiba_proc_entries(struct toshiba_acpi_dev *dev)
L
Linus Torvalds 已提交
871
{
872 873 874 875 876 877 878 879 880 881 882 883
	if (dev->backlight_dev)
		proc_create_data("lcd", S_IRUGO | S_IWUSR, toshiba_proc_dir,
				 &lcd_proc_fops, dev);
	if (dev->video_supported)
		proc_create_data("video", S_IRUGO | S_IWUSR, toshiba_proc_dir,
				 &video_proc_fops, dev);
	if (dev->fan_supported)
		proc_create_data("fan", S_IRUGO | S_IWUSR, toshiba_proc_dir,
				 &fan_proc_fops, dev);
	if (dev->hotkey_dev)
		proc_create_data("keys", S_IRUGO | S_IWUSR, toshiba_proc_dir,
				 &keys_proc_fops, dev);
884 885
	proc_create_data("version", S_IRUGO, toshiba_proc_dir,
			 &version_proc_fops, dev);
L
Linus Torvalds 已提交
886 887
}

888
static void remove_toshiba_proc_entries(struct toshiba_acpi_dev *dev)
L
Linus Torvalds 已提交
889
{
890 891 892 893 894 895 896 897
	if (dev->backlight_dev)
		remove_proc_entry("lcd", toshiba_proc_dir);
	if (dev->video_supported)
		remove_proc_entry("video", toshiba_proc_dir);
	if (dev->fan_supported)
		remove_proc_entry("fan", toshiba_proc_dir);
	if (dev->hotkey_dev)
		remove_proc_entry("keys", toshiba_proc_dir);
898
	remove_proc_entry("version", toshiba_proc_dir);
L
Linus Torvalds 已提交
899 900
}

L
Lionel Debroux 已提交
901
static const struct backlight_ops toshiba_backlight_data = {
902
	.options = BL_CORE_SUSPENDRESUME,
903 904
	.get_brightness = get_lcd_brightness,
	.update_status  = set_lcd_status,
905 906
};

907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941
static bool toshiba_acpi_i8042_filter(unsigned char data, unsigned char str,
				      struct serio *port)
{
	if (str & 0x20)
		return false;

	if (unlikely(data == 0xe0))
		return false;

	if ((data & 0x7f) == TOS1900_FN_SCAN) {
		schedule_work(&toshiba_acpi->hotkey_work);
		return true;
	}

	return false;
}

static void toshiba_acpi_hotkey_work(struct work_struct *work)
{
	acpi_handle ec_handle = ec_get_handle();
	acpi_status status;

	if (!ec_handle)
		return;

	status = acpi_evaluate_object(ec_handle, "NTFY", NULL, NULL);
	if (ACPI_FAILURE(status))
		pr_err("ACPI NTFY method execution failed\n");
}

/*
 * Returns hotkey scancode, or < 0 on failure.
 */
static int toshiba_acpi_query_hotkey(struct toshiba_acpi_dev *dev)
{
942
	unsigned long long value;
943 944
	acpi_status status;

945 946 947
	status = acpi_evaluate_integer(dev->acpi_dev->handle, "INFO",
				      NULL, &value);
	if (ACPI_FAILURE(status)) {
948 949 950 951
		pr_err("ACPI INFO method execution failed\n");
		return -EIO;
	}

952
	return value;
953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968
}

static void toshiba_acpi_report_hotkey(struct toshiba_acpi_dev *dev,
				       int scancode)
{
	if (scancode == 0x100)
		return;

	/* act on key press; ignore key release */
	if (scancode & 0x80)
		return;

	if (!sparse_keymap_report_event(dev->hotkey_dev, scancode, 1, true))
		pr_info("Unknown key %x\n", scancode);
}

969
static int toshiba_acpi_setup_keyboard(struct toshiba_acpi_dev *dev)
970 971
{
	acpi_status status;
972
	acpi_handle ec_handle;
973
	int error;
974
	u32 hci_result;
975

976
	dev->hotkey_dev = input_allocate_device();
977
	if (!dev->hotkey_dev)
978 979
		return -ENOMEM;

980
	dev->hotkey_dev->name = "Toshiba input device";
981
	dev->hotkey_dev->phys = "toshiba_acpi/input0";
982
	dev->hotkey_dev->id.bustype = BUS_HOST;
983

984
	error = sparse_keymap_setup(dev->hotkey_dev, toshiba_acpi_keymap, NULL);
985 986 987
	if (error)
		goto err_free_dev;

988 989 990 991 992 993 994 995 996
	/*
	 * For some machines the SCI responsible for providing hotkey
	 * notification doesn't fire. We can trigger the notification
	 * whenever the Fn key is pressed using the NTFY method, if
	 * supported, so if it's present set up an i8042 key filter
	 * for this purpose.
	 */
	status = AE_ERROR;
	ec_handle = ec_get_handle();
997
	if (ec_handle && acpi_has_method(ec_handle, "NTFY")) {
998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012
		INIT_WORK(&dev->hotkey_work, toshiba_acpi_hotkey_work);

		error = i8042_install_filter(toshiba_acpi_i8042_filter);
		if (error) {
			pr_err("Error installing key filter\n");
			goto err_free_keymap;
		}

		dev->ntfy_supported = 1;
	}

	/*
	 * Determine hotkey query interface. Prefer using the INFO
	 * method when it is available.
	 */
1013
	if (acpi_has_method(dev->acpi_dev->handle, "INFO"))
1014
		dev->info_supported = 1;
1015
	else {
1016 1017 1018 1019 1020 1021 1022 1023 1024 1025
		hci_write1(dev, HCI_SYSTEM_EVENT, 1, &hci_result);
		if (hci_result == HCI_SUCCESS)
			dev->system_event_supported = 1;
	}

	if (!dev->info_supported && !dev->system_event_supported) {
		pr_warn("No hotkey query interface found\n");
		goto err_remove_filter;
	}

1026
	status = acpi_evaluate_object(dev->acpi_dev->handle, "ENAB", NULL, NULL);
1027
	if (ACPI_FAILURE(status)) {
1028
		pr_info("Unable to enable hotkeys\n");
1029
		error = -ENODEV;
1030
		goto err_remove_filter;
1031 1032
	}

1033
	error = input_register_device(dev->hotkey_dev);
1034
	if (error) {
1035
		pr_info("Unable to register input device\n");
1036
		goto err_remove_filter;
1037 1038
	}

1039
	hci_write1(dev, HCI_HOTKEY_EVENT, HCI_HOTKEY_ENABLE, &hci_result);
1040
	return 0;
1041

1042 1043 1044
 err_remove_filter:
	if (dev->ntfy_supported)
		i8042_remove_filter(toshiba_acpi_i8042_filter);
1045
 err_free_keymap:
1046
	sparse_keymap_free(dev->hotkey_dev);
1047
 err_free_dev:
1048 1049
	input_free_device(dev->hotkey_dev);
	dev->hotkey_dev = NULL;
1050
	return error;
1051 1052
}

1053
static int toshiba_acpi_setup_backlight(struct toshiba_acpi_dev *dev)
1054 1055 1056 1057
{
	struct backlight_properties props;
	int brightness;
	int ret;
1058
	bool enabled;
1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074

	/*
	 * Some machines don't support the backlight methods at all, and
	 * others support it read-only. Either of these is pretty useless,
	 * so only register the backlight device if the backlight method
	 * supports both reads and writes.
	 */
	brightness = __get_lcd_brightness(dev);
	if (brightness < 0)
		return 0;
	ret = set_lcd_brightness(dev, brightness);
	if (ret) {
		pr_debug("Backlight method is read-only, disabling backlight support\n");
		return 0;
	}

1075 1076 1077 1078
	/* Determine whether or not BIOS supports transflective backlight */
	ret = get_tr_backlight_status(dev, &enabled);
	dev->tr_backlight_supported = !ret;

M
Matthew Garrett 已提交
1079
	memset(&props, 0, sizeof(props));
1080 1081 1082
	props.type = BACKLIGHT_PLATFORM;
	props.max_brightness = HCI_LCD_BRIGHTNESS_LEVELS - 1;

1083 1084 1085 1086
	/* adding an extra level and having 0 change to transflective mode */
	if (dev->tr_backlight_supported)
		props.max_brightness++;

1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102
	dev->backlight_dev = backlight_device_register("toshiba",
						       &dev->acpi_dev->dev,
						       dev,
						       &toshiba_backlight_data,
						       &props);
	if (IS_ERR(dev->backlight_dev)) {
		ret = PTR_ERR(dev->backlight_dev);
		pr_err("Could not register toshiba backlight device\n");
		dev->backlight_dev = NULL;
		return ret;
	}

	dev->backlight_dev->props.brightness = brightness;
	return 0;
}

1103
static int toshiba_acpi_remove(struct acpi_device *acpi_dev)
1104
{
1105
	struct toshiba_acpi_dev *dev = acpi_driver_data(acpi_dev);
1106

1107
	remove_toshiba_proc_entries(dev);
1108

1109 1110 1111 1112 1113
	if (dev->ntfy_supported) {
		i8042_remove_filter(toshiba_acpi_i8042_filter);
		cancel_work_sync(&dev->hotkey_work);
	}

1114 1115 1116 1117
	if (dev->hotkey_dev) {
		input_unregister_device(dev->hotkey_dev);
		sparse_keymap_free(dev->hotkey_dev);
	}
1118

1119 1120 1121 1122
	if (dev->bt_rfk) {
		rfkill_unregister(dev->bt_rfk);
		rfkill_destroy(dev->bt_rfk);
	}
1123

1124 1125
	if (dev->backlight_dev)
		backlight_device_unregister(dev->backlight_dev);
1126

1127
	if (dev->illumination_supported)
1128
		led_classdev_unregister(&dev->led_dev);
1129

1130 1131 1132
	if (toshiba_acpi)
		toshiba_acpi = NULL;

1133
	kfree(dev);
1134

1135
	return 0;
1136 1137
}

1138
static const char *find_hci_method(acpi_handle handle)
1139
{
1140
	if (acpi_has_method(handle, "GHCI"))
1141 1142
		return "GHCI";

1143
	if (acpi_has_method(handle, "SPFC"))
1144 1145 1146 1147 1148
		return "SPFC";

	return NULL;
}

1149
static int toshiba_acpi_add(struct acpi_device *acpi_dev)
L
Linus Torvalds 已提交
1150
{
1151
	struct toshiba_acpi_dev *dev;
1152
	const char *hci_method;
1153
	u32 dummy;
1154 1155
	bool bt_present;
	int ret = 0;
L
Linus Torvalds 已提交
1156

1157 1158 1159
	if (toshiba_acpi)
		return -EBUSY;

1160 1161 1162
	pr_info("Toshiba Laptop ACPI Extras version %s\n",
	       TOSHIBA_ACPI_VERSION);

1163 1164 1165
	hci_method = find_hci_method(acpi_dev->handle);
	if (!hci_method) {
		pr_err("HCI interface not found\n");
1166
		return -ENODEV;
1167
	}
1168

1169 1170 1171 1172
	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
	if (!dev)
		return -ENOMEM;
	dev->acpi_dev = acpi_dev;
1173
	dev->method_hci = hci_method;
1174
	acpi_dev->driver_data = dev;
L
Luming Yu 已提交
1175

1176 1177
	if (toshiba_acpi_setup_keyboard(dev))
		pr_info("Unable to activate hotkeys\n");
1178 1179

	mutex_init(&dev->mutex);
L
Linus Torvalds 已提交
1180

1181 1182
	ret = toshiba_acpi_setup_backlight(dev);
	if (ret)
1183
		goto error;
L
Linus Torvalds 已提交
1184

1185
	/* Register rfkill switch for Bluetooth */
1186 1187 1188 1189 1190 1191 1192
	if (hci_get_bt_present(dev, &bt_present) == HCI_SUCCESS && bt_present) {
		dev->bt_rfk = rfkill_alloc("Toshiba Bluetooth",
					   &acpi_dev->dev,
					   RFKILL_TYPE_BLUETOOTH,
					   &toshiba_rfk_ops,
					   dev);
		if (!dev->bt_rfk) {
1193
			pr_err("unable to allocate rfkill device\n");
1194 1195
			ret = -ENOMEM;
			goto error;
1196 1197
		}

1198
		ret = rfkill_register(dev->bt_rfk);
1199
		if (ret) {
1200
			pr_err("unable to register rfkill device\n");
1201 1202
			rfkill_destroy(dev->bt_rfk);
			goto error;
1203
		}
1204 1205
	}

1206 1207 1208 1209 1210 1211
	if (toshiba_illumination_available(dev)) {
		dev->led_dev.name = "toshiba::illumination";
		dev->led_dev.max_brightness = 1;
		dev->led_dev.brightness_set = toshiba_illumination_set;
		dev->led_dev.brightness_get = toshiba_illumination_get;
		if (!led_classdev_register(&acpi_dev->dev, &dev->led_dev))
1212
			dev->illumination_supported = 1;
1213 1214
	}

1215 1216 1217 1218 1219 1220 1221 1222 1223 1224
	/* Determine whether or not BIOS supports fan and video interfaces */

	ret = get_video_status(dev, &dummy);
	dev->video_supported = !ret;

	ret = get_fan_status(dev, &dummy);
	dev->fan_supported = !ret;

	create_toshiba_proc_entries(dev);

1225 1226
	toshiba_acpi = dev;

1227
	return 0;
1228 1229

error:
1230
	toshiba_acpi_remove(acpi_dev);
1231 1232 1233 1234 1235 1236 1237
	return ret;
}

static void toshiba_acpi_notify(struct acpi_device *acpi_dev, u32 event)
{
	struct toshiba_acpi_dev *dev = acpi_driver_data(acpi_dev);
	u32 hci_result, value;
1238
	int retries = 3;
1239
	int scancode;
1240

1241
	if (event != 0x80)
1242
		return;
1243

1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269
	if (dev->info_supported) {
		scancode = toshiba_acpi_query_hotkey(dev);
		if (scancode < 0)
			pr_err("Failed to query hotkey event\n");
		else if (scancode != 0)
			toshiba_acpi_report_hotkey(dev, scancode);
	} else if (dev->system_event_supported) {
		do {
			hci_read1(dev, HCI_SYSTEM_EVENT, &value, &hci_result);
			switch (hci_result) {
			case HCI_SUCCESS:
				toshiba_acpi_report_hotkey(dev, (int)value);
				break;
			case HCI_NOT_SUPPORTED:
				/*
				 * This is a workaround for an unresolved
				 * issue on some machines where system events
				 * sporadically become disabled.
				 */
				hci_write1(dev, HCI_SYSTEM_EVENT, 1,
					   &hci_result);
				pr_notice("Re-enabled hotkeys\n");
				/* fall through */
			default:
				retries--;
				break;
1270
			}
1271 1272
		} while (retries && hci_result != HCI_EMPTY);
	}
1273 1274
}

1275
#ifdef CONFIG_PM_SLEEP
1276
static int toshiba_acpi_suspend(struct device *device)
1277
{
1278
	struct toshiba_acpi_dev *dev = acpi_driver_data(to_acpi_device(device));
1279 1280 1281 1282 1283 1284 1285 1286
	u32 result;

	if (dev->hotkey_dev)
		hci_write1(dev, HCI_HOTKEY_EVENT, HCI_HOTKEY_DISABLE, &result);

	return 0;
}

1287
static int toshiba_acpi_resume(struct device *device)
1288
{
1289
	struct toshiba_acpi_dev *dev = acpi_driver_data(to_acpi_device(device));
1290 1291 1292 1293 1294 1295 1296
	u32 result;

	if (dev->hotkey_dev)
		hci_write1(dev, HCI_HOTKEY_EVENT, HCI_HOTKEY_ENABLE, &result);

	return 0;
}
1297
#endif
1298

1299 1300 1301
static SIMPLE_DEV_PM_OPS(toshiba_acpi_pm,
			 toshiba_acpi_suspend, toshiba_acpi_resume);

1302 1303 1304 1305 1306 1307 1308 1309 1310 1311
static struct acpi_driver toshiba_acpi_driver = {
	.name	= "Toshiba ACPI driver",
	.owner	= THIS_MODULE,
	.ids	= toshiba_device_ids,
	.flags	= ACPI_DRIVER_ALL_NOTIFY_EVENTS,
	.ops	= {
		.add		= toshiba_acpi_add,
		.remove		= toshiba_acpi_remove,
		.notify		= toshiba_acpi_notify,
	},
1312
	.drv.pm	= &toshiba_acpi_pm,
1313 1314 1315 1316 1317 1318
};

static int __init toshiba_acpi_init(void)
{
	int ret;

1319 1320 1321 1322 1323 1324 1325 1326
	/*
	 * Machines with this WMI guid aren't supported due to bugs in
	 * their AML. This check relies on wmi initializing before
	 * toshiba_acpi to guarantee guids have been identified.
	 */
	if (wmi_has_guid(TOSHIBA_WMI_EVENT_GUID))
		return -ENODEV;

1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346
	toshiba_proc_dir = proc_mkdir(PROC_TOSHIBA, acpi_root_dir);
	if (!toshiba_proc_dir) {
		pr_err("Unable to create proc dir " PROC_TOSHIBA "\n");
		return -ENODEV;
	}

	ret = acpi_bus_register_driver(&toshiba_acpi_driver);
	if (ret) {
		pr_err("Failed to register ACPI driver: %d\n", ret);
		remove_proc_entry(PROC_TOSHIBA, acpi_root_dir);
	}

	return ret;
}

static void __exit toshiba_acpi_exit(void)
{
	acpi_bus_unregister_driver(&toshiba_acpi_driver);
	if (toshiba_proc_dir)
		remove_proc_entry(PROC_TOSHIBA, acpi_root_dir);
L
Linus Torvalds 已提交
1347 1348 1349 1350
}

module_init(toshiba_acpi_init);
module_exit(toshiba_acpi_exit);