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

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

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

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

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

136 137 138
	struct mutex mutex;
};

139 140
static struct toshiba_acpi_dev *toshiba_acpi;

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

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

L
Linus Torvalds 已提交
177 178 179
/* utility
 */

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

/* acpi interface wrappers
 */

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

194
	params.count = ARRAY_SIZE(in_objs);
L
Linus Torvalds 已提交
195 196 197 198
	params.pointer = in_objs;
	in_objs[0].type = ACPI_TYPE_INTEGER;
	in_objs[0].integer.value = val;

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

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

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

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

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

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

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

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

287
/* Illumination support */
288
static int toshiba_illumination_available(struct toshiba_acpi_dev *dev)
289 290 291 292 293 294
{
	u32 in[HCI_WORDS] = { 0, 0, 0, 0, 0, 0 };
	u32 out[HCI_WORDS];
	acpi_status status;

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

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

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

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

	/* Last request : close communication. */
	in[0] = 0xf200;
	in[1] = 0;
	in[2] = 0;
348
	hci_raw(dev, in, out);
349 350 351 352
}

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

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

	result = out[2] ? LED_FULL : LED_OFF;

	/* Last request : close communication. */
	in[0] = 0xf200;
	in[1] = 0;
	in[2] = 0;
383
	hci_raw(dev, in, out);
384 385 386 387

	return result;
}

388 389
/* Bluetooth rfkill handlers */

390
static u32 hci_get_bt_present(struct toshiba_acpi_dev *dev, bool *present)
391 392 393 394 395 396
{
	u32 hci_result;
	u32 value, value2;

	value = 0;
	value2 = 0;
397
	hci_read2(dev, HCI_WIRELESS, &value, &value2, &hci_result);
398 399 400 401 402 403
	if (hci_result == HCI_SUCCESS)
		*present = (value & HCI_WIRELESS_BT_PRESENT) ? true : false;

	return hci_result;
}

404
static u32 hci_get_radio_state(struct toshiba_acpi_dev *dev, bool *radio_state)
405 406 407 408 409 410
{
	u32 hci_result;
	u32 value, value2;

	value = 0;
	value2 = 0x0001;
411
	hci_read2(dev, HCI_WIRELESS, &value, &value2, &hci_result);
412 413 414 415 416

	*radio_state = value & HCI_WIRELESS_KILL_SWITCH;
	return hci_result;
}

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

J
Johannes Berg 已提交
425
	value = (blocked == false);
426

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

J
Johannes Berg 已提交
433 434 435
	if (!radio_state) {
		err = 0;
		goto out;
436 437
	}

438 439
	hci_write2(dev, HCI_WIRELESS, value, HCI_WIRELESS_BT_POWER, &result1);
	hci_write2(dev, HCI_WIRELESS, value, HCI_WIRELESS_BT_ATTACH, &result2);
440 441

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

J
Johannes Berg 已提交
450
static void bt_rfkill_poll(struct rfkill *rfkill, void *data)
451 452 453 454
{
	bool new_rfk_state;
	bool value;
	u32 hci_result;
J
Johannes Berg 已提交
455 456 457
	struct toshiba_acpi_dev *dev = data;

	mutex_lock(&dev->mutex);
458

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

	new_rfk_state = value;

	mutex_unlock(&dev->mutex);

J
Johannes Berg 已提交
470 471
	if (rfkill_set_hw_state(rfkill, !new_rfk_state))
		bt_rfkill_set_block(data, true);
472 473
}

J
Johannes Berg 已提交
474 475 476 477 478
static const struct rfkill_ops toshiba_rfk_ops = {
	.set_block = bt_rfkill_set_block,
	.poll = bt_rfkill_poll,
};

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

481
static int get_lcd(struct backlight_device *bd)
L
Linus Torvalds 已提交
482
{
483
	struct toshiba_acpi_dev *dev = bl_get_data(bd);
L
Linus Torvalds 已提交
484 485 486
	u32 hci_result;
	u32 value;

487
	hci_read1(dev, HCI_LCD_BRIGHTNESS, &value, &hci_result);
S
Seth Forshee 已提交
488
	if (hci_result == HCI_SUCCESS)
489
		return (value >> HCI_LCD_BRIGHTNESS_SHIFT);
S
Seth Forshee 已提交
490 491

	return -EIO;
492 493
}

