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

L
Linus Torvalds 已提交
56 57 58 59 60 61 62 63 64 65 66 67 68 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
#include <asm/uaccess.h>

#include <acpi/acpi_drivers.h>

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

/* 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
95
#define HCI_WIRELESS			0x0056
L
Linus Torvalds 已提交
96 97 98 99 100 101 102 103

/* field definitions */
#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
104 105 106 107
#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 已提交
108

109 110 111 112 113 114 115
struct toshiba_acpi_dev {
	struct acpi_device *acpi_dev;
	const char *method_hci;
	struct rfkill *bt_rfk;
	struct input_dev *hotkey_dev;
	struct backlight_device *backlight_dev;
	struct led_classdev led_dev;
116

117 118 119 120
	int force_fan;
	int last_key_event;
	int key_event_valid;

121 122 123 124
	int illumination_supported:1;
	int video_supported:1;
	int fan_supported:1;

125 126 127
	struct mutex mutex;
};

128 129
static const struct acpi_device_id toshiba_device_ids[] = {
	{"TOS6200", 0},
130
	{"TOS6208", 0},
131 132 133 134 135
	{"TOS1900", 0},
	{"", 0},
};
MODULE_DEVICE_TABLE(acpi, toshiba_device_ids);

136
static const struct key_entry toshiba_acpi_keymap[] __devinitconst = {
137 138 139 140 141 142 143 144 145 146 147 148
	{ KE_KEY, 0x101, { KEY_MUTE } },
	{ KE_KEY, 0x102, { KEY_ZOOMOUT } },
	{ KE_KEY, 0x103, { KEY_ZOOMIN } },
	{ 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 } },
	{ KE_KEY, 0x143, { KEY_PROG1 } },
149
	{ KE_KEY, 0x17f, { KEY_FN } },
150 151 152 153 154 155 156 157 158
	{ 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 } },
	{ KE_END, 0 },
159 160
};

L
Linus Torvalds 已提交
161 162 163
/* utility
 */

L
Len Brown 已提交
164
static __inline__ void _set_bit(u32 * word, u32 mask, int value)
L
Linus Torvalds 已提交
165 166 167 168 169 170 171
{
	*word = (*word & ~mask) | (mask * value);
}

/* acpi interface wrappers
 */

L
Len Brown 已提交
172
static int write_acpi_int(const char *methodName, int val)
L
Linus Torvalds 已提交
173 174 175 176 177
{
	struct acpi_object_list params;
	union acpi_object in_objs[1];
	acpi_status status;

178
	params.count = ARRAY_SIZE(in_objs);
L
Linus Torvalds 已提交
179 180 181 182
	params.pointer = in_objs;
	in_objs[0].type = ACPI_TYPE_INTEGER;
	in_objs[0].integer.value = val;

L
Len Brown 已提交
183
	status = acpi_evaluate_object(NULL, (char *)methodName, &params, NULL);
S
Seth Forshee 已提交
184
	return (status == AE_OK) ? 0 : -EIO;
L
Linus Torvalds 已提交
185 186 187 188 189
}

/* Perform a raw HCI call.  Here we don't care about input or output buffer
 * format.
 */
190 191
static acpi_status hci_raw(struct toshiba_acpi_dev *dev,
			   const u32 in[HCI_WORDS], u32 out[HCI_WORDS])
L
Linus Torvalds 已提交
192 193 194 195
{
	struct acpi_object_list params;
	union acpi_object in_objs[HCI_WORDS];
	struct acpi_buffer results;
L
Len Brown 已提交
196
	union acpi_object out_objs[HCI_WORDS + 1];
L
Linus Torvalds 已提交
197 198 199 200 201 202 203 204 205 206 207 208 209
	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;

210 211
	status = acpi_evaluate_object(dev->acpi_dev->handle,
				      (char *)dev->method_hci, &params,
L
Len Brown 已提交
212
				      &results);
L
Linus Torvalds 已提交
213 214 215 216 217 218 219 220 221
	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;
}

222
/* common hci tasks (get or set one or two value)
L
Linus Torvalds 已提交
223 224 225 226 227
 *
 * In addition to the ACPI status, the HCI system returns a result which
 * may be useful (such as "not supported").
 */

