toshiba_acpi.c 34.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
/* 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.
80 81 82
 * 
 * SCI stands for "System Configuration Interface" which aim is to
 * conceal differences in hardware between different models.
L
Linus Torvalds 已提交
83 84 85 86 87 88 89
 */

#define HCI_WORDS			6

/* operations */
#define HCI_SET				0xff00
#define HCI_GET				0xfe00
90 91 92 93
#define SCI_OPEN			0xf100
#define SCI_CLOSE			0xf200
#define SCI_GET				0xf300
#define SCI_SET				0xf400
L
Linus Torvalds 已提交
94 95 96 97 98 99

/* return codes */
#define HCI_SUCCESS			0x0000
#define HCI_FAILURE			0x1000
#define HCI_NOT_SUPPORTED		0x8000
#define HCI_EMPTY			0x8c00
100 101 102 103
#define SCI_OPEN_CLOSE_OK		0x0044
#define SCI_ALREADY_OPEN		0x8100
#define SCI_NOT_OPENED			0x8200
#define SCI_NOT_PRESENT			0x8600
L
Linus Torvalds 已提交
104 105 106

/* registers */
#define HCI_FAN				0x0004
107
#define HCI_TR_BACKLIGHT		0x0005
L
Linus Torvalds 已提交
108 109 110 111
#define HCI_SYSTEM_EVENT		0x0016
#define HCI_VIDEO_OUT			0x001c
#define HCI_HOTKEY_EVENT		0x001e
#define HCI_LCD_BRIGHTNESS		0x002a
112
#define HCI_WIRELESS			0x0056
L
Linus Torvalds 已提交
113 114

/* field definitions */
115 116
#define HCI_HOTKEY_DISABLE		0x0b
#define HCI_HOTKEY_ENABLE		0x09
L
Linus Torvalds 已提交
117 118 119 120 121 122
#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
123 124 125 126
#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 已提交
127

128 129 130 131 132
struct toshiba_acpi_dev {
	struct acpi_device *acpi_dev;
	const char *method_hci;
	struct rfkill *bt_rfk;
	struct input_dev *hotkey_dev;
133
	struct work_struct hotkey_work;
134 135
	struct backlight_device *backlight_dev;
	struct led_classdev led_dev;
136

137 138 139 140
	int force_fan;
	int last_key_event;
	int key_event_valid;

141 142 143 144
	unsigned int illumination_supported:1;
	unsigned int video_supported:1;
	unsigned int fan_supported:1;
	unsigned int system_event_supported:1;
145 146
	unsigned int ntfy_supported:1;
	unsigned int info_supported:1;
147
	unsigned int tr_backlight_supported:1;
148

149 150 151
	struct mutex mutex;
};

152 153
static struct toshiba_acpi_dev *toshiba_acpi;

154 155
static const struct acpi_device_id toshiba_device_ids[] = {
	{"TOS6200", 0},
156
	{"TOS6208", 0},
157 158 159 160 161
	{"TOS1900", 0},
	{"", 0},
};
MODULE_DEVICE_TABLE(acpi, toshiba_device_ids);

162
static const struct key_entry toshiba_acpi_keymap[] = {
163
	{ KE_KEY, 0x9e, { KEY_RFKILL } },
164 165 166
	{ KE_KEY, 0x101, { KEY_MUTE } },
	{ KE_KEY, 0x102, { KEY_ZOOMOUT } },
	{ KE_KEY, 0x103, { KEY_ZOOMIN } },
167 168
	{ KE_KEY, 0x12c, { KEY_KBDILLUMTOGGLE } },
	{ KE_KEY, 0x139, { KEY_ZOOMRESET } },
169 170 171 172 173 174 175 176
	{ 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 } },
177
	{ KE_KEY, 0x143, { KEY_TOUCHPAD_TOGGLE } },
178
	{ KE_KEY, 0x17f, { KEY_FN } },
179 180 181 182 183 184 185 186
	{ 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 } },
187
	{ KE_IGNORE, 0x1430, { KEY_RESERVED } },
188
	{ KE_END, 0 },
189 190
};

L
Linus Torvalds 已提交
191 192 193
/* utility
 */

L
Len Brown 已提交
194
static __inline__ void _set_bit(u32 * word, u32 mask, int value)
L
Linus Torvalds 已提交
195 196 197 198 199 200 201
{
	*word = (*word & ~mask) | (mask * value);
}