494
static int lcd_proc_show(struct seq_file *m, void *v)
495
{
496 497 498 499 500
	struct toshiba_acpi_dev *dev = m->private;
	int value;

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

502
	value = get_lcd(dev->backlight_dev);
503
	if (value >= 0) {
504 505
		seq_printf(m, "brightness:              %d\n", value);
		seq_printf(m, "brightness_levels:       %d\n",
L
Len Brown 已提交
506
			     HCI_LCD_BRIGHTNESS_LEVELS);
S
Seth Forshee 已提交
507
		return 0;
L
Linus Torvalds 已提交
508 509
	}

S
Seth Forshee 已提交
510 511
	pr_err("Error reading LCD brightness\n");
	return -EIO;
512 513 514 515
}

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

519
static int set_lcd(struct toshiba_acpi_dev *dev, int value)
520 521 522 523
{
	u32 hci_result;

	value = value << HCI_LCD_BRIGHTNESS_SHIFT;
524
	hci_write1(dev, HCI_LCD_BRIGHTNESS, value, &hci_result);
S
Seth Forshee 已提交
525
	return hci_result == HCI_SUCCESS ? 0 : -EIO;
526 527 528 529
}

static int set_lcd_status(struct backlight_device *bd)
{
530 531
	struct toshiba_acpi_dev *dev = bl_get_data(bd);
	return set_lcd(dev, bd->props.brightness);
532 533
}

534 535
static ssize_t lcd_proc_write(struct file *file, const char __user *buf,
			      size_t count, loff_t *pos)
L
Linus Torvalds 已提交
536
{
537
	struct toshiba_acpi_dev *dev = PDE(file->f_path.dentry->d_inode)->data;
538 539
	char cmd[42];
	size_t len;
L
Linus Torvalds 已提交
540
	int value;
541
	int ret;
L
Linus Torvalds 已提交
542

543 544 545 546 547 548
	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 &&
549
	    value >= 0 && value < HCI_LCD_BRIGHTNESS_LEVELS) {
550
		ret = set_lcd(dev, value);
551 552 553
		if (ret == 0)
			ret = count;
	} else {
554
		ret = -EINVAL;
555
	}
556
	return ret;
L
Linus Torvalds 已提交
557 558
}

559 560 561 562 563 564 565 566 567
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,
};

568 569 570 571 572 573 574 575
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;
}

576
static int video_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
577
{
578
	struct toshiba_acpi_dev *dev = m->private;
L
Linus Torvalds 已提交
579
	u32 value;
580
	int ret;
L
Linus Torvalds 已提交
581

582 583
	ret = get_video_status(dev, &value);
	if (!ret) {
L
Linus Torvalds 已提交
584 585
		int is_lcd = (value & HCI_VIDEO_OUT_LCD) ? 1 : 0;
		int is_crt = (value & HCI_VIDEO_OUT_CRT) ? 1 : 0;
L
Len Brown 已提交
586
		int is_tv = (value & HCI_VIDEO_OUT_TV) ? 1 : 0;
587 588 589
		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 已提交
590 591
	}

592
	return ret;
L
Linus Torvalds 已提交
593 594
}

595
static int video_proc_open(struct inode *inode, struct file *file)
L
Linus Torvalds 已提交
596
{
597
	return single_open(file, video_proc_show, PDE(inode)->data);
598 599 600 601 602
}

