toshiba_acpi.c 33.5 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

L
Linus Torvalds 已提交
58 59 60 61 62 63 64 65
#include <asm/uaccess.h>

#include <acpi/acpi_drivers.h>

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

66 67
#define TOSHIBA_WMI_EVENT_GUID "59142400-C6A3-40FA-BADB-8A2652834100"

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

L
Linus Torvalds 已提交
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 96 97
/* 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
98
#define HCI_TR_BACKLIGHT		0x0005
L
Linus Torvalds 已提交
99 100 101 102
#define HCI_SYSTEM_EVENT		0x0016
#define HCI_VIDEO_OUT			0x001c
#define HCI_HOTKEY_EVENT		0x001e
#define HCI_LCD_BRIGHTNESS		0x002a
103
#define HCI_WIRELESS			0x0056
L
Linus Torvalds 已提交
104 105

/* field definitions */
106 107
#define HCI_HOTKEY_DISABLE		0x0b
#define HCI_HOTKEY_ENABLE		0x09
L
Linus Torvalds 已提交
108 109 110 111 112 113
#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
114 115 116 117
#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 已提交
118

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

128 129 130 131
	int force_fan;
	int last_key_event;
	int key_event_valid;

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

140 141 142
	struct mutex mutex;
};

143 144
static struct toshiba_acpi_dev *toshiba_acpi;

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

153
static const struct key_entry toshiba_acpi_keymap[] __devinitconst = {
154 155 156
	{ KE_KEY, 0x101, { KEY_MUTE } },
	{ KE_KEY, 0x102, { KEY_ZOOMOUT } },
	{ KE_KEY, 0x103, { KEY_ZOOMIN } },
157 158
	{ KE_KEY, 0x12c, { KEY_KBDILLUMTOGGLE } },
	{ KE_KEY, 0x139, { KEY_ZOOMRESET } },
159 160 161 162 163 164 165 166
	{ 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 } },
167
	{ KE_KEY, 0x143, { KEY_TOUCHPAD_TOGGLE } },
168
	{ KE_KEY, 0x17f, { KEY_FN } },
169 170 171 172 173 174 175 176
	{ 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 } },
177
	{ KE_IGNORE, 0x1430, { KEY_RESERVED } },
178
	{ KE_END, 0 },
179 180
};

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

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

/* acpi interface wrappers
 */

L
Len Brown 已提交
192
static int write_acpi_int(const char *methodName, int val)
L
Linus Torvalds 已提交
193 194 195 196 197
{
	struct acpi_object_list params;
	union acpi_object in_objs[1];
	acpi_status status;

198
	params.count = ARRAY_SIZE(in_objs);
L
Linus Torvalds 已提交
199 200 201 202
	params.pointer = in_objs;
	in_objs[0].type = ACPI_TYPE_INTEGER;
	in_objs[0].integer.value = val;

L
Len Brown 已提交
203
	status = acpi_evaluate_object(NULL, (char *)methodName, &params, NULL);
S
Seth Forshee 已提交
204
	return (status == AE_OK) ? 0 : -EIO;
L
Linus Torvalds 已提交
205 206 207 208 209
}

/* Perform a raw HCI call.  Here we don't care about input or output buffer
 * format.
 */
210 211
static acpi_status hci_raw(struct toshiba_acpi_dev *dev,
			   const u32 in[HCI_WORDS], u32 out[HCI_WORDS])
L
Linus Torvalds 已提交
212 213 214 215
{
	struct acpi_object_list params;
	union acpi_object in_objs[HCI_WORDS];
	struct acpi_buffer results;
L
Len Brown 已提交
216
	union acpi_object out_objs[HCI_WORDS + 1];
L
Linus Torvalds 已提交
217 218 219 220 221 222 223 224 225 226 227 228 229
	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;

230 231
	status = acpi_evaluate_object(dev->acpi_dev->handle,
				      (char *)dev->method_hci, &params,
L
Len Brown 已提交
232
				      &results);
L
Linus Torvalds 已提交
233 234 235 236 237 238 239 240 241
	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;
}

242
/* common hci tasks (get or set one or two value)
L
Linus Torvalds 已提交
243 244 245 246 247
 *
 * In addition to the ACPI status, the HCI system returns a result which
 * may be useful (such as "not supported").
 */

