evdev.c 23.9 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10
/*
 * Event char devices, giving access to raw input device events.
 *
 * Copyright (c) 1999-2002 Vojtech Pavlik
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License version 2 as published by
 * the Free Software Foundation.
 */

J
Joe Perches 已提交
11 12
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

L
Linus Torvalds 已提交
13 14
#define EVDEV_MINOR_BASE	64
#define EVDEV_MINORS		32
15 16
#define EVDEV_MIN_BUFFER_SIZE	64U
#define EVDEV_BUF_PACKETS	8
L
Linus Torvalds 已提交
17 18

#include <linux/poll.h>
19
#include <linux/sched.h>
L
Linus Torvalds 已提交
20 21 22
#include <linux/slab.h>
#include <linux/module.h>
#include <linux/init.h>
23
#include <linux/input/mt.h>
L
Linus Torvalds 已提交
24 25
#include <linux/major.h>
#include <linux/device.h>
26
#include "input-compat.h"
L
Linus Torvalds 已提交
27 28 29 30 31 32

struct evdev {
	int open;
	int minor;
	struct input_handle handle;
	wait_queue_head_t wait;
A
Arnd Bergmann 已提交
33
	struct evdev_client __rcu *grab;
34
	struct list_head client_list;
35 36
	spinlock_t client_lock; /* protects client_list */
	struct mutex mutex;
37
	struct device dev;
38
	bool exist;
L
Linus Torvalds 已提交
39 40
};

41
struct evdev_client {
42 43
	unsigned int head;
	unsigned int tail;
44
	unsigned int packet_head; /* [future] position of the first element of next packet */
45
	spinlock_t buffer_lock; /* protects access to buffer, head and tail */
L
Linus Torvalds 已提交
46 47 48
	struct fasync_struct *fasync;
	struct evdev *evdev;
	struct list_head node;
49
	int clkid;
50
	unsigned int bufsize;
51
	struct input_event buffer[];
L
Linus Torvalds 已提交
52 53 54
};

static struct evdev *evdev_table[EVDEV_MINORS];
55
static DEFINE_MUTEX(evdev_table_mutex);
L
Linus Torvalds 已提交
56

57
static void evdev_pass_event(struct evdev_client *client,
58 59
			     struct input_event *event,
			     ktime_t mono, ktime_t real)
60
{
61 62 63
	event->time = ktime_to_timeval(client->clkid == CLOCK_MONOTONIC ?
					mono : real);

64
	/* Interrupts are disabled, just acquire the lock. */
65
	spin_lock(&client->buffer_lock);
66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81

	client->buffer[client->head++] = *event;
	client->head &= client->bufsize - 1;

	if (unlikely(client->head == client->tail)) {
		/*
		 * This effectively "drops" all unconsumed events, leaving
		 * EV_SYN/SYN_DROPPED plus the newest event in the queue.
		 */
		client->tail = (client->head - 2) & (client->bufsize - 1);

		client->buffer[client->tail].time = event->time;
		client->buffer[client->tail].type = EV_SYN;
		client->buffer[client->tail].code = SYN_DROPPED;
		client->buffer[client->tail].value = 0;

82 83
		client->packet_head = client->tail;
	}
84

85 86
	if (event->type == EV_SYN && event->code == SYN_REPORT) {
		client->packet_head = client->head;
87
		kill_fasync(&client->fasync, SIGIO, POLL_IN);
88 89 90
	}

	spin_unlock(&client->buffer_lock);
91 92 93
}

/*
D
Dmitry Torokhov 已提交
94
 * Pass incoming event to all connected clients.
95 96 97
 */
static void evdev_event(struct input_handle *handle,
			unsigned int type, unsigned int code, int value)
L
Linus Torvalds 已提交
98 99
{
	struct evdev *evdev = handle->private;
100
	struct evdev_client *client;
101
	struct input_event event;
102 103 104 105
	ktime_t time_mono, time_real;

	time_mono = ktime_get();
	time_real = ktime_sub(time_mono, ktime_get_monotonic_offset());
L
Linus Torvalds 已提交
106

107 108 109
	event.type = type;
	event.code = code;
	event.value = value;
L
Linus Torvalds 已提交
110

D
Dmitry Torokhov 已提交
111 112
	rcu_read_lock();

113
	client = rcu_dereference(evdev->grab);
114

115
	if (client)
116
		evdev_pass_event(client, &event, time_mono, time_real);
117 118
	else
		list_for_each_entry_rcu(client, &evdev->client_list, node)
119
			evdev_pass_event(client, &event, time_mono, time_real);
L
Linus Torvalds 已提交
120

D
Dmitry Torokhov 已提交
121 122
	rcu_read_unlock();

123 124
	if (type == EV_SYN && code == SYN_REPORT)
		wake_up_interruptible(&evdev->wait);
L
Linus Torvalds 已提交
125 126 127 128
}