/* acpi interface wrappers
 */

L
Len Brown 已提交
202
static int write_acpi_int(const char *methodName, int val)
L
Linus Torvalds 已提交
203 204 205
{
	acpi_status status;

206
	status = acpi_execute_simple_method(NULL, (char *)methodName, val);
S
Seth Forshee 已提交
207
	return (status == AE_OK) ? 0 : -EIO;
L
Linus Torvalds 已提交
208 209 210 211 212
}

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

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

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

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

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

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

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

294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361
/* common sci tasks
 */

static int sci_open(struct toshiba_acpi_dev *dev)
{
	u32 in[HCI_WORDS] = { SCI_OPEN, 0, 0, 0, 0, 0 };
	u32 out[HCI_WORDS];
	acpi_status status;

	status = hci_raw(dev, in, out);
	if  (ACPI_FAILURE(status) || out[0] == HCI_FAILURE) {
		pr_err("ACPI call to open SCI failed\n");
		return 0;
	}

	if (out[0] == SCI_OPEN_CLOSE_OK) {
		return 1;
	} else if (out[0] == SCI_ALREADY_OPEN) {
		pr_info("Toshiba SCI already opened\n");
		return 1;
	} else if (out[0] == SCI_NOT_PRESENT) {
		pr_info("Toshiba SCI is not present\n");
	}

	return 0;
}

static void sci_close(struct toshiba_acpi_dev *dev)
{
	u32 in[HCI_WORDS] = { SCI_CLOSE, 0, 0, 0, 0, 0 };
	u32 out[HCI_WORDS];
	acpi_status status;

	status = hci_raw(dev, in, out);
	if (ACPI_FAILURE(status) || out[0] == HCI_FAILURE) {
		pr_err("ACPI call to close SCI failed\n");
		return;
	}

	if (out[0] == SCI_OPEN_CLOSE_OK)
		return;
	else if (out[0] == SCI_NOT_OPENED)
		pr_info("Toshiba SCI not opened\n");
	else if (out[0] == SCI_NOT_PRESENT)
		pr_info("Toshiba SCI is not present\n");
}

static acpi_status sci_read(struct toshiba_acpi_dev *dev, u32 reg,
			    u32 *out1, u32 *result)
{
	u32 in[HCI_WORDS] = { SCI_GET, reg, 0, 0, 0, 0 };
	u32 out[HCI_WORDS];
	acpi_status status = hci_raw(dev, in, out);
	*out1 = out[2];
	*result = (ACPI_SUCCESS(status)) ? out[0] : HCI_FAILURE;
	return status;
}

static acpi_status sci_write(struct toshiba_acpi_dev *dev, u32 reg,
			     u32 in1, u32 *result)
{
	u32 in[HCI_WORDS] = { SCI_SET, reg, in1, 0, 0, 0 };
	u32 out[HCI_WORDS];
	acpi_status status = hci_raw(dev, in, out);
	*result = (ACPI_SUCCESS(status)) ? out[0] : HCI_FAILURE;
	return status;
}

362
/* Illumination support */
363
static int toshiba_illumination_available(struct toshiba_acpi_dev *dev)
364 365 366 367 368 369
{
	u32 in[HCI_WORDS] = { 0, 0, 0, 0, 0, 0 };
	u32 out[HCI_WORDS];
	acpi_status status;

	in[0] = 0xf100;
370
	status = hci_raw(dev, in, out);
371
	if (ACPI_FAILURE(status)) {
372
		pr_info("Illumination device not available\n");
373 374 375
		return 0;
	}
	in[0] = 0xf400;
376
	status = hci_raw(dev, in, out);
377 378 379 380 381 382
	return 1;
}

static void toshiba_illumination_set(struct led_classdev *cdev,
				     enum led_brightness brightness)
{
383 384
	struct toshiba_acpi_dev *dev = container_of(cdev,
			struct toshiba_acpi_dev, led_dev);
385 386 387 388 389 390
	u32 in[HCI_WORDS] = { 0, 0, 0, 0, 0, 0 };
	u32 out[HCI_WORDS];
	acpi_status status;

	/* First request : initialize communication. */
	in[0] = 0xf100;
391
	status = hci_raw(dev, in, out);
392
	if (ACPI_FAILURE(status)) {
393
		pr_info("Illumination device not available\n");
394 395 396 397 398 399 400 401
		return;
	}