static ssize_t video_proc_write(struct file *file, const char __user *buf,
				size_t count, loff_t *pos)
{
603
	struct toshiba_acpi_dev *dev = PDE(file->f_path.dentry->d_inode)->data;
604
	char *cmd, *buffer;
605
	int ret;
L
Linus Torvalds 已提交
606 607 608 609 610
	int value;
	int remain = count;
	int lcd_out = -1;
	int crt_out = -1;
	int tv_out = -1;
A
Al Viro 已提交
611
	u32 video_out;
L
Linus Torvalds 已提交
612

613 614 615 616 617 618 619 620 621 622 623
	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 已提交
624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639
	/* 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 已提交
640
		while (remain && *(buffer - 1) != ';');
L
Linus Torvalds 已提交
641 642
	}

643 644
	kfree(cmd);

645 646
	ret = get_video_status(dev, &video_out);
	if (!ret) {
647
		unsigned int new_video_out = video_out;
L
Linus Torvalds 已提交
648 649 650 651 652 653 654 655 656
		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 已提交
657
			ret = write_acpi_int(METHOD_VIDEO_OUT, new_video_out);
L
Linus Torvalds 已提交
658 659
	}

S
Seth Forshee 已提交
660
	return ret ? ret : count;
L
Linus Torvalds 已提交
661 662
}

663 664 665 666 667 668 669 670 671
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,
};

672 673 674 675 676 677 678 679
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;
}

680
static int fan_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
681
{
682
	struct toshiba_acpi_dev *dev = m->private;
683
	int ret;
L
Linus Torvalds 已提交
684 685
	u32 value;

686 687
	ret = get_fan_status(dev, &value);
	if (!ret) {
688
		seq_printf(m, "running:                 %d\n", (value > 0));
689
		seq_printf(m, "force_on:                %d\n", dev->force_fan);
L
Linus Torvalds 已提交
690 691
	}

692
	return ret;
693 694 695 696
}

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

700 701
static ssize_t fan_proc_write(struct file *file, const char __user *buf,
			      size_t count, loff_t *pos)
L
Linus Torvalds 已提交
702
{
703
	struct toshiba_acpi_dev *dev = PDE(file->f_path.dentry->d_inode)->data;
704 705
	char cmd[42];
	size_t len;
L
Linus Torvalds 已提交
706 707 708
	int value;
	u32 hci_result;

709 710 711 712 713 714
	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 已提交
715
	    value >= 0 && value <= 1) {
716
		hci_write1(dev, HCI_FAN, value, &hci_result);
L
Linus Torvalds 已提交
717
		if (hci_result != HCI_SUCCESS)
S
Seth Forshee 已提交
718
			return -EIO;
L
Linus Torvalds 已提交
719
		else
720
			dev->force_fan = value;
L
Linus Torvalds 已提交
721 722 723 724 725 726 727
	} else {
		return -EINVAL;
	}

	return count;
}

728 729 730 731 732 733 734 735 736 737
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 已提交
738
{
739
	struct toshiba_acpi_dev *dev = m->private;
L
Linus Torvalds 已提交
740 741 742
	u32 hci_result;
	u32 value;

743
	if (!dev->key_event_valid && dev->system_event_supported) {
744
		hci_read1(dev, HCI_SYSTEM_EVENT, &value, &hci_result);
L
Linus Torvalds 已提交
745
		if (hci_result == HCI_SUCCESS) {
746 747
			dev->key_event_valid = 1;
			dev->last_key_event = value;
L
Linus Torvalds 已提交
748 749 750 751 752 753
		} 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. */
754
			hci_write1(dev, HCI_SYSTEM_EVENT, 1, &hci_result);
755
			pr_notice("Re-enabled hotkeys\n");
L
Linus Torvalds 已提交
756
		} else {
757
			pr_err("Error reading hotkey status\n");
S
Seth Forshee 已提交
758
			return -EIO;
L
Linus Torvalds 已提交
759 760 761
		}
	}

762 763
	seq_printf(m, "hotkey_ready:            %d\n", dev->key_event_valid);
	seq_printf(m, "hotkey:                  0x%04x\n", dev->last_key_event);
764 765
	return 0;
}
L
Linus Torvalds 已提交
766

767 768
static int keys_proc_open(struct inode *inode, struct file *file)
{
769
	return single_open(file, keys_proc_show, PDE(inode)->data);
L
Linus Torvalds 已提交
770 771
}

772 773
static ssize_t keys_proc_write(struct file *file, const char __user *buf,
			       size_t count, loff_t *pos)
L
Linus Torvalds 已提交
774
{
775
	struct toshiba_acpi_dev *dev = PDE(file->f_path.dentry->d_inode)->data;
776 777
	char cmd[42];
	size_t len;
L
Linus Torvalds 已提交
778 779
	int value;

780 781 782 783 784 785
	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) {
786
		dev->key_event_valid = 0;
L
Linus Torvalds 已提交
787 788 789 790 791 792 793
	} else {
		return -EINVAL;
	}

	return count;
}

