]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * Event char devices, giving access to raw input device events. | |
3 | * | |
4 | * Copyright (c) 1999-2002 Vojtech Pavlik | |
5 | * | |
6 | * This program is free software; you can redistribute it and/or modify it | |
7 | * under the terms of the GNU General Public License version 2 as published by | |
8 | * the Free Software Foundation. | |
9 | */ | |
10 | ||
11 | #define EVDEV_MINOR_BASE 64 | |
12 | #define EVDEV_MINORS 32 | |
13 | #define EVDEV_BUFFER_SIZE 64 | |
14 | ||
15 | #include <linux/poll.h> | |
16 | #include <linux/slab.h> | |
17 | #include <linux/module.h> | |
18 | #include <linux/init.h> | |
19 | #include <linux/input.h> | |
20 | #include <linux/major.h> | |
1da177e4 | 21 | #include <linux/device.h> |
52658bb6 | 22 | #include <linux/compat.h> |
1da177e4 LT |
23 | |
24 | struct evdev { | |
25 | int exist; | |
26 | int open; | |
27 | int minor; | |
28 | char name[16]; | |
29 | struct input_handle handle; | |
30 | wait_queue_head_t wait; | |
d0ffb9be DT |
31 | struct evdev_client *grab; |
32 | struct list_head client_list; | |
6addb1d6 DT |
33 | spinlock_t client_lock; /* protects client_list */ |
34 | struct mutex mutex; | |
9657d75c | 35 | struct device dev; |
1da177e4 LT |
36 | }; |
37 | ||
d0ffb9be | 38 | struct evdev_client { |
1da177e4 LT |
39 | struct input_event buffer[EVDEV_BUFFER_SIZE]; |
40 | int head; | |
41 | int tail; | |
6addb1d6 | 42 | spinlock_t buffer_lock; /* protects access to buffer, head and tail */ |
1da177e4 LT |
43 | struct fasync_struct *fasync; |
44 | struct evdev *evdev; | |
45 | struct list_head node; | |
46 | }; | |
47 | ||
48 | static struct evdev *evdev_table[EVDEV_MINORS]; | |
6addb1d6 | 49 | static DEFINE_MUTEX(evdev_table_mutex); |
1da177e4 | 50 | |
6addb1d6 DT |
51 | static void evdev_pass_event(struct evdev_client *client, |
52 | struct input_event *event) | |
53 | { | |
54 | /* | |
55 | * Interrupts are disabled, just acquire the lock | |
56 | */ | |
57 | spin_lock(&client->buffer_lock); | |
58 | client->buffer[client->head++] = *event; | |
59 | client->head &= EVDEV_BUFFER_SIZE - 1; | |
60 | spin_unlock(&client->buffer_lock); | |
61 | ||
62 | kill_fasync(&client->fasync, SIGIO, POLL_IN); | |
63 | } | |
64 | ||
65 | /* | |
66 | * Pass incoming event to all connected clients. Note that we are | |
67 | * caleld under a spinlock with interrupts off so we don't need | |
68 | * to use rcu_read_lock() here. Writers will be using syncronize_sched() | |
69 | * instead of synchrnoize_rcu(). | |
70 | */ | |
71 | static void evdev_event(struct input_handle *handle, | |
72 | unsigned int type, unsigned int code, int value) | |
1da177e4 LT |
73 | { |
74 | struct evdev *evdev = handle->private; | |
d0ffb9be | 75 | struct evdev_client *client; |
6addb1d6 | 76 | struct input_event event; |
1da177e4 | 77 | |
6addb1d6 DT |
78 | do_gettimeofday(&event.time); |
79 | event.type = type; | |
80 | event.code = code; | |
81 | event.value = value; | |
1da177e4 | 82 | |
6addb1d6 DT |
83 | client = rcu_dereference(evdev->grab); |
84 | if (client) | |
85 | evdev_pass_event(client, &event); | |
86 | else | |
87 | list_for_each_entry_rcu(client, &evdev->client_list, node) | |
88 | evdev_pass_event(client, &event); | |
1da177e4 LT |
89 | |
90 | wake_up_interruptible(&evdev->wait); | |
91 | } | |
92 | ||
93 | static int evdev_fasync(int fd, struct file *file, int on) | |
94 | { | |
d0ffb9be | 95 | struct evdev_client *client = file->private_data; |
1da177e4 | 96 | int retval; |
1e0afb28 | 97 | |
d0ffb9be | 98 | retval = fasync_helper(fd, file, on, &client->fasync); |
1e0afb28 | 99 | |
1da177e4 LT |
100 | return retval < 0 ? retval : 0; |
101 | } | |
102 | ||
1e0afb28 | 103 | static int evdev_flush(struct file *file, fl_owner_t id) |
1da177e4 | 104 | { |
d0ffb9be DT |
105 | struct evdev_client *client = file->private_data; |
106 | struct evdev *evdev = client->evdev; | |
6addb1d6 DT |
107 | int retval; |
108 | ||
109 | retval = mutex_lock_interruptible(&evdev->mutex); | |
110 | if (retval) | |
111 | return retval; | |
1e0afb28 | 112 | |
d0ffb9be | 113 | if (!evdev->exist) |
6addb1d6 DT |
114 | retval = -ENODEV; |
115 | else | |
116 | retval = input_flush_device(&evdev->handle, file); | |
1e0afb28 | 117 | |
6addb1d6 DT |
118 | mutex_unlock(&evdev->mutex); |
119 | return retval; | |
1da177e4 LT |
120 | } |
121 | ||
9657d75c | 122 | static void evdev_free(struct device *dev) |
1da177e4 | 123 | { |
9657d75c DT |
124 | struct evdev *evdev = container_of(dev, struct evdev, dev); |
125 | ||
1da177e4 LT |
126 | kfree(evdev); |
127 | } | |
128 | ||
6addb1d6 DT |
129 | /* |
130 | * Grabs an event device (along with underlying input device). | |
131 | * This function is called with evdev->mutex taken. | |
132 | */ | |
133 | static int evdev_grab(struct evdev *evdev, struct evdev_client *client) | |
134 | { | |
135 | int error; | |
136 | ||
137 | if (evdev->grab) | |
138 | return -EBUSY; | |
139 | ||
140 | error = input_grab_device(&evdev->handle); | |
141 | if (error) | |
142 | return error; | |
143 | ||
144 | rcu_assign_pointer(evdev->grab, client); | |
145 | /* | |
146 | * We don't use synchronize_rcu() here because read-side | |
147 | * critical section is protected by a spinlock instead | |
148 | * of rcu_read_lock(). | |
149 | */ | |
150 | synchronize_sched(); | |
151 | ||
152 | return 0; | |
153 | } | |
154 | ||
155 | static int evdev_ungrab(struct evdev *evdev, struct evdev_client *client) | |
156 | { | |
157 | if (evdev->grab != client) | |
158 | return -EINVAL; | |
159 | ||
160 | rcu_assign_pointer(evdev->grab, NULL); | |
161 | synchronize_sched(); | |
162 | input_release_device(&evdev->handle); | |
163 | ||
164 | return 0; | |
165 | } | |
166 | ||
167 | static void evdev_attach_client(struct evdev *evdev, | |
168 | struct evdev_client *client) | |
169 | { | |
170 | spin_lock(&evdev->client_lock); | |
171 | list_add_tail_rcu(&client->node, &evdev->client_list); | |
172 | spin_unlock(&evdev->client_lock); | |
173 | synchronize_sched(); | |
174 | } | |
175 | ||
176 | static void evdev_detach_client(struct evdev *evdev, | |
177 | struct evdev_client *client) | |
178 | { | |
179 | spin_lock(&evdev->client_lock); | |
180 | list_del_rcu(&client->node); | |
181 | spin_unlock(&evdev->client_lock); | |
182 | synchronize_sched(); | |
183 | } | |
184 | ||
185 | static int evdev_open_device(struct evdev *evdev) | |
186 | { | |
187 | int retval; | |
188 | ||
189 | retval = mutex_lock_interruptible(&evdev->mutex); | |
190 | if (retval) | |
191 | return retval; | |
192 | ||
193 | if (!evdev->exist) | |
194 | retval = -ENODEV; | |
195 | else if (!evdev->open++) | |
196 | retval = input_open_device(&evdev->handle); | |
197 | ||
198 | mutex_unlock(&evdev->mutex); | |
199 | return retval; | |
200 | } | |
201 | ||
202 | static void evdev_close_device(struct evdev *evdev) | |
203 | { | |
204 | mutex_lock(&evdev->mutex); | |
205 | ||
206 | if (evdev->exist && !--evdev->open) | |
207 | input_close_device(&evdev->handle); | |
208 | ||
209 | mutex_unlock(&evdev->mutex); | |
210 | } | |
211 | ||
212 | /* | |
213 | * Wake up users waiting for IO so they can disconnect from | |
214 | * dead device. | |
215 | */ | |
216 | static void evdev_hangup(struct evdev *evdev) | |
217 | { | |
218 | struct evdev_client *client; | |
219 | ||
220 | spin_lock(&evdev->client_lock); | |
221 | list_for_each_entry(client, &evdev->client_list, node) | |
222 | kill_fasync(&client->fasync, SIGIO, POLL_HUP); | |
223 | spin_unlock(&evdev->client_lock); | |
224 | ||
225 | wake_up_interruptible(&evdev->wait); | |
226 | } | |
227 | ||
d0ffb9be | 228 | static int evdev_release(struct inode *inode, struct file *file) |
1da177e4 | 229 | { |
d0ffb9be DT |
230 | struct evdev_client *client = file->private_data; |
231 | struct evdev *evdev = client->evdev; | |
1da177e4 | 232 | |
6addb1d6 DT |
233 | mutex_lock(&evdev->mutex); |
234 | if (evdev->grab == client) | |
235 | evdev_ungrab(evdev, client); | |
236 | mutex_unlock(&evdev->mutex); | |
1da177e4 LT |
237 | |
238 | evdev_fasync(-1, file, 0); | |
6addb1d6 | 239 | evdev_detach_client(evdev, client); |
d0ffb9be | 240 | kfree(client); |
1da177e4 | 241 | |
6addb1d6 | 242 | evdev_close_device(evdev); |
9657d75c | 243 | put_device(&evdev->dev); |
1da177e4 | 244 | |
1da177e4 LT |
245 | return 0; |
246 | } | |
247 | ||
d0ffb9be | 248 | static int evdev_open(struct inode *inode, struct file *file) |
1da177e4 | 249 | { |
d0ffb9be | 250 | struct evdev *evdev; |
6addb1d6 | 251 | struct evdev_client *client; |
1da177e4 | 252 | int i = iminor(inode) - EVDEV_MINOR_BASE; |
d542ed82 | 253 | int error; |
1da177e4 | 254 | |
d0ffb9be | 255 | if (i >= EVDEV_MINORS) |
1da177e4 LT |
256 | return -ENODEV; |
257 | ||
6addb1d6 DT |
258 | error = mutex_lock_interruptible(&evdev_table_mutex); |
259 | if (error) | |
260 | return error; | |
d0ffb9be | 261 | evdev = evdev_table[i]; |
6addb1d6 DT |
262 | if (evdev) |
263 | get_device(&evdev->dev); | |
264 | mutex_unlock(&evdev_table_mutex); | |
d0ffb9be | 265 | |
6addb1d6 | 266 | if (!evdev) |
1da177e4 LT |
267 | return -ENODEV; |
268 | ||
d0ffb9be | 269 | client = kzalloc(sizeof(struct evdev_client), GFP_KERNEL); |
9657d75c DT |
270 | if (!client) { |
271 | error = -ENOMEM; | |
272 | goto err_put_evdev; | |
273 | } | |
1da177e4 | 274 | |
6addb1d6 | 275 | spin_lock_init(&client->buffer_lock); |
d0ffb9be | 276 | client->evdev = evdev; |
6addb1d6 | 277 | evdev_attach_client(evdev, client); |
1da177e4 | 278 | |
6addb1d6 DT |
279 | error = evdev_open_device(evdev); |
280 | if (error) | |
281 | goto err_free_client; | |
1da177e4 | 282 | |
d0ffb9be | 283 | file->private_data = client; |
1da177e4 | 284 | return 0; |
9657d75c DT |
285 | |
286 | err_free_client: | |
6addb1d6 | 287 | evdev_detach_client(evdev, client); |
9657d75c DT |
288 | kfree(client); |
289 | err_put_evdev: | |
290 | put_device(&evdev->dev); | |
291 | return error; | |
1da177e4 LT |
292 | } |
293 | ||
52658bb6 | 294 | #ifdef CONFIG_COMPAT |
3a51f7c4 | 295 | |
52658bb6 JK |
296 | struct input_event_compat { |
297 | struct compat_timeval time; | |
298 | __u16 type; | |
299 | __u16 code; | |
300 | __s32 value; | |
301 | }; | |
302 | ||
bf2fcc6f AK |
303 | /* Note to the author of this code: did it ever occur to |
304 | you why the ifdefs are needed? Think about it again. -AK */ | |
52658bb6 | 305 | #ifdef CONFIG_X86_64 |
bf2fcc6f | 306 | # define COMPAT_TEST is_compat_task() |
52658bb6 | 307 | #elif defined(CONFIG_IA64) |
6450578f | 308 | # define COMPAT_TEST IS_IA32_PROCESS(task_pt_regs(current)) |
347a8dc3 | 309 | #elif defined(CONFIG_S390) |
52658bb6 | 310 | # define COMPAT_TEST test_thread_flag(TIF_31BIT) |
59df6bbf RB |
311 | #elif defined(CONFIG_MIPS) |
312 | # define COMPAT_TEST (current->thread.mflags & MF_32BIT_ADDR) | |
52658bb6 JK |
313 | #else |
314 | # define COMPAT_TEST test_thread_flag(TIF_32BIT) | |
315 | #endif | |
316 | ||
3a51f7c4 | 317 | static inline size_t evdev_event_size(void) |
52658bb6 | 318 | { |
3a51f7c4 DT |
319 | return COMPAT_TEST ? |
320 | sizeof(struct input_event_compat) : sizeof(struct input_event); | |
321 | } | |
52658bb6 | 322 | |
6addb1d6 DT |
323 | static int evdev_event_from_user(const char __user *buffer, |
324 | struct input_event *event) | |
3a51f7c4 DT |
325 | { |
326 | if (COMPAT_TEST) { | |
327 | struct input_event_compat compat_event; | |
328 | ||
6addb1d6 DT |
329 | if (copy_from_user(&compat_event, buffer, |
330 | sizeof(struct input_event_compat))) | |
3a51f7c4 DT |
331 | return -EFAULT; |
332 | ||
333 | event->time.tv_sec = compat_event.time.tv_sec; | |
334 | event->time.tv_usec = compat_event.time.tv_usec; | |
335 | event->type = compat_event.type; | |
336 | event->code = compat_event.code; | |
337 | event->value = compat_event.value; | |
338 | ||
339 | } else { | |
340 | if (copy_from_user(event, buffer, sizeof(struct input_event))) | |
52658bb6 | 341 | return -EFAULT; |
52658bb6 JK |
342 | } |
343 | ||
3a51f7c4 | 344 | return 0; |
52658bb6 | 345 | } |
52658bb6 | 346 | |
6addb1d6 DT |
347 | static int evdev_event_to_user(char __user *buffer, |
348 | const struct input_event *event) | |
1da177e4 | 349 | { |
3a51f7c4 DT |
350 | if (COMPAT_TEST) { |
351 | struct input_event_compat compat_event; | |
1da177e4 | 352 | |
3a51f7c4 DT |
353 | compat_event.time.tv_sec = event->time.tv_sec; |
354 | compat_event.time.tv_usec = event->time.tv_usec; | |
355 | compat_event.type = event->type; | |
356 | compat_event.code = event->code; | |
357 | compat_event.value = event->value; | |
52658bb6 | 358 | |
6addb1d6 DT |
359 | if (copy_to_user(buffer, &compat_event, |
360 | sizeof(struct input_event_compat))) | |
3a51f7c4 | 361 | return -EFAULT; |
1da177e4 | 362 | |
3a51f7c4 DT |
363 | } else { |
364 | if (copy_to_user(buffer, event, sizeof(struct input_event))) | |
1da177e4 | 365 | return -EFAULT; |
1da177e4 LT |
366 | } |
367 | ||
3a51f7c4 | 368 | return 0; |
1da177e4 LT |
369 | } |
370 | ||
3a51f7c4 DT |
371 | #else |
372 | ||
373 | static inline size_t evdev_event_size(void) | |
52658bb6 | 374 | { |
3a51f7c4 DT |
375 | return sizeof(struct input_event); |
376 | } | |
52658bb6 | 377 | |
6addb1d6 DT |
378 | static int evdev_event_from_user(const char __user *buffer, |
379 | struct input_event *event) | |
3a51f7c4 DT |
380 | { |
381 | if (copy_from_user(event, buffer, sizeof(struct input_event))) | |
382 | return -EFAULT; | |
52658bb6 | 383 | |
3a51f7c4 DT |
384 | return 0; |
385 | } | |
52658bb6 | 386 | |
6addb1d6 DT |
387 | static int evdev_event_to_user(char __user *buffer, |
388 | const struct input_event *event) | |
3a51f7c4 DT |
389 | { |
390 | if (copy_to_user(buffer, event, sizeof(struct input_event))) | |
391 | return -EFAULT; | |
52658bb6 | 392 | |
3a51f7c4 DT |
393 | return 0; |
394 | } | |
395 | ||
396 | #endif /* CONFIG_COMPAT */ | |
397 | ||
6addb1d6 DT |
398 | static ssize_t evdev_write(struct file *file, const char __user *buffer, |
399 | size_t count, loff_t *ppos) | |
3a51f7c4 | 400 | { |
d0ffb9be DT |
401 | struct evdev_client *client = file->private_data; |
402 | struct evdev *evdev = client->evdev; | |
3a51f7c4 | 403 | struct input_event event; |
6addb1d6 | 404 | int retval; |
52658bb6 | 405 | |
6addb1d6 DT |
406 | retval = mutex_lock_interruptible(&evdev->mutex); |
407 | if (retval) | |
408 | return retval; | |
409 | ||
410 | if (!evdev->exist) { | |
411 | retval = -ENODEV; | |
412 | goto out; | |
413 | } | |
52658bb6 | 414 | |
3a51f7c4 DT |
415 | while (retval < count) { |
416 | ||
6addb1d6 DT |
417 | if (evdev_event_from_user(buffer + retval, &event)) { |
418 | retval = -EFAULT; | |
419 | goto out; | |
420 | } | |
421 | ||
422 | input_inject_event(&evdev->handle, | |
423 | event.type, event.code, event.value); | |
3a51f7c4 | 424 | retval += evdev_event_size(); |
52658bb6 JK |
425 | } |
426 | ||
6addb1d6 DT |
427 | out: |
428 | mutex_unlock(&evdev->mutex); | |
52658bb6 JK |
429 | return retval; |
430 | } | |
52658bb6 | 431 | |
6addb1d6 DT |
432 | static int evdev_fetch_next_event(struct evdev_client *client, |
433 | struct input_event *event) | |
434 | { | |
435 | int have_event; | |
436 | ||
437 | spin_lock_irq(&client->buffer_lock); | |
438 | ||
439 | have_event = client->head != client->tail; | |
440 | if (have_event) { | |
441 | *event = client->buffer[client->tail++]; | |
442 | client->tail &= EVDEV_BUFFER_SIZE - 1; | |
443 | } | |
444 | ||
445 | spin_unlock_irq(&client->buffer_lock); | |
446 | ||
447 | return have_event; | |
448 | } | |
449 | ||
450 | static ssize_t evdev_read(struct file *file, char __user *buffer, | |
451 | size_t count, loff_t *ppos) | |
1da177e4 | 452 | { |
d0ffb9be DT |
453 | struct evdev_client *client = file->private_data; |
454 | struct evdev *evdev = client->evdev; | |
6addb1d6 | 455 | struct input_event event; |
1da177e4 LT |
456 | int retval; |
457 | ||
3a51f7c4 | 458 | if (count < evdev_event_size()) |
1da177e4 LT |
459 | return -EINVAL; |
460 | ||
6addb1d6 DT |
461 | if (client->head == client->tail && evdev->exist && |
462 | (file->f_flags & O_NONBLOCK)) | |
1da177e4 LT |
463 | return -EAGAIN; |
464 | ||
d0ffb9be DT |
465 | retval = wait_event_interruptible(evdev->wait, |
466 | client->head != client->tail || !evdev->exist); | |
1da177e4 LT |
467 | if (retval) |
468 | return retval; | |
469 | ||
d0ffb9be | 470 | if (!evdev->exist) |
1da177e4 LT |
471 | return -ENODEV; |
472 | ||
6addb1d6 DT |
473 | while (retval + evdev_event_size() <= count && |
474 | evdev_fetch_next_event(client, &event)) { | |
3a51f7c4 | 475 | |
6addb1d6 | 476 | if (evdev_event_to_user(buffer + retval, &event)) |
3a51f7c4 DT |
477 | return -EFAULT; |
478 | ||
3a51f7c4 | 479 | retval += evdev_event_size(); |
1da177e4 LT |
480 | } |
481 | ||
482 | return retval; | |
483 | } | |
484 | ||
485 | /* No kernel lock - fine */ | |
486 | static unsigned int evdev_poll(struct file *file, poll_table *wait) | |
487 | { | |
d0ffb9be DT |
488 | struct evdev_client *client = file->private_data; |
489 | struct evdev *evdev = client->evdev; | |
1e0afb28 | 490 | |
d0ffb9be DT |
491 | poll_wait(file, &evdev->wait, wait); |
492 | return ((client->head == client->tail) ? 0 : (POLLIN | POLLRDNORM)) | | |
493 | (evdev->exist ? 0 : (POLLHUP | POLLERR)); | |
1da177e4 LT |
494 | } |
495 | ||
3a51f7c4 DT |
496 | #ifdef CONFIG_COMPAT |
497 | ||
498 | #define BITS_PER_LONG_COMPAT (sizeof(compat_long_t) * 8) | |
499 | #define NBITS_COMPAT(x) ((((x) - 1) / BITS_PER_LONG_COMPAT) + 1) | |
500 | ||
501 | #ifdef __BIG_ENDIAN | |
502 | static int bits_to_user(unsigned long *bits, unsigned int maxbit, | |
503 | unsigned int maxlen, void __user *p, int compat) | |
504 | { | |
505 | int len, i; | |
506 | ||
507 | if (compat) { | |
508 | len = NBITS_COMPAT(maxbit) * sizeof(compat_long_t); | |
bf61f8d3 | 509 | if (len > maxlen) |
3a51f7c4 DT |
510 | len = maxlen; |
511 | ||
512 | for (i = 0; i < len / sizeof(compat_long_t); i++) | |
513 | if (copy_to_user((compat_long_t __user *) p + i, | |
514 | (compat_long_t *) bits + | |
515 | i + 1 - ((i % 2) << 1), | |
516 | sizeof(compat_long_t))) | |
517 | return -EFAULT; | |
518 | } else { | |
519 | len = NBITS(maxbit) * sizeof(long); | |
520 | if (len > maxlen) | |
521 | len = maxlen; | |
522 | ||
523 | if (copy_to_user(p, bits, len)) | |
524 | return -EFAULT; | |
525 | } | |
526 | ||
527 | return len; | |
528 | } | |
529 | #else | |
530 | static int bits_to_user(unsigned long *bits, unsigned int maxbit, | |
531 | unsigned int maxlen, void __user *p, int compat) | |
532 | { | |
533 | int len = compat ? | |
534 | NBITS_COMPAT(maxbit) * sizeof(compat_long_t) : | |
535 | NBITS(maxbit) * sizeof(long); | |
536 | ||
537 | if (len > maxlen) | |
538 | len = maxlen; | |
539 | ||
540 | return copy_to_user(p, bits, len) ? -EFAULT : len; | |
541 | } | |
542 | #endif /* __BIG_ENDIAN */ | |
543 | ||
544 | #else | |
545 | ||
546 | static int bits_to_user(unsigned long *bits, unsigned int maxbit, | |
547 | unsigned int maxlen, void __user *p, int compat) | |
548 | { | |
549 | int len = NBITS(maxbit) * sizeof(long); | |
550 | ||
551 | if (len > maxlen) | |
552 | len = maxlen; | |
553 | ||
554 | return copy_to_user(p, bits, len) ? -EFAULT : len; | |
555 | } | |
556 | ||
557 | #endif /* CONFIG_COMPAT */ | |
558 | ||
559 | static int str_to_user(const char *str, unsigned int maxlen, void __user *p) | |
560 | { | |
561 | int len; | |
562 | ||
563 | if (!str) | |
564 | return -ENOENT; | |
565 | ||
566 | len = strlen(str) + 1; | |
567 | if (len > maxlen) | |
568 | len = maxlen; | |
569 | ||
570 | return copy_to_user(p, str, len) ? -EFAULT : len; | |
571 | } | |
572 | ||
6addb1d6 DT |
573 | static long evdev_do_ioctl(struct file *file, unsigned int cmd, |
574 | void __user *p, int compat_mode) | |
1da177e4 | 575 | { |
d0ffb9be DT |
576 | struct evdev_client *client = file->private_data; |
577 | struct evdev *evdev = client->evdev; | |
1da177e4 LT |
578 | struct input_dev *dev = evdev->handle.dev; |
579 | struct input_absinfo abs; | |
509ca1a9 | 580 | struct ff_effect effect; |
3a51f7c4 | 581 | int __user *ip = (int __user *)p; |
1da177e4 | 582 | int i, t, u, v; |
509ca1a9 | 583 | int error; |
1da177e4 | 584 | |
1da177e4 LT |
585 | switch (cmd) { |
586 | ||
6addb1d6 DT |
587 | case EVIOCGVERSION: |
588 | return put_user(EV_VERSION, ip); | |
1da177e4 | 589 | |
6addb1d6 DT |
590 | case EVIOCGID: |
591 | if (copy_to_user(p, &dev->id, sizeof(struct input_id))) | |
592 | return -EFAULT; | |
593 | return 0; | |
08791e5c | 594 | |
6addb1d6 DT |
595 | case EVIOCGREP: |
596 | if (!test_bit(EV_REP, dev->evbit)) | |
597 | return -ENOSYS; | |
598 | if (put_user(dev->rep[REP_DELAY], ip)) | |
599 | return -EFAULT; | |
600 | if (put_user(dev->rep[REP_PERIOD], ip + 1)) | |
601 | return -EFAULT; | |
602 | return 0; | |
08791e5c | 603 | |
6addb1d6 DT |
604 | case EVIOCSREP: |
605 | if (!test_bit(EV_REP, dev->evbit)) | |
606 | return -ENOSYS; | |
607 | if (get_user(u, ip)) | |
608 | return -EFAULT; | |
609 | if (get_user(v, ip + 1)) | |
610 | return -EFAULT; | |
08791e5c | 611 | |
6addb1d6 DT |
612 | input_inject_event(&evdev->handle, EV_REP, REP_DELAY, u); |
613 | input_inject_event(&evdev->handle, EV_REP, REP_PERIOD, v); | |
3a51f7c4 | 614 | |
6addb1d6 | 615 | return 0; |
1da177e4 | 616 | |
6addb1d6 DT |
617 | case EVIOCGKEYCODE: |
618 | if (get_user(t, ip)) | |
619 | return -EFAULT; | |
c8e4c772 | 620 | |
6addb1d6 DT |
621 | error = dev->getkeycode(dev, t, &v); |
622 | if (error) | |
623 | return error; | |
c8e4c772 | 624 | |
6addb1d6 DT |
625 | if (put_user(v, ip + 1)) |
626 | return -EFAULT; | |
c8e4c772 | 627 | |
6addb1d6 | 628 | return 0; |
1da177e4 | 629 | |
6addb1d6 DT |
630 | case EVIOCSKEYCODE: |
631 | if (get_user(t, ip) || get_user(v, ip + 1)) | |
632 | return -EFAULT; | |
3a51f7c4 | 633 | |
6addb1d6 | 634 | return dev->setkeycode(dev, t, v); |
1da177e4 | 635 | |
6addb1d6 DT |
636 | case EVIOCSFF: |
637 | if (copy_from_user(&effect, p, sizeof(effect))) | |
638 | return -EFAULT; | |
1da177e4 | 639 | |
6addb1d6 | 640 | error = input_ff_upload(dev, &effect, file); |
3a51f7c4 | 641 | |
6addb1d6 DT |
642 | if (put_user(effect.id, &(((struct ff_effect __user *)p)->id))) |
643 | return -EFAULT; | |
509ca1a9 | 644 | |
6addb1d6 | 645 | return error; |
509ca1a9 | 646 | |
6addb1d6 DT |
647 | case EVIOCRMFF: |
648 | return input_ff_erase(dev, (int)(unsigned long) p, file); | |
1da177e4 | 649 | |
6addb1d6 DT |
650 | case EVIOCGEFFECTS: |
651 | i = test_bit(EV_FF, dev->evbit) ? | |
652 | dev->ff->max_effects : 0; | |
653 | if (put_user(i, ip)) | |
654 | return -EFAULT; | |
655 | return 0; | |
656 | ||
657 | case EVIOCGRAB: | |
658 | if (p) | |
659 | return evdev_grab(evdev, client); | |
660 | else | |
661 | return evdev_ungrab(evdev, client); | |
1da177e4 | 662 | |
6addb1d6 | 663 | default: |
1da177e4 | 664 | |
6addb1d6 DT |
665 | if (_IOC_TYPE(cmd) != 'E') |
666 | return -EINVAL; | |
1da177e4 | 667 | |
6addb1d6 | 668 | if (_IOC_DIR(cmd) == _IOC_READ) { |
41e979f8 | 669 | |
6addb1d6 | 670 | if ((_IOC_NR(cmd) & ~EV_MAX) == _IOC_NR(EVIOCGBIT(0, 0))) { |
41e979f8 | 671 | |
6addb1d6 DT |
672 | unsigned long *bits; |
673 | int len; | |
41e979f8 | 674 | |
6addb1d6 | 675 | switch (_IOC_NR(cmd) & EV_MAX) { |
1da177e4 | 676 | |
6addb1d6 DT |
677 | case 0: bits = dev->evbit; len = EV_MAX; break; |
678 | case EV_KEY: bits = dev->keybit; len = KEY_MAX; break; | |
679 | case EV_REL: bits = dev->relbit; len = REL_MAX; break; | |
680 | case EV_ABS: bits = dev->absbit; len = ABS_MAX; break; | |
681 | case EV_MSC: bits = dev->mscbit; len = MSC_MAX; break; | |
682 | case EV_LED: bits = dev->ledbit; len = LED_MAX; break; | |
683 | case EV_SND: bits = dev->sndbit; len = SND_MAX; break; | |
684 | case EV_FF: bits = dev->ffbit; len = FF_MAX; break; | |
685 | case EV_SW: bits = dev->swbit; len = SW_MAX; break; | |
686 | default: return -EINVAL; | |
687 | } | |
688 | return bits_to_user(bits, len, _IOC_SIZE(cmd), p, compat_mode); | |
689 | } | |
1da177e4 | 690 | |
6addb1d6 DT |
691 | if (_IOC_NR(cmd) == _IOC_NR(EVIOCGKEY(0))) |
692 | return bits_to_user(dev->key, KEY_MAX, _IOC_SIZE(cmd), | |
693 | p, compat_mode); | |
1da177e4 | 694 | |
6addb1d6 DT |
695 | if (_IOC_NR(cmd) == _IOC_NR(EVIOCGLED(0))) |
696 | return bits_to_user(dev->led, LED_MAX, _IOC_SIZE(cmd), | |
697 | p, compat_mode); | |
1da177e4 | 698 | |
6addb1d6 DT |
699 | if (_IOC_NR(cmd) == _IOC_NR(EVIOCGSND(0))) |
700 | return bits_to_user(dev->snd, SND_MAX, _IOC_SIZE(cmd), | |
701 | p, compat_mode); | |
31581066 | 702 | |
6addb1d6 DT |
703 | if (_IOC_NR(cmd) == _IOC_NR(EVIOCGSW(0))) |
704 | return bits_to_user(dev->sw, SW_MAX, _IOC_SIZE(cmd), | |
705 | p, compat_mode); | |
1da177e4 | 706 | |
6addb1d6 DT |
707 | if (_IOC_NR(cmd) == _IOC_NR(EVIOCGNAME(0))) |
708 | return str_to_user(dev->name, _IOC_SIZE(cmd), p); | |
1da177e4 | 709 | |
6addb1d6 DT |
710 | if (_IOC_NR(cmd) == _IOC_NR(EVIOCGPHYS(0))) |
711 | return str_to_user(dev->phys, _IOC_SIZE(cmd), p); | |
1da177e4 | 712 | |
6addb1d6 DT |
713 | if (_IOC_NR(cmd) == _IOC_NR(EVIOCGUNIQ(0))) |
714 | return str_to_user(dev->uniq, _IOC_SIZE(cmd), p); | |
1da177e4 | 715 | |
6addb1d6 | 716 | if ((_IOC_NR(cmd) & ~ABS_MAX) == _IOC_NR(EVIOCGABS(0))) { |
1da177e4 | 717 | |
6addb1d6 | 718 | t = _IOC_NR(cmd) & ABS_MAX; |
1da177e4 | 719 | |
6addb1d6 DT |
720 | abs.value = dev->abs[t]; |
721 | abs.minimum = dev->absmin[t]; | |
722 | abs.maximum = dev->absmax[t]; | |
723 | abs.fuzz = dev->absfuzz[t]; | |
724 | abs.flat = dev->absflat[t]; | |
41e979f8 | 725 | |
6addb1d6 DT |
726 | if (copy_to_user(p, &abs, sizeof(struct input_absinfo))) |
727 | return -EFAULT; | |
1da177e4 | 728 | |
6addb1d6 | 729 | return 0; |
1da177e4 LT |
730 | } |
731 | ||
6addb1d6 DT |
732 | } |
733 | ||
734 | if (_IOC_DIR(cmd) == _IOC_WRITE) { | |
1da177e4 | 735 | |
6addb1d6 | 736 | if ((_IOC_NR(cmd) & ~ABS_MAX) == _IOC_NR(EVIOCSABS(0))) { |
1da177e4 | 737 | |
6addb1d6 | 738 | t = _IOC_NR(cmd) & ABS_MAX; |
41e979f8 | 739 | |
6addb1d6 DT |
740 | if (copy_from_user(&abs, p, |
741 | sizeof(struct input_absinfo))) | |
742 | return -EFAULT; | |
1da177e4 | 743 | |
6addb1d6 DT |
744 | /* |
745 | * Take event lock to ensure that we are not | |
746 | * changing device parameters in the middle | |
747 | * of event. | |
748 | */ | |
749 | spin_lock_irq(&dev->event_lock); | |
1da177e4 | 750 | |
6addb1d6 DT |
751 | dev->abs[t] = abs.value; |
752 | dev->absmin[t] = abs.minimum; | |
753 | dev->absmax[t] = abs.maximum; | |
754 | dev->absfuzz[t] = abs.fuzz; | |
755 | dev->absflat[t] = abs.flat; | |
756 | ||
757 | spin_unlock_irq(&dev->event_lock); | |
758 | ||
759 | return 0; | |
1da177e4 | 760 | } |
6addb1d6 | 761 | } |
1da177e4 LT |
762 | } |
763 | return -EINVAL; | |
764 | } | |
1da177e4 | 765 | |
6addb1d6 DT |
766 | static long evdev_ioctl_handler(struct file *file, unsigned int cmd, |
767 | void __user *p, int compat_mode) | |
768 | { | |
769 | struct evdev_client *client = file->private_data; | |
770 | struct evdev *evdev = client->evdev; | |
771 | int retval; | |
772 | ||
773 | retval = mutex_lock_interruptible(&evdev->mutex); | |
774 | if (retval) | |
775 | return retval; | |
776 | ||
777 | if (!evdev->exist) { | |
778 | retval = -ENODEV; | |
779 | goto out; | |
780 | } | |
781 | ||
782 | retval = evdev_do_ioctl(file, cmd, p, compat_mode); | |
783 | ||
784 | out: | |
785 | mutex_unlock(&evdev->mutex); | |
786 | return retval; | |
787 | } | |
788 | ||
3a51f7c4 DT |
789 | static long evdev_ioctl(struct file *file, unsigned int cmd, unsigned long arg) |
790 | { | |
791 | return evdev_ioctl_handler(file, cmd, (void __user *)arg, 0); | |
792 | } | |
41e979f8 | 793 | |
3a51f7c4 | 794 | #ifdef CONFIG_COMPAT |
6addb1d6 DT |
795 | static long evdev_ioctl_compat(struct file *file, |
796 | unsigned int cmd, unsigned long arg) | |
52658bb6 | 797 | { |
3a51f7c4 | 798 | return evdev_ioctl_handler(file, cmd, compat_ptr(arg), 1); |
1da177e4 | 799 | } |
52658bb6 | 800 | #endif |
1da177e4 | 801 | |
66e66118 | 802 | static const struct file_operations evdev_fops = { |
6addb1d6 DT |
803 | .owner = THIS_MODULE, |
804 | .read = evdev_read, | |
805 | .write = evdev_write, | |
806 | .poll = evdev_poll, | |
807 | .open = evdev_open, | |
808 | .release = evdev_release, | |
809 | .unlocked_ioctl = evdev_ioctl, | |
52658bb6 | 810 | #ifdef CONFIG_COMPAT |
6addb1d6 | 811 | .compat_ioctl = evdev_ioctl_compat, |
52658bb6 | 812 | #endif |
6addb1d6 DT |
813 | .fasync = evdev_fasync, |
814 | .flush = evdev_flush | |
1da177e4 LT |
815 | }; |
816 | ||
6addb1d6 DT |
817 | static int evdev_install_chrdev(struct evdev *evdev) |
818 | { | |
819 | /* | |
820 | * No need to do any locking here as calls to connect and | |
821 | * disconnect are serialized by the input core | |
822 | */ | |
823 | evdev_table[evdev->minor] = evdev; | |
824 | return 0; | |
825 | } | |
826 | ||
827 | static void evdev_remove_chrdev(struct evdev *evdev) | |
828 | { | |
829 | /* | |
830 | * Lock evdev table to prevent race with evdev_open() | |
831 | */ | |
832 | mutex_lock(&evdev_table_mutex); | |
833 | evdev_table[evdev->minor] = NULL; | |
834 | mutex_unlock(&evdev_table_mutex); | |
835 | } | |
836 | ||
837 | /* | |
838 | * Mark device non-existent. This disables writes, ioctls and | |
839 | * prevents new users from opening the device. Already posted | |
840 | * blocking reads will stay, however new ones will fail. | |
841 | */ | |
842 | static void evdev_mark_dead(struct evdev *evdev) | |
843 | { | |
844 | mutex_lock(&evdev->mutex); | |
845 | evdev->exist = 0; | |
846 | mutex_unlock(&evdev->mutex); | |
847 | } | |
848 | ||
849 | static void evdev_cleanup(struct evdev *evdev) | |
850 | { | |
851 | struct input_handle *handle = &evdev->handle; | |
852 | ||
853 | evdev_mark_dead(evdev); | |
854 | evdev_hangup(evdev); | |
855 | evdev_remove_chrdev(evdev); | |
856 | ||
857 | /* evdev is marked dead so no one else accesses evdev->open */ | |
858 | if (evdev->open) { | |
859 | input_flush_device(handle, NULL); | |
860 | input_close_device(handle); | |
861 | } | |
862 | } | |
863 | ||
864 | /* | |
865 | * Create new evdev device. Note that input core serializes calls | |
866 | * to connect and disconnect so we don't need to lock evdev_table here. | |
867 | */ | |
5b2a0826 DT |
868 | static int evdev_connect(struct input_handler *handler, struct input_dev *dev, |
869 | const struct input_device_id *id) | |
1da177e4 LT |
870 | { |
871 | struct evdev *evdev; | |
872 | int minor; | |
5b2a0826 | 873 | int error; |
1da177e4 | 874 | |
6addb1d6 DT |
875 | for (minor = 0; minor < EVDEV_MINORS; minor++) |
876 | if (!evdev_table[minor]) | |
877 | break; | |
878 | ||
1da177e4 LT |
879 | if (minor == EVDEV_MINORS) { |
880 | printk(KERN_ERR "evdev: no more free evdev devices\n"); | |
5b2a0826 | 881 | return -ENFILE; |
1da177e4 LT |
882 | } |
883 | ||
5b2a0826 DT |
884 | evdev = kzalloc(sizeof(struct evdev), GFP_KERNEL); |
885 | if (!evdev) | |
886 | return -ENOMEM; | |
1da177e4 | 887 | |
d0ffb9be | 888 | INIT_LIST_HEAD(&evdev->client_list); |
6addb1d6 DT |
889 | spin_lock_init(&evdev->client_lock); |
890 | mutex_init(&evdev->mutex); | |
1da177e4 LT |
891 | init_waitqueue_head(&evdev->wait); |
892 | ||
6addb1d6 | 893 | snprintf(evdev->name, sizeof(evdev->name), "event%d", minor); |
1da177e4 LT |
894 | evdev->exist = 1; |
895 | evdev->minor = minor; | |
6addb1d6 | 896 | |
1da177e4 LT |
897 | evdev->handle.dev = dev; |
898 | evdev->handle.name = evdev->name; | |
899 | evdev->handle.handler = handler; | |
900 | evdev->handle.private = evdev; | |
1da177e4 | 901 | |
6addb1d6 DT |
902 | strlcpy(evdev->dev.bus_id, evdev->name, sizeof(evdev->dev.bus_id)); |
903 | evdev->dev.devt = MKDEV(INPUT_MAJOR, EVDEV_MINOR_BASE + minor); | |
9657d75c DT |
904 | evdev->dev.class = &input_class; |
905 | evdev->dev.parent = &dev->dev; | |
9657d75c DT |
906 | evdev->dev.release = evdev_free; |
907 | device_initialize(&evdev->dev); | |
5b2a0826 | 908 | |
6addb1d6 | 909 | error = input_register_handle(&evdev->handle); |
5b2a0826 | 910 | if (error) |
9657d75c | 911 | goto err_free_evdev; |
5b2a0826 | 912 | |
6addb1d6 DT |
913 | error = evdev_install_chrdev(evdev); |
914 | if (error) | |
915 | goto err_unregister_handle; | |
916 | ||
917 | error = device_add(&evdev->dev); | |
5b2a0826 | 918 | if (error) |
6addb1d6 | 919 | goto err_cleanup_evdev; |
1da177e4 | 920 | |
5b2a0826 | 921 | return 0; |
1da177e4 | 922 | |
6addb1d6 DT |
923 | err_cleanup_evdev: |
924 | evdev_cleanup(evdev); | |
925 | err_unregister_handle: | |
926 | input_unregister_handle(&evdev->handle); | |
5b2a0826 | 927 | err_free_evdev: |
9657d75c | 928 | put_device(&evdev->dev); |
5b2a0826 | 929 | return error; |
1da177e4 LT |
930 | } |
931 | ||
932 | static void evdev_disconnect(struct input_handle *handle) | |
933 | { | |
934 | struct evdev *evdev = handle->private; | |
1da177e4 | 935 | |
9657d75c | 936 | device_del(&evdev->dev); |
6addb1d6 DT |
937 | evdev_cleanup(evdev); |
938 | input_unregister_handle(handle); | |
9657d75c | 939 | put_device(&evdev->dev); |
1da177e4 LT |
940 | } |
941 | ||
66e66118 | 942 | static const struct input_device_id evdev_ids[] = { |
1da177e4 LT |
943 | { .driver_info = 1 }, /* Matches all devices */ |
944 | { }, /* Terminating zero entry */ | |
945 | }; | |
946 | ||
947 | MODULE_DEVICE_TABLE(input, evdev_ids); | |
948 | ||
949 | static struct input_handler evdev_handler = { | |
6addb1d6 DT |
950 | .event = evdev_event, |
951 | .connect = evdev_connect, | |
952 | .disconnect = evdev_disconnect, | |
953 | .fops = &evdev_fops, | |
954 | .minor = EVDEV_MINOR_BASE, | |
955 | .name = "evdev", | |
956 | .id_table = evdev_ids, | |
1da177e4 LT |
957 | }; |
958 | ||
959 | static int __init evdev_init(void) | |
960 | { | |
4263cf0f | 961 | return input_register_handler(&evdev_handler); |
1da177e4 LT |
962 | } |
963 | ||
964 | static void __exit evdev_exit(void) | |
965 | { | |
966 | input_unregister_handler(&evdev_handler); | |
967 | } | |
968 | ||
969 | module_init(evdev_init); | |
970 | module_exit(evdev_exit); | |
971 | ||
972 | MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>"); | |
973 | MODULE_DESCRIPTION("Input driver event char devices"); | |
974 | MODULE_LICENSE("GPL"); |