	if (brightness) {
		/* Switch the illumination on */
		in[0] = 0xf400;
		in[1] = 0x14e;
		in[2] = 1;
402
		status = hci_raw(dev, in, out);
403
		if (ACPI_FAILURE(status)) {
404
			pr_info("ACPI call for illumination failed\n");
405 406 407 408 409 410 411
			return;
		}
	} else {
		/* Switch the illumination off */
		in[0] = 0xf400;
		in[1] = 0x14e;
		in[2] = 0;
412
		status = hci_raw(dev, in, out);
413
		if (ACPI_FAILURE(status)) {
414
			pr_info("ACPI call for illumination failed.\n");
415 416 417 418 419 420 421 422
			return;
		}
	}

	/* Last request : close communication. */
	in[0] = 0xf200;
	in[1] = 0;
	in[2] = 0;
423
	hci_raw(dev, in, out);
424 425 426 427
}

static enum led_brightness toshiba_illumination_get(struct led_classdev *cdev)
{
428 429
	struct toshiba_acpi_dev *dev = container_of(cdev,
			struct toshiba_acpi_dev, led_dev);
430 431 432 433 434 435 436
	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;
437
	status = hci_raw(dev, in, out);
438
	if (ACPI_FAILURE(status)) {
439
		pr_info("Illumination device not available\n");
440 441 442 443 444 445
		return LED_OFF;
	}

	/* Check the illumination */
	in[0] = 0xf300;
	in[1] = 0x14e;
446
	status = hci_raw(dev, in, out);
447
	if (ACPI_FAILURE(status)) {
448
		pr_info("ACPI call for illumination failed.\n");
449 450 451 452 453 454 455 456 457
		return LED_OFF;
	}

	result = out[2] ? LED_FULL : LED_OFF;

	/* Last request : close communication. */
	in[0] = 0xf200;
	in[1] = 0;
	in[2] = 0;
458
	hci_raw(dev, in, out);
459 460 461 462

	return result;
}

463 464
/* Bluetooth rfkill handlers */

465
static u32 hci_get_bt_present(struct toshiba_acpi_dev *dev, bool *present)
466 467 468 469 470 471
{
	u32 hci_result;
	u32 value, value2;

	value = 0;
	value2 = 0;
472
	hci_read2(dev, HCI_WIRELESS, &value, &value2, &hci_result);
473 474 475 476 477 478
	if (hci_result == HCI_SUCCESS)
		*present = (value & HCI_WIRELESS_BT_PRESENT) ? true : false;

	return hci_result;
}

479
static u32 hci_get_radio_state(struct toshiba_acpi_dev *dev, bool *radio_state)
480 481 482 483 484 485
{
	u32 hci_result;
	u32 value, value2;

	value = 0;
	value2 = 0x0001;
486
	hci_read2(dev, HCI_WIRELESS, &value, &value2, &hci_result);
487 488 489 490 491

	*radio_state = value & HCI_WIRELESS_KILL_SWITCH;
	return hci_result;
}

J
Johannes Berg 已提交
492
static int bt_rfkill_set_block(void *data, bool blocked)
493
{
J
Johannes Berg 已提交
494
	struct toshiba_acpi_dev *dev = data;
495 496
	u32 result1, result2;
	u32 value;
J
Johannes Berg 已提交
497
	int err;
498 499
	bool radio_state;

J
Johannes Berg 已提交
500
	value = (blocked == false);
501

J
Johannes Berg 已提交
502
	mutex_lock(&dev->mutex);
503
	if (hci_get_radio_state(dev, &radio_state) != HCI_SUCCESS) {
S
Seth Forshee 已提交
504
		err = -EIO;
J
Johannes Berg 已提交
505 506
		goto out;
	}
507

J
Johannes Berg 已提交
508 509 510
	if (!radio_state) {
		err = 0;
		goto out;
511 512
	}

513 514
	hci_write2(dev, HCI_WIRELESS, value, HCI_WIRELESS_BT_POWER, &result1);
	hci_write2(dev, HCI_WIRELESS, value, HCI_WIRELESS_BT_ATTACH, &result2);
515 516

	if (result1 != HCI_SUCCESS || result2 != HCI_SUCCESS)
S
Seth Forshee 已提交
517
		err = -EIO;
J
Johannes Berg 已提交
518 519 520 521 522
	else
		err = 0;
 out:
	mutex_unlock(&dev->mutex);
	return err;
523 524
}