794 795 796 797 798 799 800 801 802 803
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 已提交
804
{
805 806 807
	seq_printf(m, "driver:                  %s\n", TOSHIBA_ACPI_VERSION);
	seq_printf(m, "proc_interface:          %d\n", PROC_INTERFACE_VERSION);
	return 0;
L
Linus Torvalds 已提交
808 809
}

810 811 812 813 814 815 816 817 818 819 820 821 822
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 已提交
823 824 825 826 827
/* proc and module init
 */

#define PROC_TOSHIBA		"toshiba"

828 829
static void __devinit
create_toshiba_proc_entries(struct toshiba_acpi_dev *dev)
L
Linus Torvalds 已提交
830
{
831 832 833 834 835 836 837 838 839 840 841 842
	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);
843 844
	proc_create_data("version", S_IRUGO, toshiba_proc_dir,
			 &version_proc_fops, dev);
L
Linus Torvalds 已提交
845 846
}

847
static void remove_toshiba_proc_entries(struct toshiba_acpi_dev *dev)
L
Linus Torvalds 已提交
848
{
849 850 851 852 853 854 855 856
	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);
857
	remove_proc_entry("version", toshiba_proc_dir);
L
Linus Torvalds 已提交
858 859
}

L
Lionel Debroux 已提交
860
static const struct backlight_ops toshiba_backlight_data = {
861 862 863 864
        .get_brightness = get_lcd,
        .update_status  = set_lcd_status,
};

865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 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
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);
}

