2 * User level driver support for input subsystem
4 * Heavily based on evdev.c by Vojtech Pavlik
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
20 * Author: Aristeu Sergio Rozanski Filho <aris@cathedrallabs.org>
23 * 0.3 09/04/2006 (Anssi Hannula <anssi.hannula@gmail.com>)
24 * - updated ff support for the changes in kernel interface
25 * - added MODULE_VERSION
26 * 0.2 16/10/2004 (Micah Dowty <micah@navi.cx>)
27 * - added force feedback support
30 * - first public version
32 #include <linux/poll.h>
33 #include <linux/slab.h>
34 #include <linux/module.h>
35 #include <linux/init.h>
36 #include <linux/smp_lock.h>
38 #include <linux/miscdevice.h>
39 #include <linux/uinput.h>
40 #include "../input-compat.h"
42 static int uinput_dev_event(struct input_dev
*dev
, unsigned int type
, unsigned int code
, int value
)
44 struct uinput_device
*udev
= input_get_drvdata(dev
);
46 udev
->buff
[udev
->head
].type
= type
;
47 udev
->buff
[udev
->head
].code
= code
;
48 udev
->buff
[udev
->head
].value
= value
;
49 do_gettimeofday(&udev
->buff
[udev
->head
].time
);
50 udev
->head
= (udev
->head
+ 1) % UINPUT_BUFFER_SIZE
;
52 wake_up_interruptible(&udev
->waitq
);
57 /* Atomically allocate an ID for the given request. Returns 0 on success. */
58 static int uinput_request_alloc_id(struct uinput_device
*udev
, struct uinput_request
*request
)
63 spin_lock(&udev
->requests_lock
);
65 for (id
= 0; id
< UINPUT_NUM_REQUESTS
; id
++) {
66 if (!udev
->requests
[id
]) {
68 udev
->requests
[id
] = request
;
74 spin_unlock(&udev
->requests_lock
);
78 static struct uinput_request
*uinput_request_find(struct uinput_device
*udev
, int id
)
80 /* Find an input request, by ID. Returns NULL if the ID isn't valid. */
81 if (id
>= UINPUT_NUM_REQUESTS
|| id
< 0)
84 return udev
->requests
[id
];
87 static inline int uinput_request_reserve_slot(struct uinput_device
*udev
, struct uinput_request
*request
)
89 /* Allocate slot. If none are available right away, wait. */
90 return wait_event_interruptible(udev
->requests_waitq
,
91 !uinput_request_alloc_id(udev
, request
));
94 static void uinput_request_done(struct uinput_device
*udev
, struct uinput_request
*request
)
96 /* Mark slot as available */
97 udev
->requests
[request
->id
] = NULL
;
98 wake_up(&udev
->requests_waitq
);
100 complete(&request
->done
);
103 static int uinput_request_submit(struct uinput_device
*udev
, struct uinput_request
*request
)
107 retval
= uinput_request_reserve_slot(udev
, request
);
111 retval
= mutex_lock_interruptible(&udev
->mutex
);
115 if (udev
->state
!= UIST_CREATED
) {
120 /* Tell our userspace app about this new request by queueing an input event */
121 uinput_dev_event(udev
->dev
, EV_UINPUT
, request
->code
, request
->id
);
124 mutex_unlock(&udev
->mutex
);
129 * Fail all ouitstanding requests so handlers don't wait for the userspace
130 * to finish processing them.
132 static void uinput_flush_requests(struct uinput_device
*udev
)
134 struct uinput_request
*request
;
137 spin_lock(&udev
->requests_lock
);
139 for (i
= 0; i
< UINPUT_NUM_REQUESTS
; i
++) {
140 request
= udev
->requests
[i
];
142 request
->retval
= -ENODEV
;
143 uinput_request_done(udev
, request
);
147 spin_unlock(&udev
->requests_lock
);
150 static void uinput_dev_set_gain(struct input_dev
*dev
, u16 gain
)
152 uinput_dev_event(dev
, EV_FF
, FF_GAIN
, gain
);
155 static void uinput_dev_set_autocenter(struct input_dev
*dev
, u16 magnitude
)
157 uinput_dev_event(dev
, EV_FF
, FF_AUTOCENTER
, magnitude
);
160 static int uinput_dev_playback(struct input_dev
*dev
, int effect_id
, int value
)
162 return uinput_dev_event(dev
, EV_FF
, effect_id
, value
);
165 static int uinput_dev_upload_effect(struct input_dev
*dev
, struct ff_effect
*effect
, struct ff_effect
*old
)
167 struct uinput_device
*udev
= input_get_drvdata(dev
);
168 struct uinput_request request
;
172 * uinput driver does not currently support periodic effects with
173 * custom waveform since it does not have a way to pass buffer of
174 * samples (custom_data) to userspace. If ever there is a device
175 * supporting custom waveforms we would need to define an additional
176 * ioctl (UI_UPLOAD_SAMPLES) but for now we just bail out.
178 if (effect
->type
== FF_PERIODIC
&&
179 effect
->u
.periodic
.waveform
== FF_CUSTOM
)
183 init_completion(&request
.done
);
184 request
.code
= UI_FF_UPLOAD
;
185 request
.u
.upload
.effect
= effect
;
186 request
.u
.upload
.old
= old
;
188 retval
= uinput_request_submit(udev
, &request
);
190 wait_for_completion(&request
.done
);
191 retval
= request
.retval
;
197 static int uinput_dev_erase_effect(struct input_dev
*dev
, int effect_id
)
199 struct uinput_device
*udev
= input_get_drvdata(dev
);
200 struct uinput_request request
;
203 if (!test_bit(EV_FF
, dev
->evbit
))
207 init_completion(&request
.done
);
208 request
.code
= UI_FF_ERASE
;
209 request
.u
.effect_id
= effect_id
;
211 retval
= uinput_request_submit(udev
, &request
);
213 wait_for_completion(&request
.done
);
214 retval
= request
.retval
;
220 static void uinput_destroy_device(struct uinput_device
*udev
)
222 const char *name
, *phys
;
223 struct input_dev
*dev
= udev
->dev
;
224 enum uinput_state old_state
= udev
->state
;
226 udev
->state
= UIST_NEW_DEVICE
;
231 if (old_state
== UIST_CREATED
) {
232 uinput_flush_requests(udev
);
233 input_unregister_device(dev
);
235 input_free_device(dev
);
243 static int uinput_create_device(struct uinput_device
*udev
)
245 struct input_dev
*dev
= udev
->dev
;
248 if (udev
->state
!= UIST_SETUP_COMPLETE
) {
249 printk(KERN_DEBUG
"%s: write device info first\n", UINPUT_NAME
);
253 if (udev
->ff_effects_max
) {
254 error
= input_ff_create(dev
, udev
->ff_effects_max
);
258 dev
->ff
->upload
= uinput_dev_upload_effect
;
259 dev
->ff
->erase
= uinput_dev_erase_effect
;
260 dev
->ff
->playback
= uinput_dev_playback
;
261 dev
->ff
->set_gain
= uinput_dev_set_gain
;
262 dev
->ff
->set_autocenter
= uinput_dev_set_autocenter
;
265 error
= input_register_device(udev
->dev
);
269 udev
->state
= UIST_CREATED
;
273 fail2
: input_ff_destroy(dev
);
274 fail1
: uinput_destroy_device(udev
);
278 static int uinput_open(struct inode
*inode
, struct file
*file
)
280 struct uinput_device
*newdev
;
282 newdev
= kzalloc(sizeof(struct uinput_device
), GFP_KERNEL
);
287 mutex_init(&newdev
->mutex
);
288 spin_lock_init(&newdev
->requests_lock
);
289 init_waitqueue_head(&newdev
->requests_waitq
);
290 init_waitqueue_head(&newdev
->waitq
);
291 newdev
->state
= UIST_NEW_DEVICE
;
293 file
->private_data
= newdev
;
299 static int uinput_validate_absbits(struct input_dev
*dev
)
304 for (cnt
= 0; cnt
< ABS_MAX
+ 1; cnt
++) {
305 if (!test_bit(cnt
, dev
->absbit
))
308 if ((dev
->absmax
[cnt
] <= dev
->absmin
[cnt
])) {
310 "%s: invalid abs[%02x] min:%d max:%d\n",
312 dev
->absmin
[cnt
], dev
->absmax
[cnt
]);
317 if (dev
->absflat
[cnt
] > (dev
->absmax
[cnt
] - dev
->absmin
[cnt
])) {
319 "%s: absflat[%02x] out of range: %d "
321 UINPUT_NAME
, cnt
, dev
->absflat
[cnt
],
322 dev
->absmin
[cnt
], dev
->absmax
[cnt
]);
330 static int uinput_allocate_device(struct uinput_device
*udev
)
332 udev
->dev
= input_allocate_device();
336 udev
->dev
->event
= uinput_dev_event
;
337 input_set_drvdata(udev
->dev
, udev
);
342 static int uinput_setup_device(struct uinput_device
*udev
, const char __user
*buffer
, size_t count
)
344 struct uinput_user_dev
*user_dev
;
345 struct input_dev
*dev
;
350 if (count
!= sizeof(struct uinput_user_dev
))
354 retval
= uinput_allocate_device(udev
);
361 user_dev
= kmalloc(sizeof(struct uinput_user_dev
), GFP_KERNEL
);
365 if (copy_from_user(user_dev
, buffer
, sizeof(struct uinput_user_dev
))) {
370 udev
->ff_effects_max
= user_dev
->ff_effects_max
;
372 size
= strnlen(user_dev
->name
, UINPUT_MAX_NAME_SIZE
) + 1;
379 dev
->name
= name
= kmalloc(size
, GFP_KERNEL
);
384 strlcpy(name
, user_dev
->name
, size
);
386 dev
->id
.bustype
= user_dev
->id
.bustype
;
387 dev
->id
.vendor
= user_dev
->id
.vendor
;
388 dev
->id
.product
= user_dev
->id
.product
;
389 dev
->id
.version
= user_dev
->id
.version
;
391 size
= sizeof(int) * (ABS_MAX
+ 1);
392 memcpy(dev
->absmax
, user_dev
->absmax
, size
);
393 memcpy(dev
->absmin
, user_dev
->absmin
, size
);
394 memcpy(dev
->absfuzz
, user_dev
->absfuzz
, size
);
395 memcpy(dev
->absflat
, user_dev
->absflat
, size
);
397 /* check if absmin/absmax/absfuzz/absflat are filled as
398 * told in Documentation/input/input-programming.txt */
399 if (test_bit(EV_ABS
, dev
->evbit
)) {
400 retval
= uinput_validate_absbits(dev
);
405 udev
->state
= UIST_SETUP_COMPLETE
;
413 static inline ssize_t
uinput_inject_event(struct uinput_device
*udev
, const char __user
*buffer
, size_t count
)
415 struct input_event ev
;
417 if (count
< input_event_size())
420 if (input_event_from_user(buffer
, &ev
))
423 input_event(udev
->dev
, ev
.type
, ev
.code
, ev
.value
);
425 return input_event_size();
428 static ssize_t
uinput_write(struct file
*file
, const char __user
*buffer
, size_t count
, loff_t
*ppos
)
430 struct uinput_device
*udev
= file
->private_data
;
433 retval
= mutex_lock_interruptible(&udev
->mutex
);
437 retval
= udev
->state
== UIST_CREATED
?
438 uinput_inject_event(udev
, buffer
, count
) :
439 uinput_setup_device(udev
, buffer
, count
);
441 mutex_unlock(&udev
->mutex
);
446 static ssize_t
uinput_read(struct file
*file
, char __user
*buffer
, size_t count
, loff_t
*ppos
)
448 struct uinput_device
*udev
= file
->private_data
;
451 if (udev
->state
!= UIST_CREATED
)
454 if (udev
->head
== udev
->tail
&& (file
->f_flags
& O_NONBLOCK
))
457 retval
= wait_event_interruptible(udev
->waitq
,
458 udev
->head
!= udev
->tail
|| udev
->state
!= UIST_CREATED
);
462 retval
= mutex_lock_interruptible(&udev
->mutex
);
466 if (udev
->state
!= UIST_CREATED
) {
471 while (udev
->head
!= udev
->tail
&& retval
+ input_event_size() <= count
) {
472 if (input_event_to_user(buffer
+ retval
, &udev
->buff
[udev
->tail
])) {
476 udev
->tail
= (udev
->tail
+ 1) % UINPUT_BUFFER_SIZE
;
477 retval
+= input_event_size();
481 mutex_unlock(&udev
->mutex
);
486 static unsigned int uinput_poll(struct file
*file
, poll_table
*wait
)
488 struct uinput_device
*udev
= file
->private_data
;
490 poll_wait(file
, &udev
->waitq
, wait
);
492 if (udev
->head
!= udev
->tail
)
493 return POLLIN
| POLLRDNORM
;
498 static int uinput_release(struct inode
*inode
, struct file
*file
)
500 struct uinput_device
*udev
= file
->private_data
;
502 uinput_destroy_device(udev
);
509 struct uinput_ff_upload_compat
{
512 struct ff_effect_compat effect
;
513 struct ff_effect_compat old
;
516 static int uinput_ff_upload_to_user(char __user
*buffer
,
517 const struct uinput_ff_upload
*ff_up
)
519 if (INPUT_COMPAT_TEST
) {
520 struct uinput_ff_upload_compat ff_up_compat
;
522 ff_up_compat
.request_id
= ff_up
->request_id
;
523 ff_up_compat
.retval
= ff_up
->retval
;
525 * It so happens that the pointer that gives us the trouble
526 * is the last field in the structure. Since we don't support
527 * custom waveforms in uinput anyway we can just copy the whole
528 * thing (to the compat size) and ignore the pointer.
530 memcpy(&ff_up_compat
.effect
, &ff_up
->effect
,
531 sizeof(struct ff_effect_compat
));
532 memcpy(&ff_up_compat
.old
, &ff_up
->old
,
533 sizeof(struct ff_effect_compat
));
535 if (copy_to_user(buffer
, &ff_up_compat
,
536 sizeof(struct uinput_ff_upload_compat
)))
539 if (copy_to_user(buffer
, ff_up
,
540 sizeof(struct uinput_ff_upload
)))
547 static int uinput_ff_upload_from_user(const char __user
*buffer
,
548 struct uinput_ff_upload
*ff_up
)
550 if (INPUT_COMPAT_TEST
) {
551 struct uinput_ff_upload_compat ff_up_compat
;
553 if (copy_from_user(&ff_up_compat
, buffer
,
554 sizeof(struct uinput_ff_upload_compat
)))
557 ff_up
->request_id
= ff_up_compat
.request_id
;
558 ff_up
->retval
= ff_up_compat
.retval
;
559 memcpy(&ff_up
->effect
, &ff_up_compat
.effect
,
560 sizeof(struct ff_effect_compat
));
561 memcpy(&ff_up
->old
, &ff_up_compat
.old
,
562 sizeof(struct ff_effect_compat
));
565 if (copy_from_user(ff_up
, buffer
,
566 sizeof(struct uinput_ff_upload
)))
575 static int uinput_ff_upload_to_user(char __user
*buffer
,
576 const struct uinput_ff_upload
*ff_up
)
578 if (copy_to_user(buffer
, ff_up
, sizeof(struct uinput_ff_upload
)))
584 static int uinput_ff_upload_from_user(const char __user
*buffer
,
585 struct uinput_ff_upload
*ff_up
)
587 if (copy_from_user(ff_up
, buffer
, sizeof(struct uinput_ff_upload
)))
595 #define uinput_set_bit(_arg, _bit, _max) \
598 if (udev->state == UIST_CREATED) \
600 else if ((_arg) > (_max)) \
602 else set_bit((_arg), udev->dev->_bit); \
606 static long uinput_ioctl_handler(struct file
*file
, unsigned int cmd
,
607 unsigned long arg
, void __user
*p
)
610 struct uinput_device
*udev
= file
->private_data
;
611 struct uinput_ff_upload ff_up
;
612 struct uinput_ff_erase ff_erase
;
613 struct uinput_request
*req
;
617 retval
= mutex_lock_interruptible(&udev
->mutex
);
622 retval
= uinput_allocate_device(udev
);
629 retval
= uinput_create_device(udev
);
633 uinput_destroy_device(udev
);
637 retval
= uinput_set_bit(arg
, evbit
, EV_MAX
);
641 retval
= uinput_set_bit(arg
, keybit
, KEY_MAX
);
645 retval
= uinput_set_bit(arg
, relbit
, REL_MAX
);
649 retval
= uinput_set_bit(arg
, absbit
, ABS_MAX
);
653 retval
= uinput_set_bit(arg
, mscbit
, MSC_MAX
);
657 retval
= uinput_set_bit(arg
, ledbit
, LED_MAX
);
661 retval
= uinput_set_bit(arg
, sndbit
, SND_MAX
);
665 retval
= uinput_set_bit(arg
, ffbit
, FF_MAX
);
669 retval
= uinput_set_bit(arg
, swbit
, SW_MAX
);
673 if (udev
->state
== UIST_CREATED
) {
677 length
= strnlen_user(p
, 1024);
682 kfree(udev
->dev
->phys
);
683 udev
->dev
->phys
= phys
= kmalloc(length
, GFP_KERNEL
);
688 if (copy_from_user(phys
, p
, length
)) {
689 udev
->dev
->phys
= NULL
;
694 phys
[length
- 1] = '\0';
697 case UI_BEGIN_FF_UPLOAD
:
698 retval
= uinput_ff_upload_from_user(p
, &ff_up
);
702 req
= uinput_request_find(udev
, ff_up
.request_id
);
703 if (!req
|| req
->code
!= UI_FF_UPLOAD
|| !req
->u
.upload
.effect
) {
709 ff_up
.effect
= *req
->u
.upload
.effect
;
710 if (req
->u
.upload
.old
)
711 ff_up
.old
= *req
->u
.upload
.old
;
713 memset(&ff_up
.old
, 0, sizeof(struct ff_effect
));
715 retval
= uinput_ff_upload_to_user(p
, &ff_up
);
718 case UI_BEGIN_FF_ERASE
:
719 if (copy_from_user(&ff_erase
, p
, sizeof(ff_erase
))) {
724 req
= uinput_request_find(udev
, ff_erase
.request_id
);
725 if (!req
|| req
->code
!= UI_FF_ERASE
) {
731 ff_erase
.effect_id
= req
->u
.effect_id
;
732 if (copy_to_user(p
, &ff_erase
, sizeof(ff_erase
))) {
739 case UI_END_FF_UPLOAD
:
740 retval
= uinput_ff_upload_from_user(p
, &ff_up
);
744 req
= uinput_request_find(udev
, ff_up
.request_id
);
745 if (!req
|| req
->code
!= UI_FF_UPLOAD
||
746 !req
->u
.upload
.effect
) {
751 req
->retval
= ff_up
.retval
;
752 uinput_request_done(udev
, req
);
755 case UI_END_FF_ERASE
:
756 if (copy_from_user(&ff_erase
, p
, sizeof(ff_erase
))) {
761 req
= uinput_request_find(udev
, ff_erase
.request_id
);
762 if (!req
|| req
->code
!= UI_FF_ERASE
) {
767 req
->retval
= ff_erase
.retval
;
768 uinput_request_done(udev
, req
);
776 mutex_unlock(&udev
->mutex
);
780 static long uinput_ioctl(struct file
*file
, unsigned int cmd
, unsigned long arg
)
782 return uinput_ioctl_handler(file
, cmd
, arg
, (void __user
*)arg
);
786 static long uinput_compat_ioctl(struct file
*file
, unsigned int cmd
, unsigned long arg
)
788 return uinput_ioctl_handler(file
, cmd
, arg
, compat_ptr(arg
));
792 static const struct file_operations uinput_fops
= {
793 .owner
= THIS_MODULE
,
795 .release
= uinput_release
,
797 .write
= uinput_write
,
799 .unlocked_ioctl
= uinput_ioctl
,
801 .compat_ioctl
= uinput_compat_ioctl
,
805 static struct miscdevice uinput_misc
= {
806 .fops
= &uinput_fops
,
807 .minor
= UINPUT_MINOR
,
811 static int __init
uinput_init(void)
813 return misc_register(&uinput_misc
);
816 static void __exit
uinput_exit(void)
818 misc_deregister(&uinput_misc
);
821 MODULE_AUTHOR("Aristeu Sergio Rozanski Filho");
822 MODULE_DESCRIPTION("User level driver support for input subsystem");
823 MODULE_LICENSE("GPL");
824 MODULE_VERSION("0.3");
826 module_init(uinput_init
);
827 module_exit(uinput_exit
);