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

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 116 117 118 119 120 121 122 123
struct toshiba_acpi_dev {
	struct acpi_device *acpi_dev;
	const char *method_hci;
	struct rfkill *bt_rfk;
	struct input_dev *hotkey_dev;
	struct backlight_device *backlight_dev;
	struct led_classdev led_dev;
	int illumination_installed;
	int force_fan;
	int last_key_event;
	int key_event_valid;

	struct mutex mutex;
};

124 125
static const struct acpi_device_id toshiba_device_ids[] = {
	{"TOS6200", 0},
126
	{"TOS6208", 0},
127 128 129 130 131
	{"TOS1900", 0},
	{"", 0},
};
MODULE_DEVICE_TABLE(acpi, toshiba_device_ids);

132
static const struct key_entry toshiba_acpi_keymap[] __devinitconst = {
133 134 135 136 137 138 139 140 141 142 143 144
	{ 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 } },
145
	{ KE_KEY, 0x17f, { KEY_FN } },
146 147 148 149 150 151 152 153 154
	{ 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 },
155 156
};

L
Linus Torvalds 已提交
157 158 159
/* utility
 */

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

/* acpi interface wrappers
 */

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

174
	params.count = ARRAY_SIZE(in_objs);
L
Linus Torvalds 已提交
175 176 177 178
	params.pointer = in_objs;
	in_objs[0].type = ACPI_TYPE_INTEGER;
	in_objs[0].integer.value = val;

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

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

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

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

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

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

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

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

267
/* Illumination support */
268
static int toshiba_illumination_available(struct toshiba_acpi_dev *dev)
269 270 271 272 273 274
{
	u32 in[HCI_WORDS] = { 0, 0, 0, 0, 0, 0 };
	u32 out[HCI_WORDS];
	acpi_status status;

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

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

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

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

	/* Last request : close communication. */
	in[0] = 0xf200;
	in[1] = 0;
	in[2] = 0;
328
	hci_raw(dev, in, out);
329 330 331 332
}

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

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

	result = out[2] ? LED_FULL : LED_OFF;

	/* Last request : close communication. */
	in[0] = 0xf200;
	in[1] = 0;
	in[2] = 0;
363
	hci_raw(dev, in, out);
364 365 366 367

	return result;
}

368 369
/* Bluetooth rfkill handlers */

370
static u32 hci_get_bt_present(struct toshiba_acpi_dev *dev, bool *present)
371 372 373 374 375 376
{
	u32 hci_result;
	u32 value, value2;

	value = 0;
	value2 = 0;
377
	hci_read2(dev, HCI_WIRELESS, &value, &value2, &hci_result);
378 379 380 381 382 383
	if (hci_result == HCI_SUCCESS)
		*present = (value & HCI_WIRELESS_BT_PRESENT) ? true : false;

	return hci_result;
}

384
static u32 hci_get_radio_state(struct toshiba_acpi_dev *dev, bool *radio_state)
385 386 387 388 389 390
{
	u32 hci_result;
	u32 value, value2;

	value = 0;
	value2 = 0x0001;
391
	hci_read2(dev, HCI_WIRELESS, &value, &value2, &hci_result);
392 393 394 395 396

	*radio_state = value & HCI_WIRELESS_KILL_SWITCH;
	return hci_result;
}

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

J
Johannes Berg 已提交
405
	value = (blocked == false);
406

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

J
Johannes Berg 已提交
413 414 415
	if (!radio_state) {
		err = 0;
		goto out;
416 417
	}

418 419
	hci_write2(dev, HCI_WIRELESS, value, HCI_WIRELESS_BT_POWER, &result1);
	hci_write2(dev, HCI_WIRELESS, value, HCI_WIRELESS_BT_ATTACH, &result2);
420 421

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