static int evdev_fasync(int fd, struct file *file, int on)
{
129
	struct evdev_client *client = file->private_data;
130

131
	return fasync_helper(fd, file, on, &client->fasync);
L
Linus Torvalds 已提交
132 133
}

134
static int evdev_flush(struct file *file, fl_owner_t id)
L
Linus Torvalds 已提交
135
{
136 137
	struct evdev_client *client = file->private_data;
	struct evdev *evdev = client->evdev;
138 139 140 141 142
	int retval;

	retval = mutex_lock_interruptible(&evdev->mutex);
	if (retval)
		return retval;
143

144
	if (!evdev->exist)
145 146 147
		retval = -ENODEV;
	else
		retval = input_flush_device(&evdev->handle, file);
148

149 150
	mutex_unlock(&evdev->mutex);
	return retval;
L
Linus Torvalds 已提交
151 152
}

153
static void evdev_free(struct device *dev)
L
Linus Torvalds 已提交
154
{
155 156
	struct evdev *evdev = container_of(dev, struct evdev, dev);

157
	input_put_device(evdev->handle.dev);
L
Linus Torvalds 已提交
158 159 160
	kfree(evdev);
}

161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182
/*
 * Grabs an event device (along with underlying input device).
 * This function is called with evdev->mutex taken.
 */
static int evdev_grab(struct evdev *evdev, struct evdev_client *client)
{
	int error;

	if (evdev->grab)
		return -EBUSY;

	error = input_grab_device(&evdev->handle);
	if (error)
		return error;

	rcu_assign_pointer(evdev->grab, client);

	return 0;
}

static int evdev_ungrab(struct evdev *evdev, struct evdev_client *client)
{
183 184 185 186
	struct evdev_client *grab = rcu_dereference_protected(evdev->grab,
					lockdep_is_held(&evdev->mutex));

	if (grab != client)
187 188 189
		return  -EINVAL;

	rcu_assign_pointer(evdev->grab, NULL);
D
Dmitry Torokhov 已提交
190
	synchronize_rcu();
191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209
	input_release_device(&evdev->handle);

	return 0;
}

static void evdev_attach_client(struct evdev *evdev,
				struct evdev_client *client)
{
	spin_lock(&evdev->client_lock);
	list_add_tail_rcu(&client->node, &evdev->client_list);
	spin_unlock(&evdev->client_lock);
}

static void evdev_detach_client(struct evdev *evdev,
				struct evdev_client *client)
{
	spin_lock(&evdev->client_lock);
	list_del_rcu(&client->node);
	spin_unlock(&evdev->client_lock);
D
Dmitry Torokhov 已提交
210
	synchronize_rcu();
211 212 213 214 215 216 217 218 219 220 221 222
}

static int evdev_open_device(struct evdev *evdev)
{
	int retval;

	retval = mutex_lock_interruptible(&evdev->mutex);
	if (retval)
		return retval;

	if (!evdev->exist)
		retval = -ENODEV;
223
	else if (!evdev->open++) {
224
		retval = input_open_device(&evdev->handle);
225 226 227
		if (retval)
			evdev->open--;
	}
228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258

	mutex_unlock(&evdev->mutex);
	return retval;
}

static void evdev_close_device(struct evdev *evdev)
{
	mutex_lock(&evdev->mutex);

	if (evdev->exist && !--evdev->open)
		input_close_device(&evdev->handle);

	mutex_unlock(&evdev->mutex);
}

/*
 * Wake up users waiting for IO so they can disconnect from
 * dead device.
 */
static void evdev_hangup(struct evdev *evdev)
{
	struct evdev_client *client;

	spin_lock(&evdev->client_lock);
	list_for_each_entry(client, &evdev->client_list, node)
		kill_fasync(&client->fasync, SIGIO, POLL_HUP);
	spin_unlock(&evdev->client_lock);

	wake_up_interruptible(&evdev->wait);
}

259
static int evdev_release(struct inode *inode, struct file *file)
L
Linus Torvalds 已提交
260
{
261 262
	struct evdev_client *client = file->private_data;
	struct evdev *evdev = client->evdev;
L
Linus Torvalds 已提交
263

264
	mutex_lock(&evdev->mutex);
265
	evdev_ungrab(evdev, client);
266
	mutex_unlock(&evdev->mutex);
L
Linus Torvalds 已提交
267

268
	evdev_detach_client(evdev, client);
269
	kfree(client);
L
Linus Torvalds 已提交
270

271
	evdev_close_device(evdev);
272
	put_device(&evdev->dev);
L
Linus Torvalds 已提交
273 274 275 276

	return 0;
}

277 278
static unsigned int evdev_compute_buffer_size(struct input_dev *dev)
{
279 280 281 282 283
	unsigned int n_events =
		max(dev->hint_events_per_packet * EVDEV_BUF_PACKETS,
		    EVDEV_MIN_BUFFER_SIZE);

	return roundup_pow_of_two(n_events);
284 285
}