228 229
static acpi_status hci_write1(struct toshiba_acpi_dev *dev, u32 reg,
			      u32 in1, u32 *result)
L
Linus Torvalds 已提交
230 231 232
{
	u32 in[HCI_WORDS] = { HCI_SET, reg, in1, 0, 0, 0 };
	u32 out[HCI_WORDS];
233
	acpi_status status = hci_raw(dev, in, out);
L
Linus Torvalds 已提交
234 235 236 237
	*result = (status == AE_OK) ? out[0] : HCI_FAILURE;
	return status;
}

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

249 250
static acpi_status hci_write2(struct toshiba_acpi_dev *dev, u32 reg,
			      u32 in1, u32 in2, u32 *result)
251 252 253
{
	u32 in[HCI_WORDS] = { HCI_SET, reg, in1, in2, 0, 0 };
	u32 out[HCI_WORDS];
254
	acpi_status status = hci_raw(dev, in, out);
255 256 257 258
	*result = (status == AE_OK) ? out[0] : HCI_FAILURE;
	return status;
}

259 260
static acpi_status hci_read2(struct toshiba_acpi_dev *dev, u32 reg,
			     u32 *out1, u32 *out2, u32 *result)
261 262 263
{
	u32 in[HCI_WORDS] = { HCI_GET, reg, *out1, *out2, 0, 0 };
	u32 out[HCI_WORDS];
264
	acpi_status status = hci_raw(dev, in, out);
265 266 267 268 269 270
	*out1 = out[2];
	*out2 = out[3];
	*result = (status == AE_OK) ? out[0] : HCI_FAILURE;
	return status;
}

271
/* Illumination support */
272
static int toshiba_illumination_available(struct toshiba_acpi_dev *dev)
273 274 275 276 277 278
{
	u32 in[HCI_WORDS] = { 0, 0, 0, 0, 0, 0 };
	u32 out[HCI_WORDS];
	acpi_status status;

	in[0] = 0xf100;
279
	status = hci_raw(dev, in, out);
280
	if (ACPI_FAILURE(status)) {
281
		pr_info("Illumination device not available\n");
282 283 284
		return 0;
	}
	in[0] = 0xf400;
285
	status = hci_raw(dev, in, out);
286 287 288 289 290 291
	return 1;
}

static void toshiba_illumination_set(struct led_classdev *cdev,
				     enum led_brightness brightness)
{
292 293
	struct toshiba_acpi_dev *dev = container_of(cdev,
			struct toshiba_acpi_dev, led_dev);
294 295 296 297 298 299
	u32 in[HCI_WORDS] = { 0, 0, 0, 0, 0, 0 };
	u32 out[HCI_WORDS];
	acpi_status status;

	/* First request : initialize communication. */
	in[0] = 0xf100;
300
	status = hci_raw(dev, in, out);
301
	if (ACPI_FAILURE(status)) {
302
		pr_info("Illumination device not available\n");
303 304 305 306 307 308 309 310
		return;
	}

	if (brightness) {
		/* Switch the illumination on */
		in[0] = 0xf400;
		in[1] = 0x14e;
		in[2] = 1;
311
		status = hci_raw(dev, in, out);
312
		if (ACPI_FAILURE(status)) {
313
			pr_info("ACPI call for illumination failed\n");
314 315 316 317 318 319 320
			return;
		}
	} else {
		/* Switch the illumination off */
		in[0] = 0xf400;
		in[1] = 0x14e;
		in[2] = 0;
321
		status = hci_raw(dev, in, out);
322
		if (ACPI_FAILURE(status)) {
323
			pr_info("ACPI call for illumination failed.\n");
324 325 326 327 328 329 330 331
			return;
		}
	}

	/* Last request : close communication. */
	in[0] = 0xf200;
	in[1] = 0;
	in[2] = 0;
332
	hci_raw(dev, in, out);
333 334 335 336
}