J
Johannes Berg 已提交
430
static void bt_rfkill_poll(struct rfkill *rfkill, void *data)
431 432 433 434
{
	bool new_rfk_state;
	bool value;
	u32 hci_result;
J
Johannes Berg 已提交
435 436 437
	struct toshiba_acpi_dev *dev = data;

	mutex_lock(&dev->mutex);
438

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

	new_rfk_state = value;

	mutex_unlock(&dev->mutex);

J
Johannes Berg 已提交
450 451
	if (rfkill_set_hw_state(rfkill, !new_rfk_state))
		bt_rfkill_set_block(data, true);
452 453
}

J
Johannes Berg 已提交
454 455 456 457 458
static const struct rfkill_ops toshiba_rfk_ops = {
	.set_block = bt_rfkill_set_block,
	.poll = bt_rfkill_poll,
};

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

461
static int get_lcd(struct backlight_device *bd)
L
Linus Torvalds 已提交
462
{
463
	struct toshiba_acpi_dev *dev = bl_get_data(bd);
L
Linus Torvalds 已提交
464 465 466
	u32 hci_result;
	u32 value;

467
	hci_read1(dev, HCI_LCD_BRIGHTNESS, &value, &hci_result);
S
Seth Forshee 已提交
468
	if (hci_result == HCI_SUCCESS)
469
		return (value >> HCI_LCD_BRIGHTNESS_SHIFT);
S
Seth Forshee 已提交
470 471

	return -EIO;
472 473
}

474
static int lcd_proc_show(struct seq_file *m, void *v)
475
{
476 477 478 479 480
	struct toshiba_acpi_dev *dev = m->private;
	int value;

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

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

S
Seth Forshee 已提交
490 491
	pr_err("Error reading LCD brightness\n");
	return -EIO;
492 493 494 495
}

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

499
static int set_lcd(struct toshiba_acpi_dev *dev, int value)
500 501 502 503
{
	u32 hci_result;

	value = value << HCI_LCD_BRIGHTNESS_SHIFT;
504
	hci_write1(dev, HCI_LCD_BRIGHTNESS, value, &hci_result);
S
Seth Forshee 已提交
505
	return hci_result == HCI_SUCCESS ? 0 : -EIO;
506 507 508 509
}

static int set_lcd_status(struct backlight_device *bd)
{
510 511
	struct toshiba_acpi_dev *dev = bl_get_data(bd);
	return set_lcd(dev, bd->props.brightness);
512 513
}

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

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

539 540 541 542 543 544 545 546 547 548
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,
};

static int video_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
549
{
550
	struct toshiba_acpi_dev *dev = m->private;
L
Linus Torvalds 已提交
551 552 553
	u32 hci_result;
	u32 value;

554
	hci_read1(dev, HCI_VIDEO_OUT, &value, &hci_result);
L
Linus Torvalds 已提交
555 556 557
	if (hci_result == HCI_SUCCESS) {
		int is_lcd = (value & HCI_VIDEO_OUT_LCD) ? 1 : 0;
		int is_crt = (value & HCI_VIDEO_OUT_CRT) ? 1 : 0;
L
Len Brown 已提交
558
		int is_tv = (value & HCI_VIDEO_OUT_TV) ? 1 : 0;
559 560 561
		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);
S
Seth Forshee 已提交
562
		return 0;
L
Linus Torvalds 已提交
563 564
	}

S
Seth Forshee 已提交
565
	return -EIO;
L
Linus Torvalds 已提交
566 567
}

568
static int video_proc_open(struct inode *inode, struct file *file)
L
Linus Torvalds 已提交
569
{
570
	return single_open(file, video_proc_show, PDE(inode)->data);
571 572 573 574 575
}