248 249
static acpi_status hci_write1(struct toshiba_acpi_dev *dev, u32 reg,
			      u32 in1, u32 *result)
L
Linus Torvalds 已提交
250 251 252
{
	u32 in[HCI_WORDS] = { HCI_SET, reg, in1, 0, 0, 0 };
	u32 out[HCI_WORDS];
253
	acpi_status status = hci_raw(dev, in, out);
L
Linus Torvalds 已提交
254 255 256 257
	*result = (status == AE_OK) ? out[0] : HCI_FAILURE;
	return status;
}

258 259
static acpi_status hci_read1(struct toshiba_acpi_dev *dev, u32 reg,
			     u32 *out1, u32 *result)
L
Linus Torvalds 已提交
260 261 262
{
	u32 in[HCI_WORDS] = { HCI_GET, reg, 0, 0, 0, 0 };
	u32 out[HCI_WORDS];
263
	acpi_status status = hci_raw(dev, in, out);
L
Linus Torvalds 已提交
264 265 266 267 268
	*out1 = out[2];
	*result = (status == AE_OK) ? out[0] : HCI_FAILURE;
	return status;
}

269 270
static acpi_status hci_write2(struct toshiba_acpi_dev *dev, u32 reg,
			      u32 in1, u32 in2, u32 *result)
271 272 273
{
	u32 in[HCI_WORDS] = { HCI_SET, reg, in1, in2, 0, 0 };
	u32 out[HCI_WORDS];
274
	acpi_status status = hci_raw(dev, in, out);
275 276 277 278
	*result = (status == AE_OK) ? out[0] : HCI_FAILURE;
	return status;
}

279 280
static acpi_status hci_read2(struct toshiba_acpi_dev *dev, u32 reg,
			     u32 *out1, u32 *out2, u32 *result)
281 282 283
{
	u32 in[HCI_WORDS] = { HCI_GET, reg, *out1, *out2, 0, 0 };
	u32 out[HCI_WORDS];
284
	acpi_status status = hci_raw(dev, in, out);
285 286 287 288 289 290
	*out1 = out[2];
	*out2 = out[3];
	*result = (status == AE_OK) ? out[0] : HCI_FAILURE;
	return status;
}

291
/* Illumination support */
292
static int toshiba_illumination_available(struct toshiba_acpi_dev *dev)
293 294 295 296 297 298
{
	u32 in[HCI_WORDS] = { 0, 0, 0, 0, 0, 0 };
	u32 out[HCI_WORDS];
	acpi_status status;

	in[0] = 0xf100;
299
	status = hci_raw(dev, in, out);
300
	if (ACPI_FAILURE(status)) {
301
		pr_info("Illumination device not available\n");
302 303 304
		return 0;
	}
	in[0] = 0xf400;
305
	status = hci_raw(dev, in, out);
306 307 308 309 310 311
	return 1;
}

static void toshiba_illumination_set(struct led_classdev *cdev,
				     enum led_brightness brightness)
{
312 313
	struct toshiba_acpi_dev *dev = container_of(cdev,
			struct toshiba_acpi_dev, led_dev);
314 315 316 317 318 319
	u32 in[HCI_WORDS] = { 0, 0, 0, 0, 0, 0 };
	u32 out[HCI_WORDS];
	acpi_status status;

	/* First request : initialize communication. */
	in[0] = 0xf100;
320
	status = hci_raw(dev, in, out);
321
	if (ACPI_FAILURE(status)) {
322
		pr_info("Illumination device not available\n");
323 324 325 326 327 328 329 330
		return;
	}

	if (brightness) {
		/* Switch the illumination on */
		in[0] = 0xf400;
		in[1] = 0x14e;
		in[2] = 1;
331
		status = hci_raw(dev, in, out);
332
		if (ACPI_FAILURE(status)) {
333
			pr_info("ACPI call for illumination failed\n");
334 335 336 337 338 339 340
			return;
		}
	} else {
		/* Switch the illumination off */
		in[0] = 0xf400;
		in[1] = 0x14e;
		in[2] = 0;
341
		status = hci_raw(dev, in, out);
342
		if (ACPI_FAILURE(status)) {
343
			pr_info("ACPI call for illumination failed.\n");
344 345 346 347 348 349 350 351
			return;
		}
	}