J
Johannes Berg 已提交
525
static void bt_rfkill_poll(struct rfkill *rfkill, void *data)
526 527 528 529
{
	bool new_rfk_state;
	bool value;
	u32 hci_result;
J
Johannes Berg 已提交
530 531 532
	struct toshiba_acpi_dev *dev = data;

	mutex_lock(&dev->mutex);
533

534
	hci_result = hci_get_radio_state(dev, &value);
J
Johannes Berg 已提交
535 536 537
	if (hci_result != HCI_SUCCESS) {
		/* Can't do anything useful */
		mutex_unlock(&dev->mutex);
J
Jiri Slaby 已提交
538
		return;
J
Johannes Berg 已提交
539
	}
540 541 542 543 544

	new_rfk_state = value;

	mutex_unlock(&dev->mutex);

J
Johannes Berg 已提交
545 546
	if (rfkill_set_hw_state(rfkill, !new_rfk_state))
		bt_rfkill_set_block(data, true);
547 548
}

J
Johannes Berg 已提交
549 550 551 552 553
static const struct rfkill_ops toshiba_rfk_ops = {
	.set_block = bt_rfkill_set_block,
	.poll = bt_rfkill_poll,
};

554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572
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 已提交
573
static struct proc_dir_entry *toshiba_proc_dir /*= 0*/ ;
L
Linus Torvalds 已提交
574

575
static int __get_lcd_brightness(struct toshiba_acpi_dev *dev)
L
Linus Torvalds 已提交
576 577 578
{
	u32 hci_result;
	u32 value;
579 580 581 582 583 584 585 586 587 588 589
	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 已提交
590

591
	hci_read1(dev, HCI_LCD_BRIGHTNESS, &value, &hci_result);
S
Seth Forshee 已提交
592
	if (hci_result == HCI_SUCCESS)
593
		return brightness + (value >> HCI_LCD_BRIGHTNESS_SHIFT);
S
Seth Forshee 已提交
594 595

	return -EIO;
596 597
}

598 599 600 601 602 603
static int get_lcd_brightness(struct backlight_device *bd)
{
	struct toshiba_acpi_dev *dev = bl_get_data(bd);
	return __get_lcd_brightness(dev);
}

604
static int lcd_proc_show(struct seq_file *m, void *v)
605
{
606 607
	struct toshiba_acpi_dev *dev = m->private;
	int value;
608
	int levels;
609 610 611

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

613
	levels = dev->backlight_dev->props.max_brightness + 1;
614
	value = get_lcd_brightness(dev->backlight_dev);
615
	if (value >= 0) {
616
		seq_printf(m, "brightness:              %d\n", value);
617
		seq_printf(m, "brightness_levels:       %d\n", levels);
S
Seth Forshee 已提交
618
		return 0;
L
Linus Torvalds 已提交
619 620
	}

S
Seth Forshee 已提交
621 622
	pr_err("Error reading LCD brightness\n");
	return -EIO;
623 624 625 626
}

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

630
static int set_lcd_brightness(struct toshiba_acpi_dev *dev, int value)
631 632 633
{
	u32 hci_result;

634 635 636 637 638 639 640 641 642
	if (dev->tr_backlight_supported) {
		bool enable = !value;
		int ret = set_tr_backlight_status(dev, enable);
		if (ret)
			return ret;
		if (value)
			value--;
	}

643
	value = value << HCI_LCD_BRIGHTNESS_SHIFT;
644
	hci_write1(dev, HCI_LCD_BRIGHTNESS, value, &hci_result);
S
Seth Forshee 已提交
645
	return hci_result == HCI_SUCCESS ? 0 : -EIO;
646 647 648 649
}

static int set_lcd_status(struct backlight_device *bd)
{
650
	struct toshiba_acpi_dev *dev = bl_get_data(bd);
651
	return set_lcd_brightness(dev, bd->props.brightness);
652 653
}

654 655
static ssize_t lcd_proc_write(struct file *file, const char __user *buf,
			      size_t count, loff_t *pos)
L
Linus Torvalds 已提交
656
{
A
Al Viro 已提交
657
	struct toshiba_acpi_dev *dev = PDE_DATA(file_inode(file));
658 659
	char cmd[42];
	size_t len;
L
Linus Torvalds 已提交
660
	int value;
661
	int ret;
662
	int levels = dev->backlight_dev->props.max_brightness + 1;
L
Linus Torvalds 已提交
663

664 665 666 667 668 669
	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 &&
670
	    value >= 0 && value < levels) {
671
		ret = set_lcd_brightness(dev, value);
672 673 674
		if (ret == 0)
			ret = count;
	} else {
675
		ret = -EINVAL;
676
	}