static ssize_t video_proc_write(struct file *file, const char __user *buf,
				size_t count, loff_t *pos)
{
576
	struct toshiba_acpi_dev *dev = PDE(file->f_path.dentry->d_inode)->data;
577
	char *cmd, *buffer;
S
Seth Forshee 已提交
578
	int ret = 0;
L
Linus Torvalds 已提交
579 580 581 582 583 584
	int value;
	int remain = count;
	int lcd_out = -1;
	int crt_out = -1;
	int tv_out = -1;
	u32 hci_result;
A
Al Viro 已提交
585
	u32 video_out;
L
Linus Torvalds 已提交
586

587 588 589 590 591 592 593 594 595 596 597
	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 已提交
598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613
	/* 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 已提交
614
		while (remain && *(buffer - 1) != ';');
L
Linus Torvalds 已提交
615 616
	}

617 618
	kfree(cmd);

619
	hci_read1(dev, HCI_VIDEO_OUT, &video_out, &hci_result);
L
Linus Torvalds 已提交
620
	if (hci_result == HCI_SUCCESS) {
621
		unsigned int new_video_out = video_out;
L
Linus Torvalds 已提交
622 623 624 625 626 627 628 629 630
		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 已提交
631
			ret = write_acpi_int(METHOD_VIDEO_OUT, new_video_out);
L
Linus Torvalds 已提交
632
	} else {
S
Seth Forshee 已提交
633
		ret = -EIO;
L
Linus Torvalds 已提交
634 635
	}

S
Seth Forshee 已提交
636
	return ret ? ret : count;
L
Linus Torvalds 已提交
637 638
}

639 640 641 642 643 644 645 646 647 648
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,
};

static int fan_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
649
{
650
	struct toshiba_acpi_dev *dev = m->private;
L
Linus Torvalds 已提交
651 652 653
	u32 hci_result;
	u32 value;

654
	hci_read1(dev, HCI_FAN, &value, &hci_result);
L
Linus Torvalds 已提交
655
	if (hci_result == HCI_SUCCESS) {
656
		seq_printf(m, "running:                 %d\n", (value > 0));
657
		seq_printf(m, "force_on:                %d\n", dev->force_fan);
S
Seth Forshee 已提交
658
		return 0;
L
Linus Torvalds 已提交
659 660
	}

S
Seth Forshee 已提交
661
	return -EIO;
662 663 664 665
}

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

669 670
static ssize_t fan_proc_write(struct file *file, const char __user *buf,
			      size_t count, loff_t *pos)
L
Linus Torvalds 已提交
671
{
672
	struct toshiba_acpi_dev *dev = PDE(file->f_path.dentry->d_inode)->data;
673 674
	char cmd[42];
	size_t len;
L
Linus Torvalds 已提交
675 676 677
	int value;
	u32 hci_result;

678 679 680 681 682 683
	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 已提交
684
	    value >= 0 && value <= 1) {
685
		hci_write1(dev, HCI_FAN, value, &hci_result);
L
Linus Torvalds 已提交
686
		if (hci_result != HCI_SUCCESS)
S
Seth Forshee 已提交
687
			return -EIO;
L
Linus Torvalds 已提交
688
		else
689
			dev->force_fan = value;
L
Linus Torvalds 已提交
690 691 692 693 694 695 696
	} else {
		return -EINVAL;
	}

	return count;
}

697 698 699 700 701 702 703 704 705 706
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 已提交
707
{
708
	struct toshiba_acpi_dev *dev = m->private;
L
Linus Torvalds 已提交
709 710 711
	u32 hci_result;
	u32 value;

712 713
	if (!dev->key_event_valid) {
		hci_read1(dev, HCI_SYSTEM_EVENT, &value, &hci_result);
L
Linus Torvalds 已提交
714
		if (hci_result == HCI_SUCCESS) {
715 716
			dev->key_event_valid = 1;
			dev->last_key_event = value;
L
Linus Torvalds 已提交
717 718 719 720 721 722
		} 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. */
723
			hci_write1(dev, HCI_SYSTEM_EVENT, 1, &hci_result);
724
			pr_notice("Re-enabled hotkeys\n");
L
Linus Torvalds 已提交
725
		} else {
726
			pr_err("Error reading hotkey status\n");
S
Seth Forshee 已提交
727
			return -EIO;
L
Linus Torvalds 已提交
728 729 730
		}
	}

731 732
	seq_printf(m, "hotkey_ready:            %d\n", dev->key_event_valid);
	seq_printf(m, "hotkey:                  0x%04x\n", dev->last_key_event);