	/* Last request : close communication. */
	in[0] = 0xf200;
	in[1] = 0;
	in[2] = 0;
352
	hci_raw(dev, in, out);
353 354 355 356
}

static enum led_brightness toshiba_illumination_get(struct led_classdev *cdev)
{
357 358
	struct toshiba_acpi_dev *dev = container_of(cdev,
			struct toshiba_acpi_dev, led_dev);
359 360 361 362 363 364 365
	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;
366
	status = hci_raw(dev, in, out);
367
	if (ACPI_FAILURE(status)) {
368
		pr_info("Illumination device not available\n");
369 370 371 372 373 374
		return LED_OFF;
	}

	/* Check the illumination */
	in[0] = 0xf300;
	in[1] = 0x14e;
375
	status = hci_raw(dev, in, out);
376
	if (ACPI_FAILURE(status)) {
377
		pr_info("ACPI call for illumination failed.\n");
378 379 380 381 382 383 384 385 386
		return LED_OFF;
	}

	result = out[2] ? LED_FULL : LED_OFF;

	/* Last request : close communication. */
	in[0] = 0xf200;
	in[1] = 0;
	in[2] = 0;
387
	hci_raw(dev, in, out);
388 389 390 391

	return result;
}

392 393
/* Bluetooth rfkill handlers */

394
static u32 hci_get_bt_present(struct toshiba_acpi_dev *dev, bool *present)
395 396 397 398 399 400
{
	u32 hci_result;
	u32 value, value2;

	value = 0;
	value2 = 0;
401
	hci_read2(dev, HCI_WIRELESS, &value, &value2, &hci_result);
402 403 404 405 406 407
	if (hci_result == HCI_SUCCESS)
		*present = (value & HCI_WIRELESS_BT_PRESENT) ? true : false;

	return hci_result;
}

408
static u32 hci_get_radio_state(struct toshiba_acpi_dev *dev, bool *radio_state)
409 410 411 412 413 414
{
	u32 hci_result;
	u32 value, value2;

	value = 0;
	value2 = 0x0001;
415
	hci_read2(dev, HCI_WIRELESS, &value, &value2, &hci_result);
416 417 418 419 420

	*radio_state = value & HCI_WIRELESS_KILL_SWITCH;
	return hci_result;
}

J
Johannes Berg 已提交
421
static int bt_rfkill_set_block(void *data, bool blocked)
422
{
J
Johannes Berg 已提交
423
	struct toshiba_acpi_dev *dev = data;
424 425
	u32 result1, result2;
	u32 value;
J
Johannes Berg 已提交
426
	int err;
427 428
	bool radio_state;

J
Johannes Berg 已提交
429
	value = (blocked == false);
430

J
Johannes Berg 已提交
431
	mutex_lock(&dev->mutex);
432
	if (hci_get_radio_state(dev, &radio_state) != HCI_SUCCESS) {
S
Seth Forshee 已提交
433
		err = -EIO;
J
Johannes Berg 已提交
434 435
		goto out;
	}
436

J
Johannes Berg 已提交
437 438 439
	if (!radio_state) {
		err = 0;
		goto out;
440 441
	}

442 443
	hci_write2(dev, HCI_WIRELESS, value, HCI_WIRELESS_BT_POWER, &result1);
	hci_write2(dev, HCI_WIRELESS, value, HCI_WIRELESS_BT_ATTACH, &result2);
444 445

	if (result1 != HCI_SUCCESS || result2 != HCI_SUCCESS)
S
Seth Forshee 已提交
446
		err = -EIO;
J
Johannes Berg 已提交
447 448 449 450 451
	else
		err = 0;
 out:
	mutex_unlock(&dev->mutex);
	return err;
452 453
}

J
Johannes Berg 已提交
454
static void bt_rfkill_poll(struct rfkill *rfkill, void *data)
455 456 457 458
{
	bool new_rfk_state;
	bool value;
	u32 hci_result;
J
Johannes Berg 已提交
459 460 461
	struct toshiba_acpi_dev *dev = data;

	mutex_lock(&dev->mutex);
462

463
	hci_result = hci_get_radio_state(dev, &value);
J
Johannes Berg 已提交
464 465 466
	if (hci_result != HCI_SUCCESS) {
		/* Can't do anything useful */
		mutex_unlock(&dev->mutex);
J
Jiri Slaby 已提交
467
		return;
J
Johannes Berg 已提交
468
	}
469 470 471 472 473

	new_rfk_state = value;

	mutex_unlock(&dev->mutex);

J
Johannes Berg 已提交
474 475
	if (rfkill_set_hw_state(rfkill, !new_rfk_state))
		bt_rfkill_set_block(data, true);
476 477
}