286
static int evdev_open(struct inode *inode, struct file *file)
L
Linus Torvalds 已提交
287
{
288
	struct evdev *evdev;
289
	struct evdev_client *client;
L
Linus Torvalds 已提交
290
	int i = iminor(inode) - EVDEV_MINOR_BASE;
291
	unsigned int bufsize;
292
	int error;
L
Linus Torvalds 已提交
293

294
	if (i >= EVDEV_MINORS)
L
Linus Torvalds 已提交
295 296
		return -ENODEV;

297 298 299
	error = mutex_lock_interruptible(&evdev_table_mutex);
	if (error)
		return error;
300
	evdev = evdev_table[i];
301 302 303
	if (evdev)
		get_device(&evdev->dev);
	mutex_unlock(&evdev_table_mutex);
304

305
	if (!evdev)
L
Linus Torvalds 已提交
306 307
		return -ENODEV;

308 309 310 311 312
	bufsize = evdev_compute_buffer_size(evdev->handle.dev);

	client = kzalloc(sizeof(struct evdev_client) +
				bufsize * sizeof(struct input_event),
			 GFP_KERNEL);
313 314 315 316
	if (!client) {
		error = -ENOMEM;
		goto err_put_evdev;
	}
L
Linus Torvalds 已提交
317

318
	client->bufsize = bufsize;
319
	spin_lock_init(&client->buffer_lock);
320
	client->evdev = evdev;
321
	evdev_attach_client(evdev, client);
L
Linus Torvalds 已提交
322

323 324 325
	error = evdev_open_device(evdev);
	if (error)
		goto err_free_client;
L
Linus Torvalds 已提交
326

327
	file->private_data = client;
328 329
	nonseekable_open(inode, file);

L
Linus Torvalds 已提交
330
	return 0;
331 332

 err_free_client:
333
	evdev_detach_client(evdev, client);
334 335 336 337
	kfree(client);
 err_put_evdev:
	put_device(&evdev->dev);
	return error;
L
Linus Torvalds 已提交
338 339
}

340 341
static ssize_t evdev_write(struct file *file, const char __user *buffer,
			   size_t count, loff_t *ppos)
342
{
343 344
	struct evdev_client *client = file->private_data;
	struct evdev *evdev = client->evdev;
345
	struct input_event event;
346
	int retval = 0;
347

348
	if (count != 0 && count < input_event_size())
349 350
		return -EINVAL;

351 352 353 354 355 356 357 358
	retval = mutex_lock_interruptible(&evdev->mutex);
	if (retval)
		return retval;

	if (!evdev->exist) {
		retval = -ENODEV;
		goto out;
	}
359

360 361
	while (retval + input_event_size() <= count) {

362
		if (input_event_from_user(buffer + retval, &event)) {
363 364 365
			retval = -EFAULT;
			goto out;
		}
366
		retval += input_event_size();
367 368 369

		input_inject_event(&evdev->handle,
				   event.type, event.code, event.value);
370
	}
371

372 373
 out:
	mutex_unlock(&evdev->mutex);
374 375 376
	return retval;
}

377 378 379 380 381 382 383
static int evdev_fetch_next_event(struct evdev_client *client,
				  struct input_event *event)
{
	int have_event;

	spin_lock_irq(&client->buffer_lock);

384
	have_event = client->packet_head != client->tail;
385 386
	if (have_event) {
		*event = client->buffer[client->tail++];
387
		client->tail &= client->bufsize - 1;
388 389 390 391 392 393 394 395 396
	}

	spin_unlock_irq(&client->buffer_lock);

	return have_event;
}

static ssize_t evdev_read(struct file *file, char __user *buffer,
			  size_t count, loff_t *ppos)
L
Linus Torvalds 已提交
397
{
398 399
	struct evdev_client *client = file->private_data;
	struct evdev *evdev = client->evdev;
400
	struct input_event event;
401 402
	size_t read = 0;
	int error;
L
Linus Torvalds 已提交
403

404
	if (count != 0 && count < input_event_size())
L
Linus Torvalds 已提交
405 406
		return -EINVAL;

407 408 409
	for (;;) {
		if (!evdev->exist)
			return -ENODEV;
L
Linus Torvalds 已提交
410

411 412 413 414 415 416 417 418 419 420
		if (client->packet_head == client->tail &&
		    (file->f_flags & O_NONBLOCK))
			return -EAGAIN;

		/*
		 * count == 0 is special - no IO is done but we check
		 * for error conditions (see above).
		 */
		if (count == 0)
			break;
L
Linus Torvalds 已提交
421

422 423
		while (read + input_event_size() <= count &&
		       evdev_fetch_next_event(client, &event)) {
424

425 426
			if (input_event_to_user(buffer + read, &event))
				return -EFAULT;
427

428 429
			read += input_event_size();
		}
L
Linus Torvalds 已提交
430

431 432
		if (read)
			break;
433

434 435 436 437 438 439 440 441 442 443
		if (!(file->f_flags & O_NONBLOCK)) {
			error = wait_event_interruptible(evdev->wait,
					client->packet_head != client->tail ||
					!evdev->exist);
			if (error)
				return error;
		}
	}

	return read;
L
Linus Torvalds 已提交
444 445 446 447 448
}