733 734
	return 0;
}
L
Linus Torvalds 已提交
735

736 737
static int keys_proc_open(struct inode *inode, struct file *file)
{
738
	return single_open(file, keys_proc_show, PDE(inode)->data);
L
Linus Torvalds 已提交
739 740
}

741 742
static ssize_t keys_proc_write(struct file *file, const char __user *buf,
			       size_t count, loff_t *pos)
L
Linus Torvalds 已提交
743
{
744
	struct toshiba_acpi_dev *dev = PDE(file->f_path.dentry->d_inode)->data;
745 746
	char cmd[42];
	size_t len;
L
Linus Torvalds 已提交
747 748
	int value;

749 750 751 752 753 754
	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) {
755
		dev->key_event_valid = 0;
L
Linus Torvalds 已提交
756 757 758 759 760 761 762
	} else {
		return -EINVAL;
	}

	return count;
}

763 764 765 766 767 768 769 770 771 772
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 已提交
773
{
774 775 776
	seq_printf(m, "driver:                  %s\n", TOSHIBA_ACPI_VERSION);
	seq_printf(m, "proc_interface:          %d\n", PROC_INTERFACE_VERSION);
	return 0;
L
Linus Torvalds 已提交
777 778
}

779 780 781 782 783 784 785 786 787 788 789 790 791
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 已提交
792 793 794 795 796
/* proc and module init
 */

#define PROC_TOSHIBA		"toshiba"

797 798
static void __devinit
create_toshiba_proc_entries(struct toshiba_acpi_dev *dev)
L
Linus Torvalds 已提交
799
{
800 801 802 803 804 805 806 807 808 809
	proc_create_data("lcd", S_IRUGO | S_IWUSR, toshiba_proc_dir,
			 &lcd_proc_fops, dev);
	proc_create_data("video", S_IRUGO | S_IWUSR, toshiba_proc_dir,
			 &video_proc_fops, dev);
	proc_create_data("fan", S_IRUGO | S_IWUSR, toshiba_proc_dir,
			 &fan_proc_fops, dev);
	proc_create_data("keys", S_IRUGO | S_IWUSR, toshiba_proc_dir,
			 &keys_proc_fops, dev);
	proc_create_data("version", S_IRUGO, toshiba_proc_dir,
			 &version_proc_fops, dev);
L
Linus Torvalds 已提交
810 811
}

812
static void remove_toshiba_proc_entries(void)
L
Linus Torvalds 已提交
813
{
814 815 816 817 818
	remove_proc_entry("lcd", toshiba_proc_dir);
	remove_proc_entry("video", toshiba_proc_dir);
	remove_proc_entry("fan", toshiba_proc_dir);
	remove_proc_entry("keys", toshiba_proc_dir);
	remove_proc_entry("version", toshiba_proc_dir);
L
Linus Torvalds 已提交
819 820
}

L
Lionel Debroux 已提交
821
static const struct backlight_ops toshiba_backlight_data = {
822 823 824 825
        .get_brightness = get_lcd,
        .update_status  = set_lcd_status,
};

826
static int __devinit toshiba_acpi_setup_keyboard(struct toshiba_acpi_dev *dev)
827 828
{
	acpi_status status;
829
	int error;
830

831 832
	dev->hotkey_dev = input_allocate_device();
	if (!dev->hotkey_dev) {
833
		pr_info("Unable to register input device\n");
834 835 836
		return -ENOMEM;
	}

837
	dev->hotkey_dev->name = "Toshiba input device";
838
	dev->hotkey_dev->phys = "toshiba_acpi/input0";
839
	dev->hotkey_dev->id.bustype = BUS_HOST;
840

841
	error = sparse_keymap_setup(dev->hotkey_dev, toshiba_acpi_keymap, NULL);
842 843 844
	if (error)
		goto err_free_dev;

845
	status = acpi_evaluate_object(dev->acpi_dev->handle, "ENAB", NULL, NULL);
846
	if (ACPI_FAILURE(status)) {
847
		pr_info("Unable to enable hotkeys\n");
848
		error = -ENODEV;
849
		goto err_free_keymap;
850 851
	}

852
	error = input_register_device(dev->hotkey_dev);
853
	if (error) {
854
		pr_info("Unable to register input device\n");
855
		goto err_free_keymap;
856 857 858
	}

	return 0;
859 860

 err_free_keymap:
861
	sparse_keymap_free(dev->hotkey_dev);
862
 err_free_dev:
863 864
	input_free_device(dev->hotkey_dev);
	dev->hotkey_dev = NULL;
865
	return error;
866 867
}