J
Johannes Berg 已提交
478 479 480 481 482
static const struct rfkill_ops toshiba_rfk_ops = {
	.set_block = bt_rfkill_set_block,
	.poll = bt_rfkill_poll,
};

483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501
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 已提交
502
static struct proc_dir_entry *toshiba_proc_dir /*= 0*/ ;
L
Linus Torvalds 已提交
503

504
static int __get_lcd_brightness(struct toshiba_acpi_dev *dev)
L
Linus Torvalds 已提交
505 506 507
{
	u32 hci_result;
	u32 value;
508 509 510 511 512 513 514 515 516 517 518
	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 已提交
519

520
	hci_read1(dev, HCI_LCD_BRIGHTNESS, &value, &hci_result);
S
Seth Forshee 已提交
521
	if (hci_result == HCI_SUCCESS)
522
		return brightness + (value >> HCI_LCD_BRIGHTNESS_SHIFT);
S
Seth Forshee 已提交
523 524

	return -EIO;
525 526
}

527 528 529 530 531 532
static int get_lcd_brightness(struct backlight_device *bd)
{
	struct toshiba_acpi_dev *dev = bl_get_data(bd);
	return __get_lcd_brightness(dev);
}

533
static int lcd_proc_show(struct seq_file *m, void *v)
534
{
535 536
	struct toshiba_acpi_dev *dev = m->private;
	int value;
537
	int levels;
538 539 540

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

542
	levels = dev->backlight_dev->props.max_brightness + 1;
543
	value = get_lcd_brightness(dev->backlight_dev);
544
	if (value >= 0) {
545
		seq_printf(m, "brightness:              %d\n", value);
546
		seq_printf(m, "brightness_levels:       %d\n", levels);
S
Seth Forshee 已提交
547
		return 0;
L
Linus Torvalds 已提交
548 549
	}

S
Seth Forshee 已提交
550 551
	pr_err("Error reading LCD brightness\n");
	return -EIO;
552 553 554 555
}

static int lcd_proc_open(struct inode *inode, struct file *file)
{
556
	return single_open(file, lcd_proc_show, PDE(inode)->data);
L
Linus Torvalds 已提交
557 558
}

559
static int set_lcd_brightness(struct toshiba_acpi_dev *dev, int value)
560 561 562
{
	u32 hci_result;

563 564 565 566 567 568 569 570 571
	if (dev->tr_backlight_supported) {
		bool enable = !value;
		int ret = set_tr_backlight_status(dev, enable);
		if (ret)
			return ret;
		if (value)
			value--;
	}

572
	value = value << HCI_LCD_BRIGHTNESS_SHIFT;
573
	hci_write1(dev, HCI_LCD_BRIGHTNESS, value, &hci_result);
S
Seth Forshee 已提交
574
	return hci_result == HCI_SUCCESS ? 0 : -EIO;
575 576 577 578
}

static int set_lcd_status(struct backlight_device *bd)
{
579
	struct toshiba_acpi_dev *dev = bl_get_data(bd);
580
	return set_lcd_brightness(dev, bd->props.brightness);
581 582
}

583 584
static ssize_t lcd_proc_write(struct file *file, const char __user *buf,
			      size_t count, loff_t *pos)
L
Linus Torvalds 已提交
585
{
586
	struct toshiba_acpi_dev *dev = PDE(file->f_path.dentry->d_inode)->data;
587 588
	char cmd[42];
	size_t len;
L
Linus Torvalds 已提交
589
	int value;
590
	int ret;
591
	int levels = dev->backlight_dev->props.max_brightness + 1;
L
Linus Torvalds 已提交
592

593 594 595 596 597 598
	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 &&
599
	    value >= 0 && value < levels) {
600
		ret = set_lcd_brightness(dev, value);
601 602 603
		if (ret == 0)
			ret = count;
	} else {
604
		ret = -EINVAL;
605
	}
606
	return ret;