677
	return ret;
L
Linus Torvalds 已提交
678 679
}

680 681 682 683 684 685 686 687 688
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,
};

689 690 691 692 693 694 695 696
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;
}

697
static int video_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
698
{
699
	struct toshiba_acpi_dev *dev = m->private;
L
Linus Torvalds 已提交
700
	u32 value;
701
	int ret;
L
Linus Torvalds 已提交
702

703 704
	ret = get_video_status(dev, &value);
	if (!ret) {
L
Linus Torvalds 已提交
705 706
		int is_lcd = (value & HCI_VIDEO_OUT_LCD) ? 1 : 0;
		int is_crt = (value & HCI_VIDEO_OUT_CRT) ? 1 : 0;
L
Len Brown 已提交
707
		int is_tv = (value & HCI_VIDEO_OUT_TV) ? 1 : 0;
708 709 710
		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 已提交
711 712
	}

713
	return ret;
L
Linus Torvalds 已提交
714 715
}

716
static int video_proc_open(struct inode *inode, struct file *file)
L
Linus Torvalds 已提交
717
{
A
Al Viro 已提交
718
	return single_open(file, video_proc_show, PDE_DATA(inode));
719 720 721 722 723
}

static ssize_t video_proc_write(struct file *file, const char __user *buf,
				size_t count, loff_t *pos)
{
A
Al Viro 已提交
724
	struct toshiba_acpi_dev *dev = PDE_DATA(file_inode(file));
725
	char *cmd, *buffer;
726
	int ret;
L
Linus Torvalds 已提交
727 728 729 730 731
	int value;
	int remain = count;
	int lcd_out = -1;
	int crt_out = -1;
	int tv_out = -1;
A
Al Viro 已提交
732
	u32 video_out;
L
Linus Torvalds 已提交
733

734 735 736 737 738 739 740 741 742 743 744
	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 已提交
745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760
	/* 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 已提交
761
		while (remain && *(buffer - 1) != ';');
L
Linus Torvalds 已提交
762 763
	}

764 765
	kfree(cmd);

766 767
	ret = get_video_status(dev, &video_out);
	if (!ret) {
768
		unsigned int new_video_out = video_out;
L
Linus Torvalds 已提交
769 770 771 772 773 774 775 776 777
		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 已提交
778
			ret = write_acpi_int(METHOD_VIDEO_OUT, new_video_out);
L
Linus Torvalds 已提交
779 780
	}

S
Seth Forshee 已提交
781
	return ret ? ret : count;
L
Linus Torvalds 已提交
782 783
}

784 785 786 787 788 789 790 791 792
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,
};

793 794 795 796 797 798 799 800
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;
}

801
static int fan_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
802
{
803
	struct toshiba_acpi_dev *dev = m->private;
804
	int ret;
L
Linus Torvalds 已提交
805 806
	u32 value;

807 808
	ret = get_fan_status(dev, &value);
	if (!ret) {
809
		seq_printf(m, "running:                 %d\n", (value > 0));
810
		seq_printf(m, "force_on:                %d\n", dev->force_fan);
L
Linus Torvalds 已提交
811 812
	}

813
	return ret;
814 815 816 817
}

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

821 822
static ssize_t fan_proc_write(struct file *file, const char __user *buf,
			      size_t count, loff_t *pos)
L
Linus Torvalds 已提交
823
{
A
Al Viro 已提交
824
	struct toshiba_acpi_dev *dev = PDE_DATA(file_inode(file));
825 826
	char cmd[42];
	size_t len;
L
Linus Torvalds 已提交
827 828 829
	int value;
	u32 hci_result;

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, " force_on : %i", &value) == 1 &&
L
Len Brown 已提交
836
	    value >= 0 && value <= 1) {
837
		hci_write1(dev, HCI_FAN, value, &hci_result);
L
Linus Torvalds 已提交
838
		if (hci_result != HCI_SUCCESS)
S
Seth Forshee 已提交
839
			return -EIO;
L
Linus Torvalds 已提交
840
		else
841
			dev->force_fan = value;
L
Linus Torvalds 已提交
842 843 844 845 846 847 848
	} else {
		return -EINVAL;
	}

	return count;
}

849 850 851 852 853 854 855 856 857 858
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 已提交
859
{
860
	struct toshiba_acpi_dev *dev = m->private;
L
Linus Torvalds 已提交
861 862 863
	u32 hci_result;
	u32 value;

864
	if (!dev->key_event_valid && dev->system_event_supported) {
865
		hci_read1(dev, HCI_SYSTEM_EVENT, &value, &hci_result);
L
Linus Torvalds 已提交
866
		if (hci_result == HCI_SUCCESS) {
867 868
			dev->key_event_valid = 1;
			dev->last_key_event = value;
L
Linus Torvalds 已提交
869 870 871 872 873 874
		} 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. */
875
			hci_write1(dev, HCI_SYSTEM_EVENT, 1, &hci_result);
876
			pr_notice("Re-enabled hotkeys\n");
L
Linus Torvalds 已提交
877
		} else {
878
			pr_err("Error reading hotkey status\n");
S
Seth Forshee 已提交
879
			return -EIO;
L
Linus Torvalds 已提交
880 881 882
		}
	}