931
static int __devinit toshiba_acpi_setup_keyboard(struct toshiba_acpi_dev *dev)
932 933
{
	acpi_status status;
934
	acpi_handle ec_handle, handle;
935
	int error;
936
	u32 hci_result;
937

938 939
	dev->hotkey_dev = input_allocate_device();
	if (!dev->hotkey_dev) {
940
		pr_info("Unable to register input device\n");
941 942 943
		return -ENOMEM;
	}

944
	dev->hotkey_dev->name = "Toshiba input device";
945
	dev->hotkey_dev->phys = "toshiba_acpi/input0";
946
	dev->hotkey_dev->id.bustype = BUS_HOST;
947

948
	error = sparse_keymap_setup(dev->hotkey_dev, toshiba_acpi_keymap, NULL);
949 950 951
	if (error)
		goto err_free_dev;

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 982 983 984 985 986 987 988 989 990 991 992 993
	/*
	 * 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;
	}

994
	status = acpi_evaluate_object(dev->acpi_dev->handle, "ENAB", NULL, NULL);
995
	if (ACPI_FAILURE(status)) {
996
		pr_info("Unable to enable hotkeys\n");
997
		error = -ENODEV;
998
		goto err_remove_filter;
999 1000
	}

1001
	error = input_register_device(dev->hotkey_dev);
1002
	if (error) {
1003
		pr_info("Unable to register input device\n");
1004
		goto err_remove_filter;
1005 1006
	}

1007
	hci_write1(dev, HCI_HOTKEY_EVENT, HCI_HOTKEY_ENABLE, &hci_result);
1008
	return 0;
1009

1010 1011 1012
 err_remove_filter:
	if (dev->ntfy_supported)
		i8042_remove_filter(toshiba_acpi_i8042_filter);
1013
 err_free_keymap:
1014
	sparse_keymap_free(dev->hotkey_dev);
1015
 err_free_dev:
1016 1017
	input_free_device(dev->hotkey_dev);
	dev->hotkey_dev = NULL;
1018
	return error;
1019 1020
}

1021
static int toshiba_acpi_remove(struct acpi_device *acpi_dev, int type)
1022
{
1023
	struct toshiba_acpi_dev *dev = acpi_driver_data(acpi_dev);
1024

1025
	remove_toshiba_proc_entries(dev);
1026

1027 1028 1029 1030 1031
	if (dev->ntfy_supported) {
		i8042_remove_filter(toshiba_acpi_i8042_filter);
		cancel_work_sync(&dev->hotkey_work);
	}

1032 1033 1034 1035
	if (dev->hotkey_dev) {
		input_unregister_device(dev->hotkey_dev);
		sparse_keymap_free(dev->hotkey_dev);
	}
1036

1037 1038 1039 1040
	if (dev->bt_rfk) {
		rfkill_unregister(dev->bt_rfk);
		rfkill_destroy(dev->bt_rfk);
	}
1041

1042 1043
	if (dev->backlight_dev)
		backlight_device_unregister(dev->backlight_dev);
1044

1045
	if (dev->illumination_supported)
1046
		led_classdev_unregister(&dev->led_dev);
1047

1048 1049 1050
	if (toshiba_acpi)
		toshiba_acpi = NULL;

1051
	kfree(dev);
1052

1053
	return 0;
1054 1055
}

1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071
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;
}

1072
static int __devinit toshiba_acpi_add(struct acpi_device *acpi_dev)
L
Linus Torvalds 已提交
1073
{
1074
	struct toshiba_acpi_dev *dev;
1075
	const char *hci_method;
1076
	u32 dummy;
1077 1078
	bool bt_present;
	int ret = 0;
1079
	struct backlight_properties props;
L
Linus Torvalds 已提交
1080

1081 1082 1083
	if (toshiba_acpi)
		return -EBUSY;

1084 1085 1086
	pr_info("Toshiba Laptop ACPI Extras version %s\n",
	       TOSHIBA_ACPI_VERSION);

1087 1088 1089
	hci_method = find_hci_method(acpi_dev->handle);
	if (!hci_method) {
		pr_err("HCI interface not found\n");
1090
		return -ENODEV;
1091
	}
1092

1093 1094 1095 1096
	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
	if (!dev)
		return -ENOMEM;
	dev->acpi_dev = acpi_dev;
1097
	dev->method_hci = hci_method;
1098
	acpi_dev->driver_data = dev;
L
Luming Yu 已提交
1099

1100 1101
	if (toshiba_acpi_setup_keyboard(dev))
		pr_info("Unable to activate hotkeys\n");
1102 1103

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

M
Matthew Garrett 已提交
1105
	props.type = BACKLIGHT_PLATFORM;
1106
	props.max_brightness = HCI_LCD_BRIGHTNESS_LEVELS - 1;
1107 1108 1109 1110 1111 1112 1113
	dev->backlight_dev = backlight_device_register("toshiba",
						       &acpi_dev->dev,
						       dev,
						       &toshiba_backlight_data,
						       &props);
	if (IS_ERR(dev->backlight_dev)) {
		ret = PTR_ERR(dev->backlight_dev);
1114

1115
		pr_err("Could not register toshiba backlight device\n");
1116 1117
		dev->backlight_dev = NULL;
		goto error;
1118
	}
1119
	dev->backlight_dev->props.brightness = get_lcd(dev->backlight_dev);
L
Linus Torvalds 已提交
1120

1121
	/* Register rfkill switch for Bluetooth */
1122 1123 1124 1125 1126 1127 1128
	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) {
1129
			pr_err("unable to allocate rfkill device\n");
1130 1131
			ret = -ENOMEM;
			goto error;
1132 1133
		}

1134
		ret = rfkill_register(dev->bt_rfk);
1135
		if (ret) {
1136
			pr_err("unable to register rfkill device\n");
1137 1138
			rfkill_destroy(dev->bt_rfk);
			goto error;
1139
		}
1140 1141
	}

1142 1143 1144 1145 1146 1147
	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))
1148
			dev->illumination_supported = 1;
1149 1150
	}

1151 1152 1153 1154 1155 1156 1157 1158 1159 1160
	/* 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);

1161 1162
	toshiba_acpi = dev;

1163
	return 0;
1164 1165 1166 1167 1168 1169 1170 1171 1172 1173

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;
1174
	int retries = 3;
1175
	int scancode;
1176

1177
	if (event != 0x80)
1178
		return;
1179

1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205
	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;
1206
			}
1207 1208
		} while (retries && hci_result != HCI_EMPTY);
	}
1209 1210
}

1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232
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;
}
1233 1234 1235 1236 1237 1238 1239 1240 1241 1242

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,
1243 1244
		.suspend	= toshiba_acpi_suspend,
		.resume		= toshiba_acpi_resume,
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 1270 1271
	},
};

static int __init toshiba_acpi_init(void)
{
	int ret;

	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 已提交
1272 1273 1274 1275
}

module_init(toshiba_acpi_init);
module_exit(toshiba_acpi_exit);