L
Linus Torvalds 已提交
607 608
}

609 610 611 612 613 614 615 616 617
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,
};

618 619 620 621 622 623 624 625
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;
}

626
static int video_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
627
{
628
	struct toshiba_acpi_dev *dev = m->private;
L
Linus Torvalds 已提交
629
	u32 value;
630
	int ret;
L
Linus Torvalds 已提交
631

632 633
	ret = get_video_status(dev, &value);
	if (!ret) {
L
Linus Torvalds 已提交
634 635
		int is_lcd = (value & HCI_VIDEO_OUT_LCD) ? 1 : 0;
		int is_crt = (value & HCI_VIDEO_OUT_CRT) ? 1 : 0;
L
Len Brown 已提交
636
		int is_tv = (value & HCI_VIDEO_OUT_TV) ? 1 : 0;
637 638 639
		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 已提交
640 641
	}

642
	return ret;
L
Linus Torvalds 已提交
643 644
}

645
static int video_proc_open(struct inode *inode, struct file *file)
L
Linus Torvalds 已提交
646
{
647
	return single_open(file, video_proc_show, PDE(inode)->data);
648 649 650 651 652
}

static ssize_t video_proc_write(struct file *file, const char __user *buf,
				size_t count, loff_t *pos)
{
653
	struct toshiba_acpi_dev *dev = PDE(file->f_path.dentry->d_inode)->data;
654
	char *cmd, *buffer;
655
	int ret;
L
Linus Torvalds 已提交
656 657 658 659 660
	int value;
	int remain = count;
	int lcd_out = -1;
	int crt_out = -1;
	int tv_out = -1;
A
Al Viro 已提交
661
	u32 video_out;
L
Linus Torvalds 已提交
662

663 664 665 666 667 668 669 670 671 672 673
	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 已提交
674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689
	/* 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 已提交
690
		while (remain && *(buffer - 1) != ';');
L
Linus Torvalds 已提交
691 692
	}

693 694
	kfree(cmd);

695 696
	ret = get_video_status(dev, &video_out);
	if (!ret) {
697
		unsigned int new_video_out = video_out;
L
Linus Torvalds 已提交
698 699 700 701 702 703 704 705 706
		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 已提交
707
			ret = write_acpi_int(METHOD_VIDEO_OUT, new_video_out);
L
Linus Torvalds 已提交
708 709
	}

S
Seth Forshee 已提交
710
	return ret ? ret : count;
L
Linus Torvalds 已提交
711 712
}

713 714 715 716 717 718 719 720 721
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,
};

722 723 724 725 726 727 728 729
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;
}

730
static int fan_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
731
{
732
	struct toshiba_acpi_dev *dev = m->private;
733
	int ret;
L
Linus Torvalds 已提交
734 735
	u32 value;

736 737
	ret = get_fan_status(dev, &value);
	if (!ret) {
738
		seq_printf(m, "running:                 %d\n", (value > 0));
739
		seq_printf(m, "force_on:                %d\n", dev->force_fan);
L
Linus Torvalds 已提交
740 741
	}

742
	return ret;
743 744 745 746
}

static int fan_proc_open(struct inode *inode, struct file *file)
{
747
	return single_open(file, fan_proc_show, PDE(inode)->data);
L
Linus Torvalds 已提交
748 749
}

750 751
static ssize_t fan_proc_write(struct file *file, const char __user *buf,
			      size_t count, loff_t *pos)
L
Linus Torvalds 已提交
752
{
753
	struct toshiba_acpi_dev *dev = PDE(file->f_path.dentry->d_inode)->data;
754 755
	char cmd[42];
	size_t len;
L
Linus Torvalds 已提交
756 757 758
	int value;
	u32 hci_result;

759 760 761 762 763 764
	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 已提交
765
	    value >= 0 && value <= 1) {
766
		hci_write1(dev, HCI_FAN, value, &hci_result);
L
Linus Torvalds 已提交
767
		if (hci_result != HCI_SUCCESS)
S
Seth Forshee 已提交
768
			return -EIO;
L
Linus Torvalds 已提交
769
		else
770
			dev->force_fan = value;
L
Linus Torvalds 已提交
771 772 773 774 775 776 777
	} else {
		return -EINVAL;
	}

	return count;
}

778 779 780 781 782 783 784 785 786 787
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 已提交
788
{
789
	struct toshiba_acpi_dev *dev = m->private;
L
Linus Torvalds 已提交
790 791 792
	u32 hci_result;
	u32 value;

793
	if (!dev->key_event_valid && dev->system_event_supported) {
794
		hci_read1(dev, HCI_SYSTEM_EVENT, &value, &hci_result);
L
Linus Torvalds 已提交
795
		if (hci_result == HCI_SUCCESS) {
796 797
			dev->key_event_valid = 1;
			dev->last_key_event = value;
L
Linus Torvalds 已提交
798 799 800 801 802 803
		} 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. */
804
			hci_write1(dev, HCI_SYSTEM_EVENT, 1, &hci_result);
805
			pr_notice("Re-enabled hotkeys\n");
L
Linus Torvalds 已提交
806
		} else {
807
			pr_err("Error reading hotkey status\n");
S
Seth Forshee 已提交
808
			return -EIO;
L
Linus Torvalds 已提交
809 810 811
		}
	}