/* No kernel lock - fine */
static unsigned int evdev_poll(struct file *file, poll_table *wait)
{
449 450
	struct evdev_client *client = file->private_data;
	struct evdev *evdev = client->evdev;
451
	unsigned int mask;
452

453
	poll_wait(file, &evdev->wait, wait);
454 455

	mask = evdev->exist ? POLLOUT | POLLWRNORM : POLLHUP | POLLERR;
456
	if (client->packet_head != client->tail)
457 458 459
		mask |= POLLIN | POLLRDNORM;

	return mask;
L
Linus Torvalds 已提交
460 461
}

462 463 464
#ifdef CONFIG_COMPAT

#define BITS_PER_LONG_COMPAT (sizeof(compat_long_t) * 8)
465
#define BITS_TO_LONGS_COMPAT(x) ((((x) - 1) / BITS_PER_LONG_COMPAT) + 1)
466 467 468 469 470 471 472 473

#ifdef __BIG_ENDIAN
static int bits_to_user(unsigned long *bits, unsigned int maxbit,
			unsigned int maxlen, void __user *p, int compat)
{
	int len, i;

	if (compat) {
474
		len = BITS_TO_LONGS_COMPAT(maxbit) * sizeof(compat_long_t);
475
		if (len > maxlen)
476 477 478 479 480 481 482 483 484
			len = maxlen;

		for (i = 0; i < len / sizeof(compat_long_t); i++)
			if (copy_to_user((compat_long_t __user *) p + i,
					 (compat_long_t *) bits +
						i + 1 - ((i % 2) << 1),
					 sizeof(compat_long_t)))
				return -EFAULT;
	} else {
485
		len = BITS_TO_LONGS(maxbit) * sizeof(long);
486 487 488 489 490 491 492 493 494 495 496 497 498 499
		if (len > maxlen)
			len = maxlen;

		if (copy_to_user(p, bits, len))
			return -EFAULT;
	}

	return len;
}
#else
static int bits_to_user(unsigned long *bits, unsigned int maxbit,
			unsigned int maxlen, void __user *p, int compat)
{
	int len = compat ?
500 501
			BITS_TO_LONGS_COMPAT(maxbit) * sizeof(compat_long_t) :
			BITS_TO_LONGS(maxbit) * sizeof(long);
502 503 504 505 506 507 508 509 510 511 512 513 514

	if (len > maxlen)
		len = maxlen;

	return copy_to_user(p, bits, len) ? -EFAULT : len;
}
#endif /* __BIG_ENDIAN */

#else

static int bits_to_user(unsigned long *bits, unsigned int maxbit,
			unsigned int maxlen, void __user *p, int compat)
{
515
	int len = BITS_TO_LONGS(maxbit) * sizeof(long);
516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538

	if (len > maxlen)
		len = maxlen;

	return copy_to_user(p, bits, len) ? -EFAULT : len;
}

#endif /* CONFIG_COMPAT */

static int str_to_user(const char *str, unsigned int maxlen, void __user *p)
{
	int len;

	if (!str)
		return -ENOENT;

	len = strlen(str) + 1;
	if (len > maxlen)
		len = maxlen;

	return copy_to_user(p, str, len) ? -EFAULT : len;
}

539
#define OLD_KEY_MAX	0x1ff
540 541 542
static int handle_eviocgbit(struct input_dev *dev,
			    unsigned int type, unsigned int size,
			    void __user *p, int compat_mode)
543
{
544
	static unsigned long keymax_warn_time;
545 546 547
	unsigned long *bits;
	int len;

548
	switch (type) {
549 550 551 552 553 554 555 556 557 558 559 560

	case      0: bits = dev->evbit;  len = EV_MAX;  break;
	case EV_KEY: bits = dev->keybit; len = KEY_MAX; break;
	case EV_REL: bits = dev->relbit; len = REL_MAX; break;
	case EV_ABS: bits = dev->absbit; len = ABS_MAX; break;
	case EV_MSC: bits = dev->mscbit; len = MSC_MAX; break;
	case EV_LED: bits = dev->ledbit; len = LED_MAX; break;
	case EV_SND: bits = dev->sndbit; len = SND_MAX; break;
	case EV_FF:  bits = dev->ffbit;  len = FF_MAX;  break;
	case EV_SW:  bits = dev->swbit;  len = SW_MAX;  break;
	default: return -EINVAL;
	}
561 562 563 564 565 566

	/*
	 * Work around bugs in userspace programs that like to do
	 * EVIOCGBIT(EV_KEY, KEY_MAX) and not realize that 'len'
	 * should be in bytes, not in bits.
	 */
567
	if (type == EV_KEY && size == OLD_KEY_MAX) {
568 569
		len = OLD_KEY_MAX;
		if (printk_timed_ratelimit(&keymax_warn_time, 10 * 1000))
J
Joe Perches 已提交
570 571 572 573 574
			pr_warning("(EVIOCGBIT): Suspicious buffer size %u, "
				   "limiting output to %zu bytes. See "
				   "http://userweb.kernel.org/~dtor/eviocgbit-bug.html\n",
				   OLD_KEY_MAX,
				   BITS_TO_LONGS(OLD_KEY_MAX) * sizeof(long));
575 576
	}

577
	return bits_to_user(bits, len, size, p, compat_mode);
578
}
579
#undef OLD_KEY_MAX
580