883 884
	seq_printf(m, "hotkey_ready:            %d\n", dev->key_event_valid);
	seq_printf(m, "hotkey:                  0x%04x\n", dev->last_key_event);
885 886
	return 0;
}
L
Linus Torvalds 已提交
887

888 889
static int keys_proc_open(struct inode *inode, struct file *file)
{
A
Al Viro 已提交
890
	return single_open(file, keys_proc_show, PDE_DATA(inode));
L
Linus Torvalds 已提交
891 892
}

893 894
static ssize_t keys_proc_write(struct file *file, const char __user *buf,
			       size_t count, loff_t *pos)
L
Linus Torvalds 已提交
895
{
A
Al Viro 已提交
896
	struct toshiba_acpi_dev *dev = PDE_DATA(file_inode(file));
897 898
	char cmd[42];
	size_t len;
L
Linus Torvalds 已提交
899 900
	int value;

901 902 903 904 905 906
	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) {
907
		dev->key_event_valid = 0;
L
Linus Torvalds 已提交
908 909 910 911 912 913 914
	} else {
		return -EINVAL;
	}

	return count;
}

915 916 917 918 919 920 921 922 923 924
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 已提交
925
{
926 927 928
	seq_printf(m, "driver:                  %s\n", TOSHIBA_ACPI_VERSION);
	seq_printf(m, "proc_interface:          %d\n", PROC_INTERFACE_VERSION);
	return 0;
L
Linus Torvalds 已提交
929 930
}

931 932
static int version_proc_open(struct inode *inode, struct file *file)
{
A
Al Viro 已提交
933
	return single_open(file, version_proc_show, PDE_DATA(inode));
934 935 936 937 938 939 940 941 942 943
}

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 已提交
944 945 946 947 948
/* proc and module init
 */

#define PROC_TOSHIBA		"toshiba"

949
static void create_toshiba_proc_entries(struct toshiba_acpi_dev *dev)
L
Linus Torvalds 已提交
950
{
951 952 953 954 955 956 957 958 959 960 961 962
	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);
963 964
	proc_create_data("version", S_IRUGO, toshiba_proc_dir,
			 &version_proc_fops, dev);
L
Linus Torvalds 已提交
965 966
}

967
static void remove_toshiba_proc_entries(struct toshiba_acpi_dev *dev)
L
Linus Torvalds 已提交
968
{
969 970 971 972 973 974 975 976
	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);
977
	remove_proc_entry("version", toshiba_proc_dir);
L
Linus Torvalds 已提交
978 979
}

L
Lionel Debroux 已提交
980
static const struct backlight_ops toshiba_backlight_data = {
981
	.options = BL_CORE_SUSPENDRESUME,
982 983
	.get_brightness = get_lcd_brightness,
	.update_status  = set_lcd_status,
984 985
};

986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020
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)
{
1021
	unsigned long long value;
1022 1023
	acpi_status status;

1024 1025 1026
	status = acpi_evaluate_integer(dev->acpi_dev->handle, "INFO",
				      NULL, &value);
	if (ACPI_FAILURE(status)) {
1027 1028 1029 1030
		pr_err("ACPI INFO method execution failed\n");
		return -EIO;
	}

1031
	return value;
1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047
}

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