812 813
	seq_printf(m, "hotkey_ready:            %d\n", dev->key_event_valid);
	seq_printf(m, "hotkey:                  0x%04x\n", dev->last_key_event);
814 815
	return 0;
}
L
Linus Torvalds 已提交
816

817 818
static int keys_proc_open(struct inode *inode, struct file *file)
{
819
	return single_open(file, keys_proc_show, PDE(inode)->data);
L
Linus Torvalds 已提交
820 821
}

822 823
static ssize_t keys_proc_write(struct file *file, const char __user *buf,
			       size_t count, loff_t *pos)
L
Linus Torvalds 已提交
824
{
825
	struct toshiba_acpi_dev *dev = PDE(file->f_path.dentry->d_inode)->data;
826 827
	char cmd[42];
	size_t len;
L
Linus Torvalds 已提交
828 829
	int value;

830 831 832 833 834 835
	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) {
836
		dev->key_event_valid = 0;
L
Linus Torvalds 已提交
837 838 839 840 841 842 843
	} else {
		return -EINVAL;
	}

	return count;
}

844 845 846 847 848 849 850 851 852 853
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 已提交
854
{
855 856 857
	seq_printf(m, "driver:                  %s\n", TOSHIBA_ACPI_VERSION);
	seq_printf(m, "proc_interface:          %d\n", PROC_INTERFACE_VERSION);
	return 0;
L
Linus Torvalds 已提交
858 859
}

860 861 862 863 864 865 866 867 868 869 870 871 872
static int version_proc_open(struct inode *inode, struct file *file)
{
	return single_open(file, version_proc_show, PDE(inode)->data);
}

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 已提交
873 874 875 876 877
/* proc and module init
 */

#define PROC_TOSHIBA		"toshiba"

878 879
static void __devinit
create_toshiba_proc_entries(struct toshiba_acpi_dev *dev)
L
Linus Torvalds 已提交
880
{
881 882 883 884 885 886 887 888 889 890 891 892
	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);
893 894
	proc_create_data("version", S_IRUGO, toshiba_proc_dir,
			 &version_proc_fops, dev);
L
Linus Torvalds 已提交
895 896
}

897
static void remove_toshiba_proc_entries(struct toshiba_acpi_dev *dev)
L
Linus Torvalds 已提交
898
{
899 900 901 902 903 904 905 906
	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);
907
	remove_proc_entry("version", toshiba_proc_dir);
L
Linus Torvalds 已提交
908 909
}

L
Lionel Debroux 已提交
910
static const struct backlight_ops toshiba_backlight_data = {
911
	.options = BL_CORE_SUSPENDRESUME,
912 913
	.get_brightness = get_lcd_brightness,
	.update_status  = set_lcd_status,
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 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981
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)
{
	struct acpi_buffer buf;
	union acpi_object out_obj;
	acpi_status status;

	buf.pointer = &out_obj;
	buf.length = sizeof(out_obj);

	status = acpi_evaluate_object(dev->acpi_dev->handle, "INFO",
				      NULL, &buf);
	if (ACPI_FAILURE(status) || out_obj.type != ACPI_TYPE_INTEGER) {
		pr_err("ACPI INFO method execution failed\n");
		return -EIO;
	}

	return out_obj.integer.value;
}

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);
}

