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/sched.h>
34 #include <linux/slab.h>
35 #include <linux/module.h>
36 #include <linux/init.h>
37 #include <linux/smp_lock.h>
39 #include <linux/miscdevice.h>
40 #include <linux/uinput.h>
41 #include "../input-compat.h"
43 static int uinput_dev_event(struct input_dev
*dev
, unsigned int type
, unsigned int code
, int value
)
45 struct uinput_device
*udev
= input_get_drvdata(dev
);
47 udev
->buff
[udev
->head
].type
= type
;
48 udev
->buff
[udev
->head
].code
= code
;
49 udev
->buff
[udev
->head
].value
= value
;
50 do_gettimeofday(&udev
->buff
[udev
->head
].time
);
51 udev
->head
= (udev
->head
+ 1) % UINPUT_BUFFER_SIZE
;
53 wake_up_interruptible(&udev
->waitq
);
58 /* Atomically allocate an ID for the given request. Returns 0 on success. */
59 static int uinput_request_alloc_id(struct uinput_device
*udev
, struct uinput_request
*request
)
64 spin_lock(&udev
->requests_lock
);
66 for (id
= 0; id
< UINPUT_NUM_REQUESTS
; id
++) {
67 if (!udev
->requests
[id
]) {
69 udev
->requests
[id
] = request
;
75 spin_unlock(&udev
->requests_lock
);
79 static struct uinput_request
*uinput_request_find(struct uinput_device
*udev
, int id
)
81 /* Find an input request, by ID. Returns NULL if the ID isn't valid. */
82 if (id
>= UINPUT_NUM_REQUESTS
|| id
< 0)
85 return udev
->requests
[id
];
88 static inline int uinput_request_reserve_slot(struct uinput_device
*udev
, struct uinput_request
*request
)
90 /* Allocate slot. If none are available right away, wait. */
91 return wait_event_interruptible(udev
->requests_waitq
,
92 !uinput_request_alloc_id(udev
, request
));
95 static void uinput_request_done(struct uinput_device
*udev
, struct uinput_request
*request
)
97 /* Mark slot as available */
98 udev
->requests
[request
->id
] = NULL
;
99 wake_up(&udev
->requests_waitq
);
101 complete(&request
->done
);
104 static int uinput_request_submit(struct uinput_device
*udev
, struct uinput_request
*request
)
108 retval
= uinput_request_reserve_slot(udev
, request
);
112 retval
= mutex_lock_interruptible(&udev
->mutex
);
116 if (udev
->state
!= UIST_CREATED
) {
121 /* Tell our userspace app about this new request by queueing an input event */
122 uinput_dev_event(udev
->dev
, EV_UINPUT
, request
->code
, request
->id
);
125 mutex_unlock(&udev
->mutex
);
130 * Fail all ouitstanding requests so handlers don't wait for the userspace
131 * to finish processing them.
133 static void uinput_flush_requests(struct uinput_device
*udev
)
135 struct uinput_request
*request
;
138 spin_lock(&udev
->requests_lock
);
140 for (i
= 0; i
< UINPUT_NUM_REQUESTS
; i
++) {
141 request
= udev
->requests
[i
];
143 request
->retval
= -ENODEV
;
144 uinput_request_done(udev
, request
);
148 spin_unlock(&udev
->requests_lock
);
151 static void uinput_dev_set_gain(struct input_dev
*dev
, u16 gain
)
153 uinput_dev_event(dev
, EV_FF
, FF_GAIN
, gain
);
156 static void uinput_dev_set_autocenter(struct input_dev
*dev
, u16 magnitude
)
158 uinput_dev_event(dev
, EV_FF
, FF_AUTOCENTER
, magnitude
);
161 static int uinput_dev_playback(struct input_dev
*dev
, int effect_id
, int value
)
163 return uinput_dev_event(dev
, EV_FF
, effect_id
, value
);
166 static int uinput_dev_upload_effect(struct input_dev
*dev
, struct ff_effect
*effect
, struct ff_effect
*old
)
168 struct uinput_device
*udev
= input_get_drvdata(dev
);
169 struct uinput_request request
;
173 * uinput driver does not currently support periodic effects with
174 * custom waveform since it does not have a way to pass buffer of
175 * samples (custom_data) to userspace. If ever there is a device
176 * supporting custom waveforms we would need to define an additional
177 * ioctl (UI_UPLOAD_SAMPLES) but for now we just bail out.
179 if (effect
->type
== FF_PERIODIC
&&
180 effect
->u
.periodic
.waveform
== FF_CUSTOM
)
184 init_completion(&request
.done
);
185 request
.code
= UI_FF_UPLOAD
;
186 request
.u
.upload
.effect
= effect
;
187 request
.u
.upload
.old
= old
;
189 retval
= uinput_request_submit(udev
, &request
);
191 wait_for_completion(&request
.done
);
192 retval
= request
.retval
;
198 static int uinput_dev_erase_effect(struct input_dev
*dev
, int effect_id
)
200 struct uinput_device
*udev
= input_get_drvdata(dev
);
201 struct uinput_request request
;
204 if (!test_bit(EV_FF
, dev
->evbit
))
208 init_completion(&request
.done
);
209 request
.code
= UI_FF_ERASE
;
210 request
.u
.effect_id
= effect_id
;
212 retval
= uinput_request_submit(udev
, &request
);
214 wait_for_completion(&request
.done
);
215 retval
= request
.retval
;
221 static void uinput_destroy_device(struct uinput_device
*udev
)
223 const char *name
, *phys
;
224 struct input_dev
*dev
= udev
->dev
;
225 enum uinput_state old_state
= udev
->state
;
227 udev
->state
= UIST_NEW_DEVICE
;
232 if (old_state
== UIST_CREATED
) {
233 uinput_flush_requests(udev
);
234 input_unregister_device(dev
);
236 input_free_device(dev
);
244 static int uinput_create_device(struct uinput_device
*udev
)
246 struct input_dev
*dev
= udev
->dev
;
249 if (udev
->state
!= UIST_SETUP_COMPLETE
) {
250 printk(KERN_DEBUG
"%s: write device info first\n", UINPUT_NAME
);
254 if (udev
->ff_effects_max
) {
255 error
= input_ff_create(dev
, udev
->ff_effects_max
);
259 dev
->ff
->upload
= uinput_dev_upload_effect
;
260 dev
->ff
->erase
= uinput_dev_erase_effect
;
261 dev
->ff
->playback
= uinput_dev_playback
;
262 dev
->ff
->set_gain
= uinput_dev_set_gain
;
263 dev
->ff
->set_autocenter
= uinput_dev_set_autocenter
;
266 error
= input_register_device(udev
->dev
);
270 udev
->state
= UIST_CREATED
;
274 fail2
: input_ff_destroy(dev
);
275 fail1
: uinput_destroy_device(udev
);
279 static int uinput_open(struct inode
*inode
, struct file
*file
)
281 struct uinput_device
*newdev
;
283 newdev
= kzalloc(sizeof(struct uinput_device
), GFP_KERNEL
);
288 mutex_init(&newdev
->mutex
);
289 spin_lock_init(&newdev
->requests_lock
);
290 init_waitqueue_head(&newdev
->requests_waitq
);
291 init_waitqueue_head(&newdev
->waitq
);
292 newdev
->state
= UIST_NEW_DEVICE
;
294 file
->private_data
= newdev
;
300 static int uinput_validate_absbits(struct input_dev
*dev
)
305 for (cnt
= 0; cnt
< ABS_MAX
+ 1; cnt
++) {
306 if (!test_bit(cnt
, dev
->absbit
))
309 if ((dev
->absmax
[cnt
] <= dev
->absmin
[cnt
])) {
311 "%s: invalid abs[%02x] min:%d max:%d\n",
313 dev
->absmin
[cnt
], dev
->absmax
[cnt
]);
318 if (dev
->absflat
[cnt
] > (dev
->absmax
[cnt
] - dev
->absmin
[cnt
])) {
320 "%s: absflat[%02x] out of range: %d "
322 UINPUT_NAME
, cnt
, dev
->absflat
[cnt
],
323 dev
->absmin
[cnt
], dev
->absmax
[cnt
]);
331 static int uinput_allocate_device(struct uinput_device
*udev
)
333 udev
->dev
= input_allocate_device();
337 udev
->dev
->event
= uinput_dev_event
;
338 input_set_drvdata(udev
->dev
, udev
);
343 static int uinput_setup_device(struct uinput_device
*udev
, const char __user
*buffer
, size_t count
)
345 struct uinput_user_dev
*user_dev
;
346 struct input_dev
*dev
;
351 if (count
!= sizeof(struct uinput_user_dev
))
355 retval
= uinput_allocate_device(udev
);
362 user_dev
= kmalloc(sizeof(struct uinput_user_dev
), GFP_KERNEL
);
366 if (copy_from_user(user_dev
, buffer
, sizeof(struct uinput_user_dev
))) {
371 udev
->ff_effects_max
= user_dev
->ff_effects_max
;
373 size
= strnlen(user_dev
->name
, UINPUT_MAX_NAME_SIZE
) + 1;
380 dev
->name
= name
= kmalloc(size
, GFP_KERNEL
);
385 strlcpy(name
, user_dev
->name
, size
);
387 dev
->id
.bustype
= user_dev
->id
.bustype
;
388 dev
->id
.vendor
= user_dev
->id
.vendor
;
389 dev
->id
.product
= user_dev
->id
.product
;
390 dev
->id
.version
= user_dev
->id
.version
;
392 size
= sizeof(int) * (ABS_MAX
+ 1);
393 memcpy(dev
->absmax
, user_dev
->absmax
, size
);
394 memcpy(dev
->absmin
, user_dev
->absmin
, size
);
395 memcpy(dev
->absfuzz
, user_dev
->absfuzz
, size
);
396 memcpy(dev
->absflat
, user_dev
->absflat
, size
);
398 /* check if absmin/absmax/absfuzz/absflat are filled as
399 * told in Documentation/input/input-programming.txt */
400 if (test_bit(EV_ABS
, dev
->evbit
)) {
401 retval
= uinput_validate_absbits(dev
);
406 udev
->state
= UIST_SETUP_COMPLETE
;
414 static inline ssize_t
uinput_inject_event(struct uinput_device
*udev
, const char __user
*buffer
, size_t count
)
416 struct input_event ev
;
418 if (count
< input_event_size())
421 if (input_event_from_user(buffer
, &ev
))
424 input_event(udev
->dev
, ev
.type
, ev
.code
, ev
.value
);
426 return input_event_size();
429 static ssize_t
uinput_write(struct file
*file
, const char __user
*buffer
, size_t count
, loff_t
*ppos
)
431 struct uinput_device
*udev
= file
->private_data
;
434 retval
= mutex_lock_interruptible(&udev
->mutex
);
438 retval
= udev
->state
== UIST_CREATED
?
439 uinput_inject_event(udev
, buffer
, count
) :
440 uinput_setup_device(udev
, buffer
, count
);
442 mutex_unlock(&udev
->mutex
);
447 static ssize_t
uinput_read(struct file
*file
, char __user
*buffer
, size_t count
, loff_t
*ppos
)
449 struct uinput_device
*udev
= file
->private_data
;
452 if (udev
->state
!= UIST_CREATED
)
455 if (udev
->head
== udev
->tail
&& (file
->f_flags
& O_NONBLOCK
))
458 retval
= wait_event_interruptible(udev
->waitq
,
459 udev
->head
!= udev
->tail
|| udev
->state
!= UIST_CREATED
);
463 retval
= mutex_lock_interruptible(&udev
->mutex
);
467 if (udev
->state
!= UIST_CREATED
) {
472 while (udev
->head
!= udev
->tail
&& retval
+ input_event_size() <= count
) {
473 if (input_event_to_user(buffer
+ retval
, &udev
->buff
[udev
->tail
])) {
477 udev
->tail
= (udev
->tail
+ 1) % UINPUT_BUFFER_SIZE
;
478 retval
+= input_event_size();
482 mutex_unlock(&udev
->mutex
);
487 static unsigned int uinput_poll(struct file
*file
, poll_table
*wait
)
489 struct uinput_device
*udev
= file
->private_data
;
491 poll_wait(file
, &udev
->waitq
, wait
);
493 if (udev
->head
!= udev
->tail
)
494 return POLLIN
| POLLRDNORM
;
499 static int uinput_release(struct inode
*inode
, struct file
*file
)
501 struct uinput_device
*udev
= file
->private_data
;
503 uinput_destroy_device(udev
);
510 struct uinput_ff_upload_compat
{
513 struct ff_effect_compat effect
;
514 struct ff_effect_compat old
;
517 static int uinput_ff_upload_to_user(char __user
*buffer
,
518 const struct uinput_ff_upload
*ff_up
)
520 if (INPUT_COMPAT_TEST
) {
521 struct uinput_ff_upload_compat ff_up_compat
;
523 ff_up_compat
.request_id
= ff_up
->request_id
;
524 ff_up_compat
.retval
= ff_up
->retval
;
526 * It so happens that the pointer that gives us the trouble
527 * is the last field in the structure. Since we don't support
528 * custom waveforms in uinput anyway we can just copy the whole
529 * thing (to the compat size) and ignore the pointer.
531 memcpy(&ff_up_compat
.effect
, &ff_up
->effect
,
532 sizeof(struct ff_effect_compat
));
533 memcpy(&ff_up_compat
.old
, &ff_up
->old
,
534 sizeof(struct ff_effect_compat
));
536 if (copy_to_user(buffer
, &ff_up_compat
,
537 sizeof(struct uinput_ff_upload_compat
)))
540 if (copy_to_user(buffer
, ff_up
,
541 sizeof(struct uinput_ff_upload
)))
548 static int uinput_ff_upload_from_user(const char __user
*buffer
,
549 struct uinput_ff_upload
*ff_up
)
551 if (INPUT_COMPAT_TEST
) {
552 struct uinput_ff_upload_compat ff_up_compat
;
554 if (copy_from_user(&ff_up_compat
, buffer
,
555 sizeof(struct uinput_ff_upload_compat
)))
558 ff_up
->request_id
= ff_up_compat
.request_id
;
559 ff_up
->retval
= ff_up_compat
.retval
;
560 memcpy(&ff_up
->effect
, &ff_up_compat
.effect
,
561 sizeof(struct ff_effect_compat
));
562 memcpy(&ff_up
->old
, &ff_up_compat
.old
,
563 sizeof(struct ff_effect_compat
));
566 if (copy_from_user(ff_up
, buffer
,
567 sizeof(struct uinput_ff_upload
)))
576 static int uinput_ff_upload_to_user(char __user
*buffer
,
577 const struct uinput_ff_upload
*ff_up
)
579 if (copy_to_user(buffer
, ff_up
, sizeof(struct uinput_ff_upload
)))
585 static int uinput_ff_upload_from_user(const char __user
*buffer
,
586 struct uinput_ff_upload
*ff_up
)
588 if (copy_from_user(ff_up
, buffer
, sizeof(struct uinput_ff_upload
)))
596 #define uinput_set_bit(_arg, _bit, _max) \
599 if (udev->state == UIST_CREATED) \
601 else if ((_arg) > (_max)) \
603 else set_bit((_arg), udev->dev->_bit); \
607 static long uinput_ioctl_handler(struct file
*file
, unsigned int cmd
,
608 unsigned long arg
, void __user
*p
)
611 struct uinput_device
*udev
= file
->private_data
;
612 struct uinput_ff_upload ff_up
;
613 struct uinput_ff_erase ff_erase
;
614 struct uinput_request
*req
;
618 retval
= mutex_lock_interruptible(&udev
->mutex
);
623 retval
= uinput_allocate_device(udev
);
630 retval
= uinput_create_device(udev
);
634 uinput_destroy_device(udev
);
638 retval
= uinput_set_bit(arg
, evbit
, EV_MAX
);
642 retval
= uinput_set_bit(arg
, keybit
, KEY_MAX
);
646 retval
= uinput_set_bit(arg
, relbit
, REL_MAX
);
650 retval
= uinput_set_bit(arg
, absbit
, ABS_MAX
);
654 retval
= uinput_set_bit(arg
, mscbit
, MSC_MAX
);
658 retval
= uinput_set_bit(arg
, ledbit
, LED_MAX
);
662 retval
= uinput_set_bit(arg
, sndbit
, SND_MAX
);
666 retval
= uinput_set_bit(arg
, ffbit
, FF_MAX
);
670 retval
= uinput_set_bit(arg
, swbit
, SW_MAX
);
674 if (udev
->state
== UIST_CREATED
) {
678 length
= strnlen_user(p
, 1024);
683 kfree(udev
->dev
->phys
);
684 udev
->dev
->phys
= phys
= kmalloc(length
, GFP_KERNEL
);
689 if (copy_from_user(phys
, p
, length
)) {
690 udev
->dev
->phys
= NULL
;
695 phys
[length
- 1] = '\0';
698 case UI_BEGIN_FF_UPLOAD
:
699 retval
= uinput_ff_upload_from_user(p
, &ff_up
);
703 req
= uinput_request_find(udev
, ff_up
.request_id
);
704 if (!req
|| req
->code
!= UI_FF_UPLOAD
|| !req
->u
.upload
.effect
) {
710 ff_up
.effect
= *req
->u
.upload
.effect
;
711 if (req
->u
.upload
.old
)
712 ff_up
.old
= *req
->u
.upload
.old
;
714 memset(&ff_up
.old
, 0, sizeof(struct ff_effect
));
716 retval
= uinput_ff_upload_to_user(p
, &ff_up
);
719 case UI_BEGIN_FF_ERASE
:
720 if (copy_from_user(&ff_erase
, p
, sizeof(ff_erase
))) {
725 req
= uinput_request_find(udev
, ff_erase
.request_id
);
726 if (!req
|| req
->code
!= UI_FF_ERASE
) {
732 ff_erase
.effect_id
= req
->u
.effect_id
;
733 if (copy_to_user(p
, &ff_erase
, sizeof(ff_erase
))) {
740 case UI_END_FF_UPLOAD
:
741 retval
= uinput_ff_upload_from_user(p
, &ff_up
);
745 req
= uinput_request_find(udev
, ff_up
.request_id
);
746 if (!req
|| req
->code
!= UI_FF_UPLOAD
||
747 !req
->u
.upload
.effect
) {
752 req
->retval
= ff_up
.retval
;
753 uinput_request_done(udev
, req
);
756 case UI_END_FF_ERASE
:
757 if (copy_from_user(&ff_erase
, p
, sizeof(ff_erase
))) {
762 req
= uinput_request_find(udev
, ff_erase
.request_id
);
763 if (!req
|| req
->code
!= UI_FF_ERASE
) {
768 req
->retval
= ff_erase
.retval
;
769 uinput_request_done(udev
, req
);
777 mutex_unlock(&udev
->mutex
);
781 static long uinput_ioctl(struct file
*file
, unsigned int cmd
, unsigned long arg
)
783 return uinput_ioctl_handler(file
, cmd
, arg
, (void __user
*)arg
);
787 static long uinput_compat_ioctl(struct file
*file
, unsigned int cmd
, unsigned long arg
)
789 return uinput_ioctl_handler(file
, cmd
, arg
, compat_ptr(arg
));
793 static const struct file_operations uinput_fops
= {
794 .owner
= THIS_MODULE
,
796 .release
= uinput_release
,
798 .write
= uinput_write
,
800 .unlocked_ioctl
= uinput_ioctl
,
802 .compat_ioctl
= uinput_compat_ioctl
,
806 static struct miscdevice uinput_misc
= {
807 .fops
= &uinput_fops
,
808 .minor
= UINPUT_MINOR
,
812 static int __init
uinput_init(void)
814 return misc_register(&uinput_misc
);
817 static void __exit
uinput_exit(void)
819 misc_deregister(&uinput_misc
);
822 MODULE_AUTHOR("Aristeu Sergio Rozanski Filho");
823 MODULE_DESCRIPTION("User level driver support for input subsystem");
824 MODULE_LICENSE("GPL");
825 MODULE_VERSION("0.3");
827 module_init(uinput_init
);
828 module_exit(uinput_exit
);