static enum led_brightness toshiba_illumination_get(struct led_classdev *cdev)
{
337 338
	struct toshiba_acpi_dev *dev = container_of(cdev,
			struct toshiba_acpi_dev, led_dev);
339 340 341 342 343 344 345
	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;
346
	status = hci_raw(dev, in, out);
347
	if (ACPI_FAILURE(status)) {
348
		pr_info("Illumination device not available\n");
349 350 351 352 353 354
		return LED_OFF;
	}

	/* Check the illumination */
	in[0] = 0xf300;
	in[1] = 0x14e;
355
	status = hci_raw(dev, in, out);
356
	if (ACPI_FAILURE(status)) {
357
		pr_info("ACPI call for illumination failed.\n");
358 359 360 361 362 363 364 365 366
		return LED_OFF;
	}

	result = out[2] ? LED_FULL : LED_OFF;

	/* Last request : close communication. */
	in[0] = 0xf200;
	in[1] = 0;
	in[2] = 0;
367
	hci_raw(dev, in, out);
368 369 370 371

	return result;
}

372 373
/* Bluetooth rfkill handlers */

374
static u32 hci_get_bt_present(struct toshiba_acpi_dev *dev, bool *present)
375 376 377 378 379 380
{
	u32 hci_result;
	u32 value, value2;

	value = 0;
	value2 = 0;
381
	hci_read2(dev, HCI_WIRELESS, &value, &value2, &hci_result);
382 383 384 385 386 387
	if (hci_result == HCI_SUCCESS)
		*present = (value & HCI_WIRELESS_BT_PRESENT) ? true : false;

	return hci_result;
}

388
static u32 hci_get_radio_state(struct toshiba_acpi_dev *dev, bool *radio_state)
389 390 391 392 393 394
{
	u32 hci_result;
	u32 value, value2;

	value = 0;
	value2 = 0x0001;
395
	hci_read2(dev, HCI_WIRELESS, &value, &value2, &hci_result);
396 397 398 399 400

	*radio_state = value & HCI_WIRELESS_KILL_SWITCH;
	return hci_result;
}

J
Johannes Berg 已提交
401
static int bt_rfkill_set_block(void *data, bool blocked)
402
{
J
Johannes Berg 已提交
403
	struct toshiba_acpi_dev *dev = data;
404 405
	u32 result1, result2;
	u32 value;
J
Johannes Berg 已提交
406
	int err;
407 408
	bool radio_state;

J
Johannes Berg 已提交
409
	value = (blocked == false);
410

J
Johannes Berg 已提交
411
	mutex_lock(&dev->mutex);
412
	if (hci_get_radio_state(dev, &radio_state) != HCI_SUCCESS) {
S
Seth Forshee 已提交
413
		err = -EIO;
J
Johannes Berg 已提交
414 415
		goto out;
	}
416

J
Johannes Berg 已提交
417 418 419
	if (!radio_state) {
		err = 0;
		goto out;
420 421
	}

422 423
	hci_write2(dev, HCI_WIRELESS, value, HCI_WIRELESS_BT_POWER, &result1);
	hci_write2(dev, HCI_WIRELESS, value, HCI_WIRELESS_BT_ATTACH, &result2);
424 425

	if (result1 != HCI_SUCCESS || result2 != HCI_SUCCESS)
S
Seth Forshee 已提交
426
		err = -EIO;
J
Johannes Berg 已提交
427 428 429 430 431
	else
		err = 0;
 out:
	mutex_unlock(&dev->mutex);
	return err;
432 433
}

J
Johannes Berg 已提交
434
static void bt_rfkill_poll(struct rfkill *rfkill, void *data)
435 436 437 438
{
	bool new_rfk_state;
	bool value;
	u32 hci_result;
J
Johannes Berg 已提交
439 440 441
	struct toshiba_acpi_dev *dev = data;

	mutex_lock(&dev->mutex);
442

443
	hci_result = hci_get_radio_state(dev, &value);
J
Johannes Berg 已提交
444 445 446
	if (hci_result != HCI_SUCCESS) {
		/* Can't do anything useful */
		mutex_unlock(&dev->mutex);
J
Jiri Slaby 已提交
447
		return;
J
Johannes Berg 已提交
448
	}
449 450 451 452 453

	new_rfk_state = value;

	mutex_unlock(&dev->mutex);

J
Johannes Berg 已提交
454 455
	if (rfkill_set_hw_state(rfkill, !new_rfk_state))
		bt_rfkill_set_block(data, true);
456 457
}