982
static int __devinit toshiba_acpi_setup_keyboard(struct toshiba_acpi_dev *dev)
983 984
{
	acpi_status status;
985
	acpi_handle ec_handle, handle;
986
	int error;
987
	u32 hci_result;
988

989 990
	dev->hotkey_dev = input_allocate_device();
	if (!dev->hotkey_dev) {
991
		pr_info("Unable to register input device\n");
992 993 994
		return -ENOMEM;
	}

995
	dev->hotkey_dev->name = "Toshiba input device";
996
	dev->hotkey_dev->phys = "toshiba_acpi/input0";
997
	dev->hotkey_dev->id.bustype = BUS_HOST;
998

999
	error = sparse_keymap_setup(dev->hotkey_dev, toshiba_acpi_keymap, NULL);
1000 1001 1002
	if (error)
		goto err_free_dev;

1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044
	/*
	 * 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();
	if (ec_handle)
		status = acpi_get_handle(ec_handle, "NTFY", &handle);

	if (ACPI_SUCCESS(status)) {
		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.
	 */
	status = acpi_get_handle(dev->acpi_dev->handle, "INFO", &handle);
	if (ACPI_SUCCESS(status)) {
		dev->info_supported = 1;
	} else {
		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;
	}

1045
	status = acpi_evaluate_object(dev->acpi_dev->handle, "ENAB", NULL, NULL);
1046
	if (ACPI_FAILURE(status)) {
1047
		pr_info("Unable to enable hotkeys\n");
1048
		error = -ENODEV;
1049
		goto err_remove_filter;
1050 1051
	}

1052
	error = input_register_device(dev->hotkey_dev);
1053
	if (error) {
1054
		pr_info("Unable to register input device\n");
1055
		goto err_remove_filter;
1056 1057
	}

1058
	hci_write1(dev, HCI_HOTKEY_EVENT, HCI_HOTKEY_ENABLE, &hci_result);
1059
	return 0;
1060

1061 1062 1063
 err_remove_filter:
	if (dev->ntfy_supported)
		i8042_remove_filter(toshiba_acpi_i8042_filter);
1064
 err_free_keymap:
1065
	sparse_keymap_free(dev->hotkey_dev);
1066
 err_free_dev:
1067 1068
	input_free_device(dev->hotkey_dev);
	dev->hotkey_dev = NULL;
1069
	return error;
1070 1071
}

1072 1073 1074 1075 1076
static int __devinit toshiba_acpi_setup_backlight(struct toshiba_acpi_dev *dev)
{
	struct backlight_properties props;
	int brightness;
	int ret;
1077
	bool enabled;
1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093

	/*
	 * 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;
	}

1094 1095 1096 1097
	/* Determine whether or not BIOS supports transflective backlight */
	ret = get_tr_backlight_status(dev, &enabled);
	dev->tr_backlight_supported = !ret;

1098 1099 1100 1101
	props.type = BACKLIGHT_PLATFORM;
	props.max_brightness = HCI_LCD_BRIGHTNESS_LEVELS - 1;
	memset(&props, 0, sizeof(props));

1102 1103 1104 1105
	/* adding an extra level and having 0 change to transflective mode */
	if (dev->tr_backlight_supported)
		props.max_brightness++;

1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121
	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;
}

1122
static int toshiba_acpi_remove(struct acpi_device *acpi_dev, int type)
1123
{
1124
	struct toshiba_acpi_dev *dev = acpi_driver_data(acpi_dev);
1125

1126
	remove_toshiba_proc_entries(dev);
1127

1128 1129 1130 1131 1132
	if (dev->ntfy_supported) {
		i8042_remove_filter(toshiba_acpi_i8042_filter);
		cancel_work_sync(&dev->hotkey_work);
	}

1133 1134 1135 1136
	if (dev->hotkey_dev) {
		input_unregister_device(dev->hotkey_dev);
		sparse_keymap_free(dev->hotkey_dev);
	}
1137

1138 1139 1140 1141
	if (dev->bt_rfk) {
		rfkill_unregister(dev->bt_rfk);
		rfkill_destroy(dev->bt_rfk);
	}
1142

1143 1144
	if (dev->backlight_dev)
		backlight_device_unregister(dev->backlight_dev);
1145

1146
	if (dev->illumination_supported)
1147
		led_classdev_unregister(&dev->led_dev);
1148

1149 1150 1151
	if (toshiba_acpi)
		toshiba_acpi = NULL;

1152
	kfree(dev);
1153

1154
	return 0;
1155 1156
}