581
static int evdev_handle_get_keycode(struct input_dev *dev, void __user *p)
582
{
583 584 585 586 587
	struct input_keymap_entry ke = {
		.len	= sizeof(unsigned int),
		.flags	= 0,
	};
	int __user *ip = (int __user *)p;
588 589
	int error;

590 591 592
	/* legacy case */
	if (copy_from_user(ke.scancode, p, sizeof(unsigned int)))
		return -EFAULT;
593

594 595 596
	error = input_get_keycode(dev, &ke);
	if (error)
		return error;
597

598 599
	if (put_user(ke.keycode, ip + 1))
		return -EFAULT;
600

601 602
	return 0;
}
603

604 605 606 607
static int evdev_handle_get_keycode_v2(struct input_dev *dev, void __user *p)
{
	struct input_keymap_entry ke;
	int error;
608

609 610
	if (copy_from_user(&ke, p, sizeof(ke)))
		return -EFAULT;
611

612 613 614
	error = input_get_keycode(dev, &ke);
	if (error)
		return error;
615

616 617
	if (copy_to_user(p, &ke, sizeof(ke)))
		return -EFAULT;
618 619 620 621

	return 0;
}

622
static int evdev_handle_set_keycode(struct input_dev *dev, void __user *p)
623
{
624 625 626 627 628
	struct input_keymap_entry ke = {
		.len	= sizeof(unsigned int),
		.flags	= 0,
	};
	int __user *ip = (int __user *)p;
629

630 631
	if (copy_from_user(ke.scancode, p, sizeof(unsigned int)))
		return -EFAULT;
632

633 634
	if (get_user(ke.keycode, ip + 1))
		return -EFAULT;
635

636 637
	return input_set_keycode(dev, &ke);
}
638

639 640 641
static int evdev_handle_set_keycode_v2(struct input_dev *dev, void __user *p)
{
	struct input_keymap_entry ke;
642

643 644
	if (copy_from_user(&ke, p, sizeof(ke)))
		return -EFAULT;
645

646 647
	if (ke.len > sizeof(ke.scancode))
		return -EINVAL;
648 649 650 651

	return input_set_keycode(dev, &ke);
}

652 653 654 655
static int evdev_handle_mt_request(struct input_dev *dev,
				   unsigned int size,
				   int __user *ip)
{
H
Henrik Rydberg 已提交
656
	const struct input_mt *mt = dev->mt;
657 658 659 660 661 662
	unsigned int code;
	int max_slots;
	int i;

	if (get_user(code, &ip[0]))
		return -EFAULT;
H
Henrik Rydberg 已提交
663
	if (!mt || !input_is_mt_value(code))
664 665 666
		return -EINVAL;

	max_slots = (size - sizeof(__u32)) / sizeof(__s32);
H
Henrik Rydberg 已提交
667 668 669
	for (i = 0; i < mt->num_slots && i < max_slots; i++) {
		int value = input_mt_get_value(&mt->slots[i], code);
		if (put_user(value, &ip[1 + i]))
670
			return -EFAULT;
H
Henrik Rydberg 已提交
671
	}
672 673 674 675

	return 0;
}

676 677
static long evdev_do_ioctl(struct file *file, unsigned int cmd,
			   void __user *p, int compat_mode)