J
Johannes Berg 已提交
458 459 460 461 462
static const struct rfkill_ops toshiba_rfk_ops = {
	.set_block = bt_rfkill_set_block,
	.poll = bt_rfkill_poll,
};

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

465
static int get_lcd(struct backlight_device *bd)
L
Linus Torvalds 已提交
466
{
467
	struct toshiba_acpi_dev *dev = bl_get_data(bd);
L
Linus Torvalds 已提交
468 469 470
	u32 hci_result;
	u32 value;

471
	hci_read1(dev, HCI_LCD_BRIGHTNESS, &value, &hci_result);
S
Seth Forshee 已提交
472
	if (hci_result == HCI_SUCCESS)
473
		return (value >> HCI_LCD_BRIGHTNESS_SHIFT);
S
Seth Forshee 已提交
474 475

	return -EIO;
476 477
}

478
static int lcd_proc_show(struct seq_file *m, void *v)
479
{
480 481 482 483 484
	struct toshiba_acpi_dev *dev = m->private;
	int value;

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

486
	value = get_lcd(dev->backlight_dev);
487
	if (value >= 0) {
488 489
		seq_printf(m, "brightness:              %d\n", value);
		seq_printf(m, "brightness_levels:       %d\n",
L
Len Brown 已提交
490
			     HCI_LCD_BRIGHTNESS_LEVELS);
S
Seth Forshee 已提交
491
		return 0;
L
Linus Torvalds 已提交
492 493
	}

S
Seth Forshee 已提交
494 495
	pr_err("Error reading LCD brightness\n");
	return -EIO;
496 497 498 499
}

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

503
static int set_lcd(struct toshiba_acpi_dev *dev, int value)
504 505 506 507
{
	u32 hci_result;

	value = value << HCI_LCD_BRIGHTNESS_SHIFT;
508
	hci_write1(dev, HCI_LCD_BRIGHTNESS, value, &hci_result);
S
Seth Forshee 已提交
509
	return hci_result == HCI_SUCCESS ? 0 : -EIO;
510 511 512 513
}

static int set_lcd_status(struct backlight_device *bd)
{
514 515
	struct toshiba_acpi_dev *dev = bl_get_data(bd);
	return set_lcd(dev, bd->props.brightness);
516 517
}

518 519
static ssize_t lcd_proc_write(struct file *file, const char __user *buf,
			      size_t count, loff_t *pos)
L
Linus Torvalds 已提交
520
{
521
	struct toshiba_acpi_dev *dev = PDE(file->f_path.dentry->d_inode)->data;
522 523
	char cmd[42];
	size_t len;
L
Linus Torvalds 已提交
524
	int value;
525
	int ret;
L
Linus Torvalds 已提交
526

527 528 529 530 531 532
	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 &&
533
	    value >= 0 && value < HCI_LCD_BRIGHTNESS_LEVELS) {
534
		ret = set_lcd(dev, value);
535 536 537
		if (ret == 0)
			ret = count;
	} else {
538
		ret = -EINVAL;
539
	}
540
	return ret;
L
Linus Torvalds 已提交
541 542
}

543 544 545 546 547 548 549 550 551
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,
};

552 553 554 555 556 557 558 559
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;
}

560
static int video_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
561
{
562
	struct toshiba_acpi_dev *dev = m->private;
L
Linus Torvalds 已提交
563
	u32 value;
564
	int ret;
L
Linus Torvalds 已提交
565

566 567
	ret = get_video_status(dev, &value);
	if (!ret) {
L
Linus Torvalds 已提交
568 569
		int is_lcd = (value & HCI_VIDEO_OUT_LCD) ? 1 : 0;
		int is_crt = (value & HCI_VIDEO_OUT_CRT) ? 1 : 0;
L
Len Brown 已提交
570
		int is_tv = (value & HCI_VIDEO_OUT_TV) ? 1 : 0;
571 572 573
		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 已提交
574 575
	}

576
	return ret;
L
Linus Torvalds 已提交
577 578
}

