xref: /linux/drivers/input/input.c (revision 54a8a2220c936a47840c9a3d74910c5a56fae2ed)
1 /*
2  * The input core
3  *
4  * Copyright (c) 1999-2002 Vojtech Pavlik
5  */
6 
7 /*
8  * This program is free software; you can redistribute it and/or modify it
9  * under the terms of the GNU General Public License version 2 as published by
10  * the Free Software Foundation.
11  */
12 
13 #include <linux/init.h>
14 #include <linux/sched.h>
15 #include <linux/smp_lock.h>
16 #include <linux/input.h>
17 #include <linux/module.h>
18 #include <linux/random.h>
19 #include <linux/major.h>
20 #include <linux/proc_fs.h>
21 #include <linux/kobject_uevent.h>
22 #include <linux/interrupt.h>
23 #include <linux/poll.h>
24 #include <linux/device.h>
25 #include <linux/devfs_fs_kernel.h>
26 
27 MODULE_AUTHOR("Vojtech Pavlik <vojtech@suse.cz>");
28 MODULE_DESCRIPTION("Input core");
29 MODULE_LICENSE("GPL");
30 
31 EXPORT_SYMBOL(input_register_device);
32 EXPORT_SYMBOL(input_unregister_device);
33 EXPORT_SYMBOL(input_register_handler);
34 EXPORT_SYMBOL(input_unregister_handler);
35 EXPORT_SYMBOL(input_grab_device);
36 EXPORT_SYMBOL(input_release_device);
37 EXPORT_SYMBOL(input_open_device);
38 EXPORT_SYMBOL(input_close_device);
39 EXPORT_SYMBOL(input_accept_process);
40 EXPORT_SYMBOL(input_flush_device);
41 EXPORT_SYMBOL(input_event);
42 EXPORT_SYMBOL(input_class);
43 
44 #define INPUT_DEVICES	256
45 
46 static LIST_HEAD(input_dev_list);
47 static LIST_HEAD(input_handler_list);
48 
49 static struct input_handler *input_table[8];
50 
51 void input_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
52 {
53 	struct input_handle *handle;
54 
55 	if (type > EV_MAX || !test_bit(type, dev->evbit))
56 		return;
57 
58 	add_input_randomness(type, code, value);
59 
60 	switch (type) {
61 
62 		case EV_SYN:
63 			switch (code) {
64 				case SYN_CONFIG:
65 					if (dev->event) dev->event(dev, type, code, value);
66 					break;
67 
68 				case SYN_REPORT:
69 					if (dev->sync) return;
70 					dev->sync = 1;
71 					break;
72 			}
73 			break;
74 
75 		case EV_KEY:
76 
77 			if (code > KEY_MAX || !test_bit(code, dev->keybit) || !!test_bit(code, dev->key) == value)
78 				return;
79 
80 			if (value == 2)
81 				break;
82 
83 			change_bit(code, dev->key);
84 
85 			if (test_bit(EV_REP, dev->evbit) && dev->rep[REP_PERIOD] && dev->rep[REP_DELAY] && dev->timer.data && value) {
86 				dev->repeat_key = code;
87 				mod_timer(&dev->timer, jiffies + msecs_to_jiffies(dev->rep[REP_DELAY]));
88 			}
89 
90 			break;
91 
92 		case EV_SW:
93 
94 			if (code > SW_MAX || !test_bit(code, dev->swbit) || !!test_bit(code, dev->sw) == value)
95 				return;
96 
97 			change_bit(code, dev->sw);
98 
99 			break;
100 
101 		case EV_ABS:
102 
103 			if (code > ABS_MAX || !test_bit(code, dev->absbit))
104 				return;
105 
106 			if (dev->absfuzz[code]) {
107 				if ((value > dev->abs[code] - (dev->absfuzz[code] >> 1)) &&
108 				    (value < dev->abs[code] + (dev->absfuzz[code] >> 1)))
109 					return;
110 
111 				if ((value > dev->abs[code] - dev->absfuzz[code]) &&
112 				    (value < dev->abs[code] + dev->absfuzz[code]))
113 					value = (dev->abs[code] * 3 + value) >> 2;
114 
115 				if ((value > dev->abs[code] - (dev->absfuzz[code] << 1)) &&
116 				    (value < dev->abs[code] + (dev->absfuzz[code] << 1)))
117 					value = (dev->abs[code] + value) >> 1;
118 			}
119 
120 			if (dev->abs[code] == value)
121 				return;
122 
123 			dev->abs[code] = value;
124 			break;
125 
126 		case EV_REL:
127 
128 			if (code > REL_MAX || !test_bit(code, dev->relbit) || (value == 0))
129 				return;
130 
131 			break;
132 
133 		case EV_MSC:
134 
135 			if (code > MSC_MAX || !test_bit(code, dev->mscbit))
136 				return;
137 
138 			if (dev->event) dev->event(dev, type, code, value);
139 
140 			break;
141 
142 		case EV_LED:
143 
144 			if (code > LED_MAX || !test_bit(code, dev->ledbit) || !!test_bit(code, dev->led) == value)
145 				return;
146 
147 			change_bit(code, dev->led);
148 			if (dev->event) dev->event(dev, type, code, value);
149 
150 			break;
151 
152 		case EV_SND:
153 
154 			if (code > SND_MAX || !test_bit(code, dev->sndbit))
155 				return;
156 
157 			if (dev->event) dev->event(dev, type, code, value);
158 
159 			break;
160 
161 		case EV_REP:
162 
163 			if (code > REP_MAX || value < 0 || dev->rep[code] == value) return;
164 
165 			dev->rep[code] = value;
166 			if (dev->event) dev->event(dev, type, code, value);
167 
168 			break;
169 
170 		case EV_FF:
171 			if (dev->event) dev->event(dev, type, code, value);
172 			break;
173 	}
174 
175 	if (type != EV_SYN)
176 		dev->sync = 0;
177 
178 	if (dev->grab)
179 		dev->grab->handler->event(dev->grab, type, code, value);
180 	else
181 		list_for_each_entry(handle, &dev->h_list, d_node)
182 			if (handle->open)
183 				handle->handler->event(handle, type, code, value);
184 }
185 
186 static void input_repeat_key(unsigned long data)
187 {
188 	struct input_dev *dev = (void *) data;
189 
190 	if (!test_bit(dev->repeat_key, dev->key))
191 		return;
192 
193 	input_event(dev, EV_KEY, dev->repeat_key, 2);
194 	input_sync(dev);
195 
196 	if (dev->rep[REP_PERIOD])
197 		mod_timer(&dev->timer, jiffies + msecs_to_jiffies(dev->rep[REP_PERIOD]));
198 }
199 
200 int input_accept_process(struct input_handle *handle, struct file *file)
201 {
202 	if (handle->dev->accept)
203 		return handle->dev->accept(handle->dev, file);
204 
205 	return 0;
206 }
207 
208 int input_grab_device(struct input_handle *handle)
209 {
210 	if (handle->dev->grab)
211 		return -EBUSY;
212 
213 	handle->dev->grab = handle;
214 	return 0;
215 }
216 
217 void input_release_device(struct input_handle *handle)
218 {
219 	if (handle->dev->grab == handle)
220 		handle->dev->grab = NULL;
221 }
222 
223 int input_open_device(struct input_handle *handle)
224 {
225 	struct input_dev *dev = handle->dev;
226 	int err;
227 
228 	err = down_interruptible(&dev->sem);
229 	if (err)
230 		return err;
231 
232 	handle->open++;
233 
234 	if (!dev->users++ && dev->open)
235 		err = dev->open(dev);
236 
237 	if (err)
238 		handle->open--;
239 
240 	up(&dev->sem);
241 
242 	return err;
243 }
244 
245 int input_flush_device(struct input_handle* handle, struct file* file)
246 {
247 	if (handle->dev->flush)
248 		return handle->dev->flush(handle->dev, file);
249 
250 	return 0;
251 }
252 
253 void input_close_device(struct input_handle *handle)
254 {
255 	struct input_dev *dev = handle->dev;
256 
257 	input_release_device(handle);
258 
259 	down(&dev->sem);
260 
261 	if (!--dev->users && dev->close)
262 		dev->close(dev);
263 	handle->open--;
264 
265 	up(&dev->sem);
266 }
267 
268 static void input_link_handle(struct input_handle *handle)
269 {
270 	list_add_tail(&handle->d_node, &handle->dev->h_list);
271 	list_add_tail(&handle->h_node, &handle->handler->h_list);
272 }
273 
274 #define MATCH_BIT(bit, max) \
275 		for (i = 0; i < NBITS(max); i++) \
276 			if ((id->bit[i] & dev->bit[i]) != id->bit[i]) \
277 				break; \
278 		if (i != NBITS(max)) \
279 			continue;
280 
281 static struct input_device_id *input_match_device(struct input_device_id *id, struct input_dev *dev)
282 {
283 	int i;
284 
285 	for (; id->flags || id->driver_info; id++) {
286 
287 		if (id->flags & INPUT_DEVICE_ID_MATCH_BUS)
288 			if (id->id.bustype != dev->id.bustype)
289 				continue;
290 
291 		if (id->flags & INPUT_DEVICE_ID_MATCH_VENDOR)
292 			if (id->id.vendor != dev->id.vendor)
293 				continue;
294 
295 		if (id->flags & INPUT_DEVICE_ID_MATCH_PRODUCT)
296 			if (id->id.product != dev->id.product)
297 				continue;
298 
299 		if (id->flags & INPUT_DEVICE_ID_MATCH_VERSION)
300 			if (id->id.version != dev->id.version)
301 				continue;
302 
303 		MATCH_BIT(evbit,  EV_MAX);
304 		MATCH_BIT(keybit, KEY_MAX);
305 		MATCH_BIT(relbit, REL_MAX);
306 		MATCH_BIT(absbit, ABS_MAX);
307 		MATCH_BIT(mscbit, MSC_MAX);
308 		MATCH_BIT(ledbit, LED_MAX);
309 		MATCH_BIT(sndbit, SND_MAX);
310 		MATCH_BIT(ffbit,  FF_MAX);
311 		MATCH_BIT(swbit,  SW_MAX);
312 
313 		return id;
314 	}
315 
316 	return NULL;
317 }
318 
319 
320 /*
321  * Input hotplugging interface - loading event handlers based on
322  * device bitfields.
323  */
324 
325 #ifdef CONFIG_HOTPLUG
326 
327 /*
328  * Input hotplugging invokes what /proc/sys/kernel/hotplug says
329  * (normally /sbin/hotplug) when input devices get added or removed.
330  *
331  * This invokes a user mode policy agent, typically helping to load driver
332  * or other modules, configure the device, and more.  Drivers can provide
333  * a MODULE_DEVICE_TABLE to help with module loading subtasks.
334  *
335  */
336 
337 #define SPRINTF_BIT_A(bit, name, max) \
338 	do { \
339 		envp[i++] = scratch; \
340 		scratch += sprintf(scratch, name); \
341 		for (j = NBITS(max) - 1; j >= 0; j--) \
342 			if (dev->bit[j]) break; \
343 		for (; j >= 0; j--) \
344 			scratch += sprintf(scratch, "%lx ", dev->bit[j]); \
345 		scratch++; \
346 	} while (0)
347 
348 #define SPRINTF_BIT_A2(bit, name, max, ev) \
349 	do { \
350 		if (test_bit(ev, dev->evbit)) \
351 			SPRINTF_BIT_A(bit, name, max); \
352 	} while (0)
353 
354 static void input_call_hotplug(char *verb, struct input_dev *dev)
355 {
356 	char *argv[3], **envp, *buf, *scratch;
357 	int i = 0, j, value;
358 
359 	if (!hotplug_path[0]) {
360 		printk(KERN_ERR "input.c: calling hotplug without a hotplug agent defined\n");
361 		return;
362 	}
363 	if (in_interrupt()) {
364 		printk(KERN_ERR "input.c: calling hotplug from interrupt\n");
365 		return;
366 	}
367 	if (!current->fs->root) {
368 		printk(KERN_WARNING "input.c: calling hotplug without valid filesystem\n");
369 		return;
370 	}
371 	if (!(envp = (char **) kmalloc(20 * sizeof(char *), GFP_KERNEL))) {
372 		printk(KERN_ERR "input.c: not enough memory allocating hotplug environment\n");
373 		return;
374 	}
375 	if (!(buf = kmalloc(1024, GFP_KERNEL))) {
376 		kfree (envp);
377 		printk(KERN_ERR "input.c: not enough memory allocating hotplug environment\n");
378 		return;
379 	}
380 
381 	argv[0] = hotplug_path;
382 	argv[1] = "input";
383 	argv[2] = NULL;
384 
385 	envp[i++] = "HOME=/";
386 	envp[i++] = "PATH=/sbin:/bin:/usr/sbin:/usr/bin";
387 
388 	scratch = buf;
389 
390 	envp[i++] = scratch;
391 	scratch += sprintf(scratch, "ACTION=%s", verb) + 1;
392 
393 	envp[i++] = scratch;
394 	scratch += sprintf(scratch, "PRODUCT=%x/%x/%x/%x",
395 		dev->id.bustype, dev->id.vendor, dev->id.product, dev->id.version) + 1;
396 
397 	if (dev->name) {
398 		envp[i++] = scratch;
399 		scratch += sprintf(scratch, "NAME=%s", dev->name) + 1;
400 	}
401 
402 	if (dev->phys) {
403 		envp[i++] = scratch;
404 		scratch += sprintf(scratch, "PHYS=%s", dev->phys) + 1;
405 	}
406 
407 	SPRINTF_BIT_A(evbit, "EV=", EV_MAX);
408 	SPRINTF_BIT_A2(keybit, "KEY=", KEY_MAX, EV_KEY);
409 	SPRINTF_BIT_A2(relbit, "REL=", REL_MAX, EV_REL);
410 	SPRINTF_BIT_A2(absbit, "ABS=", ABS_MAX, EV_ABS);
411 	SPRINTF_BIT_A2(mscbit, "MSC=", MSC_MAX, EV_MSC);
412 	SPRINTF_BIT_A2(ledbit, "LED=", LED_MAX, EV_LED);
413 	SPRINTF_BIT_A2(sndbit, "SND=", SND_MAX, EV_SND);
414 	SPRINTF_BIT_A2(ffbit,  "FF=",  FF_MAX, EV_FF);
415 	SPRINTF_BIT_A2(swbit,  "SW=",  SW_MAX, EV_SW);
416 
417 	envp[i++] = NULL;
418 
419 #ifdef INPUT_DEBUG
420 	printk(KERN_DEBUG "input.c: calling %s %s [%s %s %s %s %s]\n",
421 		argv[0], argv[1], envp[0], envp[1], envp[2], envp[3], envp[4]);
422 #endif
423 
424 	value = call_usermodehelper(argv [0], argv, envp, 0);
425 
426 	kfree(buf);
427 	kfree(envp);
428 
429 #ifdef INPUT_DEBUG
430 	if (value != 0)
431 		printk(KERN_DEBUG "input.c: hotplug returned %d\n", value);
432 #endif
433 }
434 
435 #endif
436 
437 #ifdef CONFIG_PROC_FS
438 
439 static struct proc_dir_entry *proc_bus_input_dir;
440 static DECLARE_WAIT_QUEUE_HEAD(input_devices_poll_wait);
441 static int input_devices_state;
442 
443 static inline void input_wakeup_procfs_readers(void)
444 {
445 	input_devices_state++;
446 	wake_up(&input_devices_poll_wait);
447 }
448 
449 static unsigned int input_devices_poll(struct file *file, poll_table *wait)
450 {
451 	int state = input_devices_state;
452 	poll_wait(file, &input_devices_poll_wait, wait);
453 	if (state != input_devices_state)
454 		return POLLIN | POLLRDNORM;
455 	return 0;
456 }
457 
458 #define SPRINTF_BIT_B(bit, name, max) \
459 	do { \
460 		len += sprintf(buf + len, "B: %s", name); \
461 		for (i = NBITS(max) - 1; i >= 0; i--) \
462 			if (dev->bit[i]) break; \
463 		for (; i >= 0; i--) \
464 			len += sprintf(buf + len, "%lx ", dev->bit[i]); \
465 		len += sprintf(buf + len, "\n"); \
466 	} while (0)
467 
468 #define SPRINTF_BIT_B2(bit, name, max, ev) \
469 	do { \
470 		if (test_bit(ev, dev->evbit)) \
471 			SPRINTF_BIT_B(bit, name, max); \
472 	} while (0)
473 
474 static int input_devices_read(char *buf, char **start, off_t pos, int count, int *eof, void *data)
475 {
476 	struct input_dev *dev;
477 	struct input_handle *handle;
478 
479 	off_t at = 0;
480 	int i, len, cnt = 0;
481 
482 	list_for_each_entry(dev, &input_dev_list, node) {
483 
484 		len = sprintf(buf, "I: Bus=%04x Vendor=%04x Product=%04x Version=%04x\n",
485 			dev->id.bustype, dev->id.vendor, dev->id.product, dev->id.version);
486 
487 		len += sprintf(buf + len, "N: Name=\"%s\"\n", dev->name ? dev->name : "");
488 		len += sprintf(buf + len, "P: Phys=%s\n", dev->phys ? dev->phys : "");
489 		len += sprintf(buf + len, "H: Handlers=");
490 
491 		list_for_each_entry(handle, &dev->h_list, d_node)
492 			len += sprintf(buf + len, "%s ", handle->name);
493 
494 		len += sprintf(buf + len, "\n");
495 
496 		SPRINTF_BIT_B(evbit, "EV=", EV_MAX);
497 		SPRINTF_BIT_B2(keybit, "KEY=", KEY_MAX, EV_KEY);
498 		SPRINTF_BIT_B2(relbit, "REL=", REL_MAX, EV_REL);
499 		SPRINTF_BIT_B2(absbit, "ABS=", ABS_MAX, EV_ABS);
500 		SPRINTF_BIT_B2(mscbit, "MSC=", MSC_MAX, EV_MSC);
501 		SPRINTF_BIT_B2(ledbit, "LED=", LED_MAX, EV_LED);
502 		SPRINTF_BIT_B2(sndbit, "SND=", SND_MAX, EV_SND);
503 		SPRINTF_BIT_B2(ffbit,  "FF=",  FF_MAX, EV_FF);
504 		SPRINTF_BIT_B2(swbit,  "SW=",  SW_MAX, EV_SW);
505 
506 		len += sprintf(buf + len, "\n");
507 
508 		at += len;
509 
510 		if (at >= pos) {
511 			if (!*start) {
512 				*start = buf + (pos - (at - len));
513 				cnt = at - pos;
514 			} else  cnt += len;
515 			buf += len;
516 			if (cnt >= count)
517 				break;
518 		}
519 	}
520 
521 	if (&dev->node == &input_dev_list)
522 		*eof = 1;
523 
524 	return (count > cnt) ? cnt : count;
525 }
526 
527 static int input_handlers_read(char *buf, char **start, off_t pos, int count, int *eof, void *data)
528 {
529 	struct input_handler *handler;
530 
531 	off_t at = 0;
532 	int len = 0, cnt = 0;
533 	int i = 0;
534 
535 	list_for_each_entry(handler, &input_handler_list, node) {
536 
537 		if (handler->fops)
538 			len = sprintf(buf, "N: Number=%d Name=%s Minor=%d\n",
539 				i++, handler->name, handler->minor);
540 		else
541 			len = sprintf(buf, "N: Number=%d Name=%s\n",
542 				i++, handler->name);
543 
544 		at += len;
545 
546 		if (at >= pos) {
547 			if (!*start) {
548 				*start = buf + (pos - (at - len));
549 				cnt = at - pos;
550 			} else  cnt += len;
551 			buf += len;
552 			if (cnt >= count)
553 				break;
554 		}
555 	}
556 	if (&handler->node == &input_handler_list)
557 		*eof = 1;
558 
559 	return (count > cnt) ? cnt : count;
560 }
561 
562 static struct file_operations input_fileops;
563 
564 static int __init input_proc_init(void)
565 {
566 	struct proc_dir_entry *entry;
567 
568 	proc_bus_input_dir = proc_mkdir("input", proc_bus);
569 	if (!proc_bus_input_dir)
570 		return -ENOMEM;
571 
572 	proc_bus_input_dir->owner = THIS_MODULE;
573 
574 	entry = create_proc_read_entry("devices", 0, proc_bus_input_dir, input_devices_read, NULL);
575 	if (!entry)
576 		goto fail1;
577 
578 	entry->owner = THIS_MODULE;
579 	input_fileops = *entry->proc_fops;
580 	entry->proc_fops = &input_fileops;
581 	entry->proc_fops->poll = input_devices_poll;
582 
583 	entry = create_proc_read_entry("handlers", 0, proc_bus_input_dir, input_handlers_read, NULL);
584 	if (!entry)
585 		goto fail2;
586 
587 	entry->owner = THIS_MODULE;
588 
589 	return 0;
590 
591  fail2:	remove_proc_entry("devices", proc_bus_input_dir);
592  fail1: remove_proc_entry("input", proc_bus);
593 	return -ENOMEM;
594 }
595 
596 static void input_proc_exit(void)
597 {
598 	remove_proc_entry("devices", proc_bus_input_dir);
599 	remove_proc_entry("handlers", proc_bus_input_dir);
600 	remove_proc_entry("input", proc_bus);
601 }
602 
603 #else /* !CONFIG_PROC_FS */
604 static inline void input_wakeup_procfs_readers(void) { }
605 static inline int input_proc_init(void) { return 0; }
606 static inline void input_proc_exit(void) { }
607 #endif
608 
609 void input_register_device(struct input_dev *dev)
610 {
611 	struct input_handle *handle;
612 	struct input_handler *handler;
613 	struct input_device_id *id;
614 
615 	set_bit(EV_SYN, dev->evbit);
616 
617 	init_MUTEX(&dev->sem);
618 
619 	/*
620 	 * If delay and period are pre-set by the driver, then autorepeating
621 	 * is handled by the driver itself and we don't do it in input.c.
622 	 */
623 
624 	init_timer(&dev->timer);
625 	if (!dev->rep[REP_DELAY] && !dev->rep[REP_PERIOD]) {
626 		dev->timer.data = (long) dev;
627 		dev->timer.function = input_repeat_key;
628 		dev->rep[REP_DELAY] = 250;
629 		dev->rep[REP_PERIOD] = 33;
630 	}
631 
632 	INIT_LIST_HEAD(&dev->h_list);
633 	list_add_tail(&dev->node, &input_dev_list);
634 
635 	list_for_each_entry(handler, &input_handler_list, node)
636 		if (!handler->blacklist || !input_match_device(handler->blacklist, dev))
637 			if ((id = input_match_device(handler->id_table, dev)))
638 				if ((handle = handler->connect(handler, dev, id)))
639 					input_link_handle(handle);
640 
641 #ifdef CONFIG_HOTPLUG
642 	input_call_hotplug("add", dev);
643 #endif
644 
645 	input_wakeup_procfs_readers();
646 }
647 
648 void input_unregister_device(struct input_dev *dev)
649 {
650 	struct list_head * node, * next;
651 
652 	if (!dev) return;
653 
654 	del_timer_sync(&dev->timer);
655 
656 	list_for_each_safe(node, next, &dev->h_list) {
657 		struct input_handle * handle = to_handle(node);
658 		list_del_init(&handle->d_node);
659 		list_del_init(&handle->h_node);
660 		handle->handler->disconnect(handle);
661 	}
662 
663 #ifdef CONFIG_HOTPLUG
664 	input_call_hotplug("remove", dev);
665 #endif
666 
667 	list_del_init(&dev->node);
668 
669 	input_wakeup_procfs_readers();
670 }
671 
672 void input_register_handler(struct input_handler *handler)
673 {
674 	struct input_dev *dev;
675 	struct input_handle *handle;
676 	struct input_device_id *id;
677 
678 	if (!handler) return;
679 
680 	INIT_LIST_HEAD(&handler->h_list);
681 
682 	if (handler->fops != NULL)
683 		input_table[handler->minor >> 5] = handler;
684 
685 	list_add_tail(&handler->node, &input_handler_list);
686 
687 	list_for_each_entry(dev, &input_dev_list, node)
688 		if (!handler->blacklist || !input_match_device(handler->blacklist, dev))
689 			if ((id = input_match_device(handler->id_table, dev)))
690 				if ((handle = handler->connect(handler, dev, id)))
691 					input_link_handle(handle);
692 
693 	input_wakeup_procfs_readers();
694 }
695 
696 void input_unregister_handler(struct input_handler *handler)
697 {
698 	struct list_head * node, * next;
699 
700 	list_for_each_safe(node, next, &handler->h_list) {
701 		struct input_handle * handle = to_handle_h(node);
702 		list_del_init(&handle->h_node);
703 		list_del_init(&handle->d_node);
704 		handler->disconnect(handle);
705 	}
706 
707 	list_del_init(&handler->node);
708 
709 	if (handler->fops != NULL)
710 		input_table[handler->minor >> 5] = NULL;
711 
712 	input_wakeup_procfs_readers();
713 }
714 
715 static int input_open_file(struct inode *inode, struct file *file)
716 {
717 	struct input_handler *handler = input_table[iminor(inode) >> 5];
718 	struct file_operations *old_fops, *new_fops = NULL;
719 	int err;
720 
721 	/* No load-on-demand here? */
722 	if (!handler || !(new_fops = fops_get(handler->fops)))
723 		return -ENODEV;
724 
725 	/*
726 	 * That's _really_ odd. Usually NULL ->open means "nothing special",
727 	 * not "no device". Oh, well...
728 	 */
729 	if (!new_fops->open) {
730 		fops_put(new_fops);
731 		return -ENODEV;
732 	}
733 	old_fops = file->f_op;
734 	file->f_op = new_fops;
735 
736 	err = new_fops->open(inode, file);
737 
738 	if (err) {
739 		fops_put(file->f_op);
740 		file->f_op = fops_get(old_fops);
741 	}
742 	fops_put(old_fops);
743 	return err;
744 }
745 
746 static struct file_operations input_fops = {
747 	.owner = THIS_MODULE,
748 	.open = input_open_file,
749 };
750 
751 struct class *input_class;
752 
753 static int __init input_init(void)
754 {
755 	int err;
756 
757 	input_class = class_create(THIS_MODULE, "input");
758 	if (IS_ERR(input_class)) {
759 		printk(KERN_ERR "input: unable to register input class\n");
760 		return PTR_ERR(input_class);
761 	}
762 
763 	err = input_proc_init();
764 	if (err)
765 		goto fail1;
766 
767 	err = register_chrdev(INPUT_MAJOR, "input", &input_fops);
768 	if (err) {
769 		printk(KERN_ERR "input: unable to register char major %d", INPUT_MAJOR);
770 		goto fail2;
771 	}
772 
773 	err = devfs_mk_dir("input");
774 	if (err)
775 		goto fail3;
776 
777 	return 0;
778 
779  fail3:	unregister_chrdev(INPUT_MAJOR, "input");
780  fail2:	input_proc_exit();
781  fail1:	class_destroy(input_class);
782 	return err;
783 }
784 
785 static void __exit input_exit(void)
786 {
787 	input_proc_exit();
788 	devfs_remove("input");
789 	unregister_chrdev(INPUT_MAJOR, "input");
790 	class_destroy(input_class);
791 }
792 
793 subsys_initcall(input_init);
794 module_exit(input_exit);
795