L
Linus Torvalds 已提交
678
{
679 680
	struct evdev_client *client = file->private_data;
	struct evdev *evdev = client->evdev;
L
Linus Torvalds 已提交
681 682
	struct input_dev *dev = evdev->handle.dev;
	struct input_absinfo abs;
683
	struct ff_effect effect;
684
	int __user *ip = (int __user *)p;
685
	unsigned int i, t, u, v;
686
	unsigned int size;
687
	int error;
L
Linus Torvalds 已提交
688

689
	/* First we check for fixed-length commands */
L
Linus Torvalds 已提交
690 691
	switch (cmd) {

692 693
	case EVIOCGVERSION:
		return put_user(EV_VERSION, ip);
L
Linus Torvalds 已提交
694

695 696 697 698
	case EVIOCGID:
		if (copy_to_user(p, &dev->id, sizeof(struct input_id)))
			return -EFAULT;
		return 0;
699

700 701 702 703 704 705 706 707
	case EVIOCGREP:
		if (!test_bit(EV_REP, dev->evbit))
			return -ENOSYS;
		if (put_user(dev->rep[REP_DELAY], ip))
			return -EFAULT;
		if (put_user(dev->rep[REP_PERIOD], ip + 1))
			return -EFAULT;
		return 0;
708

709 710 711 712 713 714 715
	case EVIOCSREP:
		if (!test_bit(EV_REP, dev->evbit))
			return -ENOSYS;
		if (get_user(u, ip))
			return -EFAULT;
		if (get_user(v, ip + 1))
			return -EFAULT;
716

717 718
		input_inject_event(&evdev->handle, EV_REP, REP_DELAY, u);
		input_inject_event(&evdev->handle, EV_REP, REP_PERIOD, v);
719

720
		return 0;
L
Linus Torvalds 已提交
721

722 723
	case EVIOCRMFF:
		return input_ff_erase(dev, (int)(unsigned long) p, file);
L
Linus Torvalds 已提交
724

725 726 727 728 729 730 731 732 733 734 735 736
	case EVIOCGEFFECTS:
		i = test_bit(EV_FF, dev->evbit) ?
				dev->ff->max_effects : 0;
		if (put_user(i, ip))
			return -EFAULT;
		return 0;

	case EVIOCGRAB:
		if (p)
			return evdev_grab(evdev, client);
		else
			return evdev_ungrab(evdev, client);
737

738 739 740 741 742 743 744 745
	case EVIOCSCLOCKID:
		if (copy_from_user(&i, p, sizeof(unsigned int)))
			return -EFAULT;
		if (i != CLOCK_MONOTONIC && i != CLOCK_REALTIME)
			return -EINVAL;
		client->clkid = i;
		return 0;

746 747 748 749 750 751 752 753 754 755 756
	case EVIOCGKEYCODE:
		return evdev_handle_get_keycode(dev, p);

	case EVIOCSKEYCODE:
		return evdev_handle_set_keycode(dev, p);

	case EVIOCGKEYCODE_V2:
		return evdev_handle_get_keycode_v2(dev, p);

	case EVIOCSKEYCODE_V2:
		return evdev_handle_set_keycode_v2(dev, p);
757
	}
L
Linus Torvalds 已提交
758

759
	size = _IOC_SIZE(cmd);
L
Linus Torvalds 已提交
760

761 762 763
	/* Now check variable-length commands */
#define EVIOC_MASK_SIZE(nr)	((nr) & ~(_IOC_SIZEMASK << _IOC_SIZESHIFT))
	switch (EVIOC_MASK_SIZE(cmd)) {
764

765 766 767 768
	case EVIOCGPROP(0):
		return bits_to_user(dev->propbit, INPUT_PROP_MAX,
				    size, p, compat_mode);

769 770 771
	case EVIOCGMTSLOTS(0):
		return evdev_handle_mt_request(dev, size, ip);

772 773
	case EVIOCGKEY(0):
		return bits_to_user(dev->key, KEY_MAX, size, p, compat_mode);
L
Linus Torvalds 已提交
774

775 776
	case EVIOCGLED(0):
		return bits_to_user(dev->led, LED_MAX, size, p, compat_mode);
L
Linus Torvalds 已提交
777

778 779
	case EVIOCGSND(0):
		return bits_to_user(dev->snd, SND_MAX, size, p, compat_mode);
L
Linus Torvalds 已提交
780

781 782
	case EVIOCGSW(0):
		return bits_to_user(dev->sw, SW_MAX, size, p, compat_mode);
783

784 785
	case EVIOCGNAME(0):
		return str_to_user(dev->name, size, p);
L
Linus Torvalds 已提交
786

787 788
	case EVIOCGPHYS(0):
		return str_to_user(dev->phys, size, p);
L
Linus Torvalds 已提交
789

790 791
	case EVIOCGUNIQ(0):
		return str_to_user(dev->uniq, size, p);
L
Linus Torvalds 已提交
792

793 794 795
	case EVIOC_MASK_SIZE(EVIOCSFF):
		if (input_ff_effect_from_user(p, size, &effect))
			return -EFAULT;
L
Linus Torvalds 已提交
796

797
		error = input_ff_upload(dev, &effect, file);
L
Linus Torvalds 已提交
798

799 800
		if (put_user(effect.id, &(((struct ff_effect __user *)p)->id)))
			return -EFAULT;
801

802 803
		return error;
	}
L
Linus Torvalds 已提交
804

805 806 807
	/* Multi-number variable-length handlers */
	if (_IOC_TYPE(cmd) != 'E')
		return -EINVAL;
L
Linus Torvalds 已提交
808

809
	if (_IOC_DIR(cmd) == _IOC_READ) {
810

811 812 813 814
		if ((_IOC_NR(cmd) & ~EV_MAX) == _IOC_NR(EVIOCGBIT(0, 0)))
			return handle_eviocgbit(dev,
						_IOC_NR(cmd) & EV_MAX, size,
						p, compat_mode);
L
Linus Torvalds 已提交
815

816
		if ((_IOC_NR(cmd) & ~ABS_MAX) == _IOC_NR(EVIOCGABS(0))) {
817

818 819 820
			if (!dev->absinfo)
				return -EINVAL;

821 822
			t = _IOC_NR(cmd) & ABS_MAX;
			abs = dev->absinfo[t];
823

824 825 826
			if (copy_to_user(p, &abs, min_t(size_t,
					size, sizeof(struct input_absinfo))))
				return -EFAULT;
827

828 829 830
			return 0;
		}
	}
831

832
	if (_IOC_DIR(cmd) == _IOC_WRITE) {
833

834
		if ((_IOC_NR(cmd) & ~ABS_MAX) == _IOC_NR(EVIOCSABS(0))) {
L
Linus Torvalds 已提交
835

836 837 838
			if (!dev->absinfo)
				return -EINVAL;

839
			t = _IOC_NR(cmd) & ABS_MAX;
840

841 842 843
			if (copy_from_user(&abs, p, min_t(size_t,
					size, sizeof(struct input_absinfo))))
				return -EFAULT;
L
Linus Torvalds 已提交
844

845 846
			if (size < sizeof(struct input_absinfo))
				abs.resolution = 0;
847

848 849 850
			/* We can't change number of reserved MT slots */
			if (t == ABS_MT_SLOT)
				return -EINVAL;
H
Henrik Rydberg 已提交
851

852 853 854 855 856 857 858 859
			/*
			 * Take event lock to ensure that we are not
			 * changing device parameters in the middle
			 * of event.
			 */
			spin_lock_irq(&dev->event_lock);
			dev->absinfo[t] = abs;
			spin_unlock_irq(&dev->event_lock);
860

861
			return 0;
862
		}
L
Linus Torvalds 已提交
863
	}
864

L
Linus Torvalds 已提交
865 866 867
	return -EINVAL;
}