579
static int video_proc_open(struct inode *inode, struct file *file)
L
Linus Torvalds 已提交
580
{
581
	return single_open(file, video_proc_show, PDE(inode)->data);
582 583 584 585 586
}

static ssize_t video_proc_write(struct file *file, const char __user *buf,
				size_t count, loff_t *pos)
{
587
	struct toshiba_acpi_dev *dev = PDE(file->f_path.dentry->d_inode)->data;
588
	char *cmd, *buffer;
589
	int ret;
L
Linus Torvalds 已提交
590 591 592 593 594
	int value;
	int remain = count;
	int lcd_out = -1;
	int crt_out = -1;
	int tv_out = -1;
A
Al Viro 已提交
595
	u32 video_out;
L
Linus Torvalds 已提交
596

597 598 599 600 601 602 603 604 605 606 607
	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 已提交
608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623
	/* 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 已提交
624
		while (remain && *(buffer - 1) != ';');
L
Linus Torvalds 已提交
625 626
	}

627 628
	kfree(cmd);

629 630
	ret = get_video_status(dev, &video_out);
	if (!ret) {
631
		unsigned int new_video_out = video_out;
L
Linus Torvalds 已提交
632 633 634 635 636 637 638 639 640
		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 已提交
641
			ret = write_acpi_int(METHOD_VIDEO_OUT, new_video_out);
L
Linus Torvalds 已提交
642 643
	}

S
Seth Forshee 已提交
644
	return ret ? ret : count;
L
Linus Torvalds 已提交
645 646
}

647 648 649 650 651 652 653 654 655
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,
};

656 657 658 659 660 661 662 663
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;
}

664
static int fan_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
665
{
666
	struct toshiba_acpi_dev *dev = m->private;
667
	int ret;
L
Linus Torvalds 已提交
668 669
	u32 value;

670 671
	ret = get_fan_status(dev, &value);
	if (!ret) {
672
		seq_printf(m, "running:                 %d\n", (value > 0));
673
		seq_printf(m, "force_on:                %d\n", dev->force_fan);
L
Linus Torvalds 已提交
674 675
	}

676
	return ret;
677 678 679 680
}

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

684 685
static ssize_t fan_proc_write(struct file *file, const char __user *buf,
			      size_t count, loff_t *pos)
L
Linus Torvalds 已提交
686
{
687
	struct toshiba_acpi_dev *dev = PDE(file->f_path.dentry->d_inode)->data;
688 689
	char cmd[42];
	size_t len;
L
Linus Torvalds 已提交
690 691 692
	int value;
	u32 hci_result;

693 694 695 696 697 698
	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 已提交
699
	    value >= 0 && value <= 1) {
700
		hci_write1(dev, HCI_FAN, value, &hci_result);
L
Linus Torvalds 已提交
701
		if (hci_result != HCI_SUCCESS)
S
Seth Forshee 已提交
702
			return -EIO;
L
Linus Torvalds 已提交
703
		else
704
			dev->force_fan = value;
L
Linus Torvalds 已提交
705 706 707 708 709 710 711
	} else {
		return -EINVAL;
	}

	return count;
}

712 713 714 715 716 717 718 719 720 721
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 已提交
722
{
723
	struct toshiba_acpi_dev *dev = m->private;
L
Linus Torvalds 已提交
724 725 726
	u32 hci_result;
	u32 value;

727 728
	if (!dev->key_event_valid) {
		hci_read1(dev, HCI_SYSTEM_EVENT, &value, &hci_result);
L
Linus Torvalds 已提交
729
		if (hci_result == HCI_SUCCESS) {
730 731
			dev->key_event_valid = 1;
			dev->last_key_event = value;
L
Linus Torvalds 已提交
732 733 734 735 736 737
		} 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. */
738
			hci_write1(dev, HCI_SYSTEM_EVENT, 1, &hci_result);
739
			pr_notice("Re-enabled hotkeys\n");
L
Linus Torvalds 已提交
740
		} else {
741
			pr_err("Error reading hotkey status\n");
S
Seth Forshee 已提交
742
			return -EIO;
L
Linus Torvalds 已提交
743 744 745
		}
	}