1048
static int toshiba_acpi_setup_keyboard(struct toshiba_acpi_dev *dev)
1049 1050
{
	acpi_status status;
1051
	acpi_handle ec_handle;
1052
	int error;
1053
	u32 hci_result;
1054

1055
	dev->hotkey_dev = input_allocate_device();
1056
	if (!dev->hotkey_dev)
1057 1058
		return -ENOMEM;

1059
	dev->hotkey_dev->name = "Toshiba input device";
1060
	dev->hotkey_dev->phys = "toshiba_acpi/input0";
1061
	dev->hotkey_dev->id.bustype = BUS_HOST;
1062

1063
	error = sparse_keymap_setup(dev->hotkey_dev, toshiba_acpi_keymap, NULL);
1064 1065 1066
	if (error)
		goto err_free_dev;

1067 1068 1069 1070 1071 1072 1073 1074 1075
	/*
	 * 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();
1076
	if (ec_handle && acpi_has_method(ec_handle, "NTFY")) {
1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091
		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.
	 */
1092
	if (acpi_has_method(dev->acpi_dev->handle, "INFO"))
1093
		dev->info_supported = 1;
1094
	else {
1095 1096 1097 1098 1099 1100 1101 1102 1103 1104
		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;
	}

1105
	status = acpi_evaluate_object(dev->acpi_dev->handle, "ENAB", NULL, NULL);
1106
	if (ACPI_FAILURE(status)) {
1107
		pr_info("Unable to enable hotkeys\n");
1108
		error = -ENODEV;
1109
		goto err_remove_filter;
1110 1111
	}

1112
	error = input_register_device(dev->hotkey_dev);
1113
	if (error) {
1114
		pr_info("Unable to register input device\n");
1115
		goto err_remove_filter;
1116 1117
	}

1118
	hci_write1(dev, HCI_HOTKEY_EVENT, HCI_HOTKEY_ENABLE, &hci_result);
1119
	return 0;
1120

1121 1122 1123
 err_remove_filter:
	if (dev->ntfy_supported)
		i8042_remove_filter(toshiba_acpi_i8042_filter);
1124
 err_free_keymap:
1125
	sparse_keymap_free(dev->hotkey_dev);
1126
 err_free_dev:
1127 1128
	input_free_device(dev->hotkey_dev);
	dev->hotkey_dev = NULL;
1129
	return error;
1130 1131
}

1132
static int toshiba_acpi_setup_backlight(struct toshiba_acpi_dev *dev)
1133 1134 1135 1136
{
	struct backlight_properties props;
	int brightness;
	int ret;
1137
	bool enabled;
1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153

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

1154 1155 1156 1157
	/* Determine whether or not BIOS supports transflective backlight */
	ret = get_tr_backlight_status(dev, &enabled);
	dev->tr_backlight_supported = !ret;

M
Matthew Garrett 已提交
1158
	memset(&props, 0, sizeof(props));
1159 1160 1161
	props.type = BACKLIGHT_PLATFORM;
	props.max_brightness = HCI_LCD_BRIGHTNESS_LEVELS - 1;

1162 1163 1164 1165
	/* adding an extra level and having 0 change to transflective mode */
	if (dev->tr_backlight_supported)
		props.max_brightness++;

1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181
	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;
}

1182
static int toshiba_acpi_remove(struct acpi_device *acpi_dev)
1183
{
1184
	struct toshiba_acpi_dev *dev = acpi_driver_data(acpi_dev);
1185

1186
	remove_toshiba_proc_entries(dev);
1187

1188 1189 1190 1191 1192
	if (dev->ntfy_supported) {
		i8042_remove_filter(toshiba_acpi_i8042_filter);
		cancel_work_sync(&dev->hotkey_work);
	}

1193 1194 1195 1196
	if (dev->hotkey_dev) {
		input_unregister_device(dev->hotkey_dev);
		sparse_keymap_free(dev->hotkey_dev);
	}
1197

1198 1199 1200 1201
	if (dev->bt_rfk) {
		rfkill_unregister(dev->bt_rfk);
		rfkill_destroy(dev->bt_rfk);
	}
1202

1203 1204
	if (dev->backlight_dev)
		backlight_device_unregister(dev->backlight_dev);
1205

1206
	if (dev->illumination_supported)
1207
		led_classdev_unregister(&dev->led_dev);
1208

1209 1210 1211
	if (toshiba_acpi)
		toshiba_acpi = NULL;

1212
	kfree(dev);
1213

1214
	return 0;
1215 1216
}