868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890
static long evdev_ioctl_handler(struct file *file, unsigned int cmd,
				void __user *p, int compat_mode)
{
	struct evdev_client *client = file->private_data;
	struct evdev *evdev = client->evdev;
	int retval;

	retval = mutex_lock_interruptible(&evdev->mutex);
	if (retval)
		return retval;

	if (!evdev->exist) {
		retval = -ENODEV;
		goto out;
	}

	retval = evdev_do_ioctl(file, cmd, p, compat_mode);

 out:
	mutex_unlock(&evdev->mutex);
	return retval;
}

891 892 893 894
static long evdev_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
{
	return evdev_ioctl_handler(file, cmd, (void __user *)arg, 0);
}
895

896
#ifdef CONFIG_COMPAT
897 898
static long evdev_ioctl_compat(struct file *file,
				unsigned int cmd, unsigned long arg)
899
{
900
	return evdev_ioctl_handler(file, cmd, compat_ptr(arg), 1);
L
Linus Torvalds 已提交
901
}
902
#endif
L
Linus Torvalds 已提交
903

D
Dmitry Torokhov 已提交
904
static const struct file_operations evdev_fops = {
905 906 907 908 909 910 911
	.owner		= THIS_MODULE,
	.read		= evdev_read,
	.write		= evdev_write,
	.poll		= evdev_poll,
	.open		= evdev_open,
	.release	= evdev_release,
	.unlocked_ioctl	= evdev_ioctl,
912
#ifdef CONFIG_COMPAT
913
	.compat_ioctl	= evdev_ioctl_compat,
914
#endif
915
	.fasync		= evdev_fasync,
916 917
	.flush		= evdev_flush,
	.llseek		= no_llseek,
L
Linus Torvalds 已提交
918 919
};

920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947
static int evdev_install_chrdev(struct evdev *evdev)
{
	/*
	 * No need to do any locking here as calls to connect and
	 * disconnect are serialized by the input core
	 */
	evdev_table[evdev->minor] = evdev;
	return 0;
}

static void evdev_remove_chrdev(struct evdev *evdev)
{
	/*
	 * Lock evdev table to prevent race with evdev_open()
	 */
	mutex_lock(&evdev_table_mutex);
	evdev_table[evdev->minor] = NULL;
	mutex_unlock(&evdev_table_mutex);
}

/*
 * Mark device non-existent. This disables writes, ioctls and
 * prevents new users from opening the device. Already posted
 * blocking reads will stay, however new ones will fail.
 */
static void evdev_mark_dead(struct evdev *evdev)
{
	mutex_lock(&evdev->mutex);
948
	evdev->exist = false;
949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970
	mutex_unlock(&evdev->mutex);
}