746 747
	seq_printf(m, "hotkey_ready:            %d\n", dev->key_event_valid);
	seq_printf(m, "hotkey:                  0x%04x\n", dev->last_key_event);
748 749
	return 0;
}
L
Linus Torvalds 已提交
750

751 752
static int keys_proc_open(struct inode *inode, struct file *file)
{
753
	return single_open(file, keys_proc_show, PDE(inode)->data);
L
Linus Torvalds 已提交
754 755
}

756 757
static ssize_t keys_proc_write(struct file *file, const char __user *buf,
			       size_t count, loff_t *pos)
L
Linus Torvalds 已提交
758
{
759
	struct toshiba_acpi_dev *dev = PDE(file->f_path.dentry->d_inode)->data;
760 761
	char cmd[42];
	size_t len;
L
Linus Torvalds 已提交
762 763
	int value;

764 765 766 767 768 769
	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) {
770
		dev->key_event_valid = 0;
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 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 已提交
788
{
789 790 791
	seq_printf(m, "driver:                  %s\n", TOSHIBA_ACPI_VERSION);
	seq_printf(m, "proc_interface:          %d\n", PROC_INTERFACE_VERSION);
	return 0;
L
Linus Torvalds 已提交
792 793
}

794 795 796 797 798 799 800 801 802 803 804 805 806
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 已提交
807 808 809 810 811
/* proc and module init
 */

#define PROC_TOSHIBA		"toshiba"

812 813
static void __devinit
create_toshiba_proc_entries(struct toshiba_acpi_dev *dev)
L
Linus Torvalds 已提交
814
{
815 816 817 818 819 820 821 822 823 824 825 826
	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);
827 828
	proc_create_data("version", S_IRUGO, toshiba_proc_dir,
			 &version_proc_fops, dev);
L
Linus Torvalds 已提交
829 830
}

831
static void remove_toshiba_proc_entries(struct toshiba_acpi_dev *dev)
L
Linus Torvalds 已提交
832
{
833 834 835 836 837 838 839 840
	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);
841
	remove_proc_entry("version", toshiba_proc_dir);
L
Linus Torvalds 已提交
842 843
}

L
Lionel Debroux 已提交
844
static const struct backlight_ops toshiba_backlight_data = {
845 846 847 848
        .get_brightness = get_lcd,
        .update_status  = set_lcd_status,
};

849
static int __devinit toshiba_acpi_setup_keyboard(struct toshiba_acpi_dev *dev)
850 851
{
	acpi_status status;
852
	int error;
853

854 855
	dev->hotkey_dev = input_allocate_device();
	if (!dev->hotkey_dev) {
856
		pr_info("Unable to register input device\n");
857 858 859
		return -ENOMEM;
	}

860
	dev->hotkey_dev->name = "Toshiba input device";
861
	dev->hotkey_dev->phys = "toshiba_acpi/input0";
862
	dev->hotkey_dev->id.bustype = BUS_HOST;
863

864
	error = sparse_keymap_setup(dev->hotkey_dev, toshiba_acpi_keymap, NULL);
865 866 867
	if (error)
		goto err_free_dev;

868
	status = acpi_evaluate_object(dev->acpi_dev->handle, "ENAB", NULL, NULL);
869
	if (ACPI_FAILURE(status)) {
870
		pr_info("Unable to enable hotkeys\n");
871
		error = -ENODEV;
872
		goto err_free_keymap;
873 874
	}

875
	error = input_register_device(dev->hotkey_dev);
876
	if (error) {
877
		pr_info("Unable to register input device\n");
878
		goto err_free_keymap;
879 880 881
	}

	return 0;
882 883

 err_free_keymap:
884
	sparse_keymap_free(dev->hotkey_dev);
885
 err_free_dev:
886 887
	input_free_device(dev->hotkey_dev);
	dev->hotkey_dev = NULL;
888
	return error;
889 890
}