1217
static const char *find_hci_method(acpi_handle handle)
1218
{
1219
	if (acpi_has_method(handle, "GHCI"))
1220 1221
		return "GHCI";

1222
	if (acpi_has_method(handle, "SPFC"))
1223 1224 1225 1226 1227
		return "SPFC";

	return NULL;
}

1228
static int toshiba_acpi_add(struct acpi_device *acpi_dev)
L
Linus Torvalds 已提交
1229
{
1230
	struct toshiba_acpi_dev *dev;
1231
	const char *hci_method;
1232
	u32 dummy;
1233 1234
	bool bt_present;
	int ret = 0;
L
Linus Torvalds 已提交
1235

1236 1237 1238
	if (toshiba_acpi)
		return -EBUSY;

1239 1240 1241
	pr_info("Toshiba Laptop ACPI Extras version %s\n",
	       TOSHIBA_ACPI_VERSION);

1242 1243 1244
	hci_method = find_hci_method(acpi_dev->handle);
	if (!hci_method) {
		pr_err("HCI interface not found\n");
1245
		return -ENODEV;
1246
	}
1247

1248 1249 1250 1251
	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
	if (!dev)
		return -ENOMEM;
	dev->acpi_dev = acpi_dev;
1252
	dev->method_hci = hci_method;
1253
	acpi_dev->driver_data = dev;
L
Luming Yu 已提交
1254

1255 1256
	if (toshiba_acpi_setup_keyboard(dev))
		pr_info("Unable to activate hotkeys\n");
1257 1258

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

1260 1261
	ret = toshiba_acpi_setup_backlight(dev);
	if (ret)
1262
		goto error;
L
Linus Torvalds 已提交
1263

1264
	/* Register rfkill switch for Bluetooth */
1265 1266 1267 1268 1269 1270 1271
	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) {
1272
			pr_err("unable to allocate rfkill device\n");
1273 1274
			ret = -ENOMEM;
			goto error;
1275 1276
		}

1277
		ret = rfkill_register(dev->bt_rfk);
1278
		if (ret) {
1279
			pr_err("unable to register rfkill device\n");
1280 1281
			rfkill_destroy(dev->bt_rfk);
			goto error;
1282
		}
1283 1284
	}

1285 1286 1287 1288 1289 1290
	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))
1291
			dev->illumination_supported = 1;
1292 1293
	}

1294 1295 1296 1297 1298 1299 1300 1301 1302 1303
	/* 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);

1304 1305
	toshiba_acpi = dev;

1306
	return 0;
1307 1308

error:
1309
	toshiba_acpi_remove(acpi_dev);
1310 1311 1312 1313 1314 1315 1316
	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;
1317
	int retries = 3;
1318
	int scancode;
1319

1320
	if (event != 0x80)
1321
		return;
1322

1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348
	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;
1349
			}
1350 1351
		} while (retries && hci_result != HCI_EMPTY);
	}
1352 1353
}

1354
#ifdef CONFIG_PM_SLEEP
1355
static int toshiba_acpi_suspend(struct device *device)
1356
{
1357
	struct toshiba_acpi_dev *dev = acpi_driver_data(to_acpi_device(device));
1358 1359 1360 1361 1362 1363 1364 1365
	u32 result;

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

	return 0;
}

1366
static int toshiba_acpi_resume(struct device *device)
1367
{
1368
	struct toshiba_acpi_dev *dev = acpi_driver_data(to_acpi_device(device));
1369 1370 1371 1372 1373 1374 1375
	u32 result;

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

	return 0;
}
1376
#endif
1377

1378 1379 1380
static SIMPLE_DEV_PM_OPS(toshiba_acpi_pm,
			 toshiba_acpi_suspend, toshiba_acpi_resume);

1381 1382 1383 1384 1385 1386 1387 1388 1389 1390
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,
	},
1391
	.drv.pm	= &toshiba_acpi_pm,
1392 1393 1394 1395 1396 1397
};

static int __init toshiba_acpi_init(void)
{
	int ret;

1398 1399 1400 1401 1402 1403 1404 1405
	/*
	 * 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;

1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425
	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 已提交
1426 1427 1428 1429
}

module_init(toshiba_acpi_init);
module_exit(toshiba_acpi_exit);