static void evdev_cleanup(struct evdev *evdev)
{
	struct input_handle *handle = &evdev->handle;

	evdev_mark_dead(evdev);
	evdev_hangup(evdev);
	evdev_remove_chrdev(evdev);

	/* evdev is marked dead so no one else accesses evdev->open */
	if (evdev->open) {
		input_flush_device(handle, NULL);
		input_close_device(handle);
	}
}

/*
 * Create new evdev device. Note that input core serializes calls
 * to connect and disconnect so we don't need to lock evdev_table here.
 */
971 972
static int evdev_connect(struct input_handler *handler, struct input_dev *dev,
			 const struct input_device_id *id)
L
Linus Torvalds 已提交
973 974 975
{
	struct evdev *evdev;
	int minor;
976
	int error;
L
Linus Torvalds 已提交
977

978 979 980 981
	for (minor = 0; minor < EVDEV_MINORS; minor++)
		if (!evdev_table[minor])
			break;

L
Linus Torvalds 已提交
982
	if (minor == EVDEV_MINORS) {
J
Joe Perches 已提交
983
		pr_err("no more free evdev devices\n");
984
		return -ENFILE;
L
Linus Torvalds 已提交
985 986
	}

987 988 989
	evdev = kzalloc(sizeof(struct evdev), GFP_KERNEL);
	if (!evdev)
		return -ENOMEM;
L
Linus Torvalds 已提交
990

991
	INIT_LIST_HEAD(&evdev->client_list);
992 993
	spin_lock_init(&evdev->client_lock);
	mutex_init(&evdev->mutex);
L
Linus Torvalds 已提交
994 995
	init_waitqueue_head(&evdev->wait);

996
	dev_set_name(&evdev->dev, "event%d", minor);
997
	evdev->exist = true;
L
Linus Torvalds 已提交
998
	evdev->minor = minor;
999

1000
	evdev->handle.dev = input_get_device(dev);
1001
	evdev->handle.name = dev_name(&evdev->dev);
L
Linus Torvalds 已提交
1002 1003 1004
	evdev->handle.handler = handler;
	evdev->handle.private = evdev;

1005
	evdev->dev.devt = MKDEV(INPUT_MAJOR, EVDEV_MINOR_BASE + minor);
1006 1007 1008 1009
	evdev->dev.class = &input_class;
	evdev->dev.parent = &dev->dev;
	evdev->dev.release = evdev_free;
	device_initialize(&evdev->dev);
1010

1011
	error = input_register_handle(&evdev->handle);
1012
	if (error)
1013
		goto err_free_evdev;
1014

1015 1016 1017 1018 1019
	error = evdev_install_chrdev(evdev);
	if (error)
		goto err_unregister_handle;

	error = device_add(&evdev->dev);
1020
	if (error)
1021
		goto err_cleanup_evdev;
L
Linus Torvalds 已提交
1022

1023
	return 0;
L
Linus Torvalds 已提交
1024

1025 1026 1027 1028
 err_cleanup_evdev:
	evdev_cleanup(evdev);
 err_unregister_handle:
	input_unregister_handle(&evdev->handle);
1029
 err_free_evdev:
1030
	put_device(&evdev->dev);
1031
	return error;
L
Linus Torvalds 已提交
1032 1033 1034 1035 1036 1037
}

static void evdev_disconnect(struct input_handle *handle)
{
	struct evdev *evdev = handle->private;

1038
	device_del(&evdev->dev);
1039 1040
	evdev_cleanup(evdev);
	input_unregister_handle(handle);
1041
	put_device(&evdev->dev);
L
Linus Torvalds 已提交
1042 1043
}

D
Dmitry Torokhov 已提交
1044
static const struct input_device_id evdev_ids[] = {
L
Linus Torvalds 已提交
1045 1046 1047 1048 1049 1050 1051
	{ .driver_info = 1 },	/* Matches all devices */
	{ },			/* Terminating zero entry */
};

MODULE_DEVICE_TABLE(input, evdev_ids);

static struct input_handler evdev_handler = {
1052 1053 1054 1055 1056 1057 1058
	.event		= evdev_event,
	.connect	= evdev_connect,
	.disconnect	= evdev_disconnect,
	.fops		= &evdev_fops,
	.minor		= EVDEV_MINOR_BASE,
	.name		= "evdev",
	.id_table	= evdev_ids,
L
Linus Torvalds 已提交
1059 1060 1061 1062
};

static int __init evdev_init(void)
{
1063
	return input_register_handler(&evdev_handler);
L
Linus Torvalds 已提交
1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076
}

static void __exit evdev_exit(void)
{
	input_unregister_handler(&evdev_handler);
}

module_init(evdev_init);
module_exit(evdev_exit);

MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
MODULE_DESCRIPTION("Input driver event char devices");
MODULE_LICENSE("GPL");