891
static int toshiba_acpi_remove(struct acpi_device *acpi_dev, int type)
892
{
893
	struct toshiba_acpi_dev *dev = acpi_driver_data(acpi_dev);
894

895
	remove_toshiba_proc_entries(dev);
896

897 898 899 900
	if (dev->hotkey_dev) {
		input_unregister_device(dev->hotkey_dev);
		sparse_keymap_free(dev->hotkey_dev);
	}
901

902 903 904 905
	if (dev->bt_rfk) {
		rfkill_unregister(dev->bt_rfk);
		rfkill_destroy(dev->bt_rfk);
	}
906

907 908
	if (dev->backlight_dev)
		backlight_device_unregister(dev->backlight_dev);
909

910
	if (dev->illumination_supported)
911
		led_classdev_unregister(&dev->led_dev);
912

913
	kfree(dev);
914

915
	return 0;
916 917
}

918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933
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;
}

934
static int __devinit toshiba_acpi_add(struct acpi_device *acpi_dev)
L
Linus Torvalds 已提交
935
{
936
	struct toshiba_acpi_dev *dev;
937
	const char *hci_method;
L
Linus Torvalds 已提交
938
	u32 hci_result;
939
	u32 dummy;
940 941
	bool bt_present;
	int ret = 0;
942
	struct backlight_properties props;
L
Linus Torvalds 已提交
943

944 945 946
	pr_info("Toshiba Laptop ACPI Extras version %s\n",
	       TOSHIBA_ACPI_VERSION);

947 948 949
	hci_method = find_hci_method(acpi_dev->handle);
	if (!hci_method) {
		pr_err("HCI interface not found\n");
950
		return -ENODEV;
951
	}
952

953 954 955 956
	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
	if (!dev)
		return -ENOMEM;
	dev->acpi_dev = acpi_dev;
957
	dev->method_hci = hci_method;
958
	acpi_dev->driver_data = dev;
L
Luming Yu 已提交
959

960 961
	if (toshiba_acpi_setup_keyboard(dev))
		pr_info("Unable to activate hotkeys\n");
962 963

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

	/* enable event fifo */
966
	hci_write1(dev, HCI_SYSTEM_EVENT, 1, &hci_result);
L
Linus Torvalds 已提交
967

M
Matthew Garrett 已提交
968
	props.type = BACKLIGHT_PLATFORM;
969
	props.max_brightness = HCI_LCD_BRIGHTNESS_LEVELS - 1;
970 971 972 973 974 975 976
	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);
977

978
		pr_err("Could not register toshiba backlight device\n");
979 980
		dev->backlight_dev = NULL;
		goto error;
981
	}
L
Linus Torvalds 已提交
982

983
	/* Register rfkill switch for Bluetooth */
984 985 986 987 988 989 990
	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) {
991
			pr_err("unable to allocate rfkill device\n");
992 993
			ret = -ENOMEM;
			goto error;
994 995
		}

996
		ret = rfkill_register(dev->bt_rfk);
997
		if (ret) {
998
			pr_err("unable to register rfkill device\n");
999 1000
			rfkill_destroy(dev->bt_rfk);
			goto error;
1001
		}
1002 1003
	}

1004 1005 1006 1007 1008 1009
	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))
1010
			dev->illumination_supported = 1;
1011 1012
	}

1013 1014 1015 1016 1017 1018 1019 1020 1021 1022
	/* 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);

1023
	return 0;
1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097

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;

	if (event != 0x80)
		return;
	do {
		hci_read1(dev, HCI_SYSTEM_EVENT, &value, &hci_result);
		if (hci_result == HCI_SUCCESS) {
			if (value == 0x100)
				continue;
			/* act on key press; ignore key release */
			if (value & 0x80)
				continue;

			if (!sparse_keymap_report_event(dev->hotkey_dev,
							value, 1, true)) {
				pr_info("Unknown key %x\n",
				       value);
			}
		} else if (hci_result == 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");
		}
	} while (hci_result != HCI_EMPTY);
}


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

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 已提交
1098 1099 1100 1101
}

module_init(toshiba_acpi_init);
module_exit(toshiba_acpi_exit);