1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172
static const char * __devinit find_hci_method(acpi_handle handle)
{
	acpi_status status;
	acpi_handle hci_handle;

	status = acpi_get_handle(handle, "GHCI", &hci_handle);
	if (ACPI_SUCCESS(status))
		return "GHCI";

	status = acpi_get_handle(handle, "SPFC", &hci_handle);
	if (ACPI_SUCCESS(status))
		return "SPFC";

	return NULL;
}

1173
static int __devinit toshiba_acpi_add(struct acpi_device *acpi_dev)
L
Linus Torvalds 已提交
1174
{
1175
	struct toshiba_acpi_dev *dev;
1176
	const char *hci_method;
1177
	u32 dummy;
1178 1179
	bool bt_present;
	int ret = 0;
L
Linus Torvalds 已提交
1180

1181 1182 1183
	if (toshiba_acpi)
		return -EBUSY;

1184 1185 1186
	pr_info("Toshiba Laptop ACPI Extras version %s\n",
	       TOSHIBA_ACPI_VERSION);

1187 1188 1189
	hci_method = find_hci_method(acpi_dev->handle);
	if (!hci_method) {
		pr_err("HCI interface not found\n");
1190
		return -ENODEV;
1191
	}
1192

1193 1194 1195 1196
	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
	if (!dev)
		return -ENOMEM;
	dev->acpi_dev = acpi_dev;
1197
	dev->method_hci = hci_method;
1198
	acpi_dev->driver_data = dev;
L
Luming Yu 已提交
1199

1200 1201
	if (toshiba_acpi_setup_keyboard(dev))
		pr_info("Unable to activate hotkeys\n");
1202 1203

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

1205 1206
	ret = toshiba_acpi_setup_backlight(dev);
	if (ret)
1207
		goto error;
L
Linus Torvalds 已提交
1208

1209
	/* Register rfkill switch for Bluetooth */
1210 1211 1212 1213 1214 1215 1216
	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) {
1217
			pr_err("unable to allocate rfkill device\n");
1218 1219
			ret = -ENOMEM;
			goto error;
1220 1221
		}

1222
		ret = rfkill_register(dev->bt_rfk);
1223
		if (ret) {
1224
			pr_err("unable to register rfkill device\n");
1225 1226
			rfkill_destroy(dev->bt_rfk);
			goto error;
1227
		}
1228 1229
	}

1230 1231 1232 1233 1234 1235
	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))
1236
			dev->illumination_supported = 1;
1237 1238
	}

1239 1240 1241 1242 1243 1244 1245 1246 1247 1248
	/* 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);

1249 1250
	toshiba_acpi = dev;

1251
	return 0;
1252 1253 1254 1255 1256 1257 1258 1259 1260 1261

error:
	toshiba_acpi_remove(acpi_dev, 0);
	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;
1262
	int retries = 3;
1263
	int scancode;
1264

1265
	if (event != 0x80)
1266
		return;
1267

1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293
	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;
1294
			}
1295 1296
		} while (retries && hci_result != HCI_EMPTY);
	}
1297 1298
}

1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320
static int toshiba_acpi_suspend(struct acpi_device *acpi_dev,
				pm_message_t state)
{
	struct toshiba_acpi_dev *dev = acpi_driver_data(acpi_dev);
	u32 result;

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

	return 0;
}

static int toshiba_acpi_resume(struct acpi_device *acpi_dev)
{
	struct toshiba_acpi_dev *dev = acpi_driver_data(acpi_dev);
	u32 result;

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

	return 0;
}
1321 1322 1323 1324 1325 1326 1327 1328 1329 1330

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,
1331 1332
		.suspend	= toshiba_acpi_suspend,
		.resume		= toshiba_acpi_resume,
1333 1334 1335 1336 1337 1338 1339
	},
};

static int __init toshiba_acpi_init(void)
{
	int ret;

1340 1341 1342 1343 1344 1345 1346 1347
	/*
	 * 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;

1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367
	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 已提交
1368 1369 1370 1371
}

module_init(toshiba_acpi_init);
module_exit(toshiba_acpi_exit);