868
static int toshiba_acpi_remove(struct acpi_device *acpi_dev, int type)
869
{
870
	struct toshiba_acpi_dev *dev = acpi_driver_data(acpi_dev);
871

872
	remove_toshiba_proc_entries();
873

874 875 876 877
	if (dev->hotkey_dev) {
		input_unregister_device(dev->hotkey_dev);
		sparse_keymap_free(dev->hotkey_dev);
	}
878

879 880 881 882
	if (dev->bt_rfk) {
		rfkill_unregister(dev->bt_rfk);
		rfkill_destroy(dev->bt_rfk);
	}
883

884 885
	if (dev->backlight_dev)
		backlight_device_unregister(dev->backlight_dev);
886

887 888
	if (dev->illumination_installed)
		led_classdev_unregister(&dev->led_dev);
889

890
	kfree(dev);
891

892
	return 0;
893 894
}

895
static int __devinit toshiba_acpi_add(struct acpi_device *acpi_dev)
L
Linus Torvalds 已提交
896
{
897
	struct toshiba_acpi_dev *dev;
898 899
	acpi_status status;
	acpi_handle handle;
L
Linus Torvalds 已提交
900
	u32 hci_result;
901 902
	bool bt_present;
	int ret = 0;
903
	struct backlight_properties props;
L
Linus Torvalds 已提交
904

905 906 907
	pr_info("Toshiba Laptop ACPI Extras version %s\n",
	       TOSHIBA_ACPI_VERSION);

908 909 910 911 912
	/* simple device detection: look for HCI method */
	status = acpi_get_handle(acpi_dev->handle, "GHCI", &handle);
	if (ACPI_FAILURE(status))
		return -ENODEV;

913 914 915 916
	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
	if (!dev)
		return -ENOMEM;
	dev->acpi_dev = acpi_dev;
917
	dev->method_hci = "GHCI";
918
	acpi_dev->driver_data = dev;
L
Luming Yu 已提交
919

920 921
	if (toshiba_acpi_setup_keyboard(dev))
		pr_info("Unable to activate hotkeys\n");
922 923

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

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

928
	create_toshiba_proc_entries(dev);
L
Linus Torvalds 已提交
929

M
Matthew Garrett 已提交
930
	props.type = BACKLIGHT_PLATFORM;
931
	props.max_brightness = HCI_LCD_BRIGHTNESS_LEVELS - 1;
932 933 934 935 936 937 938
	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);
939

940
		pr_err("Could not register toshiba backlight device\n");
941 942
		dev->backlight_dev = NULL;
		goto error;
943
	}
L
Linus Torvalds 已提交
944

945
	/* Register rfkill switch for Bluetooth */
946 947 948 949 950 951 952
	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) {
953
			pr_err("unable to allocate rfkill device\n");
954 955
			ret = -ENOMEM;
			goto error;
956 957
		}

958
		ret = rfkill_register(dev->bt_rfk);
959
		if (ret) {
960
			pr_err("unable to register rfkill device\n");
961 962
			rfkill_destroy(dev->bt_rfk);
			goto error;
963
		}
964 965
	}

966 967 968 969 970 971 972
	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))
			dev->illumination_installed = 1;
973 974
	}

975
	return 0;
976 977 978 979 980 981 982 983 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 1021 1022 1023 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

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 已提交
1050 1051 1052 1053
}

module_init(toshiba_acpi_init);
module_exit(toshiba_acpi_exit);