blob: cd02f1b62b665fa5915e332ddc3b6a09fa00223e [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * Input driver to ExplorerPS/2 device driver module.
3 *
4 * Copyright (c) 1999-2002 Vojtech Pavlik
5 * Copyright (c) 2004 Dmitry Torokhov
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as published by
9 * the Free Software Foundation.
10 */
11
Dmitry Torokhov4f004692005-09-15 02:01:38 -050012#define MOUSEDEV_MINOR_BASE 32
Linus Torvalds1da177e2005-04-16 15:20:36 -070013#define MOUSEDEV_MINORS 32
14#define MOUSEDEV_MIX 31
15
16#include <linux/slab.h>
17#include <linux/poll.h>
18#include <linux/module.h>
19#include <linux/moduleparam.h>
20#include <linux/init.h>
21#include <linux/input.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070022#include <linux/smp_lock.h>
23#include <linux/random.h>
24#include <linux/major.h>
25#include <linux/device.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070026#ifdef CONFIG_INPUT_MOUSEDEV_PSAUX
27#include <linux/miscdevice.h>
28#endif
29
30MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
31MODULE_DESCRIPTION("Mouse (ExplorerPS/2) device interfaces");
32MODULE_LICENSE("GPL");
33
34#ifndef CONFIG_INPUT_MOUSEDEV_SCREEN_X
35#define CONFIG_INPUT_MOUSEDEV_SCREEN_X 1024
36#endif
37#ifndef CONFIG_INPUT_MOUSEDEV_SCREEN_Y
38#define CONFIG_INPUT_MOUSEDEV_SCREEN_Y 768
39#endif
40
41static int xres = CONFIG_INPUT_MOUSEDEV_SCREEN_X;
Dmitry Torokhov84c12b22005-12-11 12:41:03 -050042module_param(xres, uint, 0644);
Linus Torvalds1da177e2005-04-16 15:20:36 -070043MODULE_PARM_DESC(xres, "Horizontal screen resolution");
44
45static int yres = CONFIG_INPUT_MOUSEDEV_SCREEN_Y;
Dmitry Torokhov84c12b22005-12-11 12:41:03 -050046module_param(yres, uint, 0644);
Linus Torvalds1da177e2005-04-16 15:20:36 -070047MODULE_PARM_DESC(yres, "Vertical screen resolution");
48
49static unsigned tap_time = 200;
Dmitry Torokhov84c12b22005-12-11 12:41:03 -050050module_param(tap_time, uint, 0644);
Linus Torvalds1da177e2005-04-16 15:20:36 -070051MODULE_PARM_DESC(tap_time, "Tap time for touchpads in absolute mode (msecs)");
52
53struct mousedev_hw_data {
54 int dx, dy, dz;
55 int x, y;
56 int abs_event;
57 unsigned long buttons;
58};
59
60struct mousedev {
61 int exist;
62 int open;
63 int minor;
64 char name[16];
65 wait_queue_head_t wait;
66 struct list_head list;
67 struct input_handle handle;
68
69 struct mousedev_hw_data packet;
70 unsigned int pkt_count;
71 int old_x[4], old_y[4];
72 int frac_dx, frac_dy;
73 unsigned long touch;
74};
75
76enum mousedev_emul {
77 MOUSEDEV_EMUL_PS2,
78 MOUSEDEV_EMUL_IMPS,
79 MOUSEDEV_EMUL_EXPS
80};
81
82struct mousedev_motion {
83 int dx, dy, dz;
84 unsigned long buttons;
85};
86
87#define PACKET_QUEUE_LEN 16
88struct mousedev_list {
89 struct fasync_struct *fasync;
90 struct mousedev *mousedev;
91 struct list_head node;
92
93 struct mousedev_motion packets[PACKET_QUEUE_LEN];
94 unsigned int head, tail;
95 spinlock_t packet_lock;
96 int pos_x, pos_y;
97
98 signed char ps2[6];
99 unsigned char ready, buffer, bufsiz;
100 unsigned char imexseq, impsseq;
101 enum mousedev_emul mode;
Pavel Machekc1e4c8d2005-05-27 12:53:03 -0700102 unsigned long last_buttons;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700103};
104
105#define MOUSEDEV_SEQ_LEN 6
106
107static unsigned char mousedev_imps_seq[] = { 0xf3, 200, 0xf3, 100, 0xf3, 80 };
108static unsigned char mousedev_imex_seq[] = { 0xf3, 200, 0xf3, 200, 0xf3, 80 };
109
110static struct input_handler mousedev_handler;
111
112static struct mousedev *mousedev_table[MOUSEDEV_MINORS];
113static struct mousedev mousedev_mix;
114
115#define fx(i) (mousedev->old_x[(mousedev->pkt_count - (i)) & 03])
116#define fy(i) (mousedev->old_y[(mousedev->pkt_count - (i)) & 03])
117
118static void mousedev_touchpad_event(struct input_dev *dev, struct mousedev *mousedev, unsigned int code, int value)
119{
120 int size, tmp;
121 enum { FRACTION_DENOM = 128 };
122
123 if (mousedev->touch) {
124 size = dev->absmax[ABS_X] - dev->absmin[ABS_X];
Dmitry Torokhov1e0afb22006-06-26 01:48:47 -0400125 if (size == 0)
126 size = 256 * 2;
127
Linus Torvalds1da177e2005-04-16 15:20:36 -0700128 switch (code) {
129 case ABS_X:
130 fx(0) = value;
131 if (mousedev->pkt_count >= 2) {
132 tmp = ((value - fx(2)) * (256 * FRACTION_DENOM)) / size;
133 tmp += mousedev->frac_dx;
134 mousedev->packet.dx = tmp / FRACTION_DENOM;
135 mousedev->frac_dx = tmp - mousedev->packet.dx * FRACTION_DENOM;
136 }
137 break;
138
139 case ABS_Y:
140 fy(0) = value;
141 if (mousedev->pkt_count >= 2) {
142 tmp = -((value - fy(2)) * (256 * FRACTION_DENOM)) / size;
143 tmp += mousedev->frac_dy;
144 mousedev->packet.dy = tmp / FRACTION_DENOM;
145 mousedev->frac_dy = tmp - mousedev->packet.dy * FRACTION_DENOM;
146 }
147 break;
148 }
149 }
150}
151
152static void mousedev_abs_event(struct input_dev *dev, struct mousedev *mousedev, unsigned int code, int value)
153{
154 int size;
155
156 switch (code) {
157 case ABS_X:
158 size = dev->absmax[ABS_X] - dev->absmin[ABS_X];
Dmitry Torokhov1e0afb22006-06-26 01:48:47 -0400159 if (size == 0)
160 size = xres ? : 1;
161 if (value > dev->absmax[ABS_X])
162 value = dev->absmax[ABS_X];
163 if (value < dev->absmin[ABS_X])
164 value = dev->absmin[ABS_X];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700165 mousedev->packet.x = ((value - dev->absmin[ABS_X]) * xres) / size;
166 mousedev->packet.abs_event = 1;
167 break;
168
169 case ABS_Y:
170 size = dev->absmax[ABS_Y] - dev->absmin[ABS_Y];
Dmitry Torokhov1e0afb22006-06-26 01:48:47 -0400171 if (size == 0)
172 size = yres ? : 1;
173 if (value > dev->absmax[ABS_Y])
174 value = dev->absmax[ABS_Y];
175 if (value < dev->absmin[ABS_Y])
176 value = dev->absmin[ABS_Y];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700177 mousedev->packet.y = yres - ((value - dev->absmin[ABS_Y]) * yres) / size;
178 mousedev->packet.abs_event = 1;
179 break;
180 }
181}
182
183static void mousedev_rel_event(struct mousedev *mousedev, unsigned int code, int value)
184{
185 switch (code) {
186 case REL_X: mousedev->packet.dx += value; break;
187 case REL_Y: mousedev->packet.dy -= value; break;
188 case REL_WHEEL: mousedev->packet.dz -= value; break;
189 }
190}
191
192static void mousedev_key_event(struct mousedev *mousedev, unsigned int code, int value)
193{
194 int index;
195
196 switch (code) {
197 case BTN_TOUCH:
198 case BTN_0:
199 case BTN_FORWARD:
200 case BTN_LEFT: index = 0; break;
201 case BTN_STYLUS:
202 case BTN_1:
203 case BTN_RIGHT: index = 1; break;
204 case BTN_2:
205 case BTN_STYLUS2:
206 case BTN_MIDDLE: index = 2; break;
207 case BTN_3:
208 case BTN_BACK:
209 case BTN_SIDE: index = 3; break;
210 case BTN_4:
211 case BTN_EXTRA: index = 4; break;
Dmitry Torokhov1e0afb22006-06-26 01:48:47 -0400212 default: return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700213 }
214
215 if (value) {
216 set_bit(index, &mousedev->packet.buttons);
217 set_bit(index, &mousedev_mix.packet.buttons);
218 } else {
219 clear_bit(index, &mousedev->packet.buttons);
220 clear_bit(index, &mousedev_mix.packet.buttons);
221 }
222}
223
224static void mousedev_notify_readers(struct mousedev *mousedev, struct mousedev_hw_data *packet)
225{
226 struct mousedev_list *list;
227 struct mousedev_motion *p;
228 unsigned long flags;
Dmitry Torokhov81211522005-06-01 02:39:36 -0500229 int wake_readers = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700230
231 list_for_each_entry(list, &mousedev->list, node) {
232 spin_lock_irqsave(&list->packet_lock, flags);
233
234 p = &list->packets[list->head];
Pavel Machekc1e4c8d2005-05-27 12:53:03 -0700235 if (list->ready && p->buttons != mousedev->packet.buttons) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700236 unsigned int new_head = (list->head + 1) % PACKET_QUEUE_LEN;
237 if (new_head != list->tail) {
238 p = &list->packets[list->head = new_head];
239 memset(p, 0, sizeof(struct mousedev_motion));
240 }
241 }
242
243 if (packet->abs_event) {
244 p->dx += packet->x - list->pos_x;
245 p->dy += packet->y - list->pos_y;
246 list->pos_x = packet->x;
247 list->pos_y = packet->y;
248 }
249
250 list->pos_x += packet->dx;
251 list->pos_x = list->pos_x < 0 ? 0 : (list->pos_x >= xres ? xres : list->pos_x);
252 list->pos_y += packet->dy;
253 list->pos_y = list->pos_y < 0 ? 0 : (list->pos_y >= yres ? yres : list->pos_y);
254
255 p->dx += packet->dx;
256 p->dy += packet->dy;
257 p->dz += packet->dz;
258 p->buttons = mousedev->packet.buttons;
259
Pavel Machekc1e4c8d2005-05-27 12:53:03 -0700260 if (p->dx || p->dy || p->dz || p->buttons != list->last_buttons)
261 list->ready = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700262
263 spin_unlock_irqrestore(&list->packet_lock, flags);
Pavel Machekc1e4c8d2005-05-27 12:53:03 -0700264
Dmitry Torokhov81211522005-06-01 02:39:36 -0500265 if (list->ready) {
Pavel Machekc1e4c8d2005-05-27 12:53:03 -0700266 kill_fasync(&list->fasync, SIGIO, POLL_IN);
Dmitry Torokhov81211522005-06-01 02:39:36 -0500267 wake_readers = 1;
268 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700269 }
270
Dmitry Torokhov81211522005-06-01 02:39:36 -0500271 if (wake_readers)
272 wake_up_interruptible(&mousedev->wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700273}
274
275static void mousedev_touchpad_touch(struct mousedev *mousedev, int value)
276{
277 if (!value) {
278 if (mousedev->touch &&
279 time_before(jiffies, mousedev->touch + msecs_to_jiffies(tap_time))) {
280 /*
281 * Toggle left button to emulate tap.
282 * We rely on the fact that mousedev_mix always has 0
283 * motion packet so we won't mess current position.
284 */
285 set_bit(0, &mousedev->packet.buttons);
286 set_bit(0, &mousedev_mix.packet.buttons);
287 mousedev_notify_readers(mousedev, &mousedev_mix.packet);
288 mousedev_notify_readers(&mousedev_mix, &mousedev_mix.packet);
289 clear_bit(0, &mousedev->packet.buttons);
290 clear_bit(0, &mousedev_mix.packet.buttons);
291 }
292 mousedev->touch = mousedev->pkt_count = 0;
293 mousedev->frac_dx = 0;
294 mousedev->frac_dy = 0;
Dmitry Torokhov1e0afb22006-06-26 01:48:47 -0400295
296 } else if (!mousedev->touch)
297 mousedev->touch = jiffies;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298}
299
300static void mousedev_event(struct input_handle *handle, unsigned int type, unsigned int code, int value)
301{
302 struct mousedev *mousedev = handle->private;
303
304 switch (type) {
305 case EV_ABS:
306 /* Ignore joysticks */
307 if (test_bit(BTN_TRIGGER, handle->dev->keybit))
308 return;
309
310 if (test_bit(BTN_TOOL_FINGER, handle->dev->keybit))
311 mousedev_touchpad_event(handle->dev, mousedev, code, value);
312 else
313 mousedev_abs_event(handle->dev, mousedev, code, value);
314
315 break;
316
317 case EV_REL:
318 mousedev_rel_event(mousedev, code, value);
319 break;
320
321 case EV_KEY:
322 if (value != 2) {
323 if (code == BTN_TOUCH && test_bit(BTN_TOOL_FINGER, handle->dev->keybit))
324 mousedev_touchpad_touch(mousedev, value);
325 else
326 mousedev_key_event(mousedev, code, value);
327 }
328 break;
329
330 case EV_SYN:
331 if (code == SYN_REPORT) {
332 if (mousedev->touch) {
333 mousedev->pkt_count++;
334 /* Input system eats duplicate events, but we need all of them
335 * to do correct averaging so apply present one forward
Dmitry Torokhov1e0afb22006-06-26 01:48:47 -0400336 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700337 fx(0) = fx(1);
338 fy(0) = fy(1);
339 }
340
341 mousedev_notify_readers(mousedev, &mousedev->packet);
342 mousedev_notify_readers(&mousedev_mix, &mousedev->packet);
343
344 mousedev->packet.dx = mousedev->packet.dy = mousedev->packet.dz = 0;
345 mousedev->packet.abs_event = 0;
346 }
347 break;
348 }
349}
350
351static int mousedev_fasync(int fd, struct file *file, int on)
352{
353 int retval;
354 struct mousedev_list *list = file->private_data;
Dmitry Torokhov1e0afb22006-06-26 01:48:47 -0400355
Linus Torvalds1da177e2005-04-16 15:20:36 -0700356 retval = fasync_helper(fd, file, on, &list->fasync);
Dmitry Torokhov1e0afb22006-06-26 01:48:47 -0400357
Linus Torvalds1da177e2005-04-16 15:20:36 -0700358 return retval < 0 ? retval : 0;
359}
360
361static void mousedev_free(struct mousedev *mousedev)
362{
363 mousedev_table[mousedev->minor] = NULL;
364 kfree(mousedev);
365}
366
Kimball Murray74570d42006-01-29 21:50:59 -0500367static void mixdev_release(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700368{
369 struct input_handle *handle;
370
371 list_for_each_entry(handle, &mousedev_handler.h_list, h_node) {
372 struct mousedev *mousedev = handle->private;
373
374 if (!mousedev->open) {
375 if (mousedev->exist)
376 input_close_device(&mousedev->handle);
377 else
378 mousedev_free(mousedev);
379 }
380 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700381}
382
383static int mousedev_release(struct inode * inode, struct file * file)
384{
385 struct mousedev_list *list = file->private_data;
386
387 mousedev_fasync(-1, file, 0);
388
389 list_del(&list->node);
390
391 if (!--list->mousedev->open) {
392 if (list->mousedev->minor == MOUSEDEV_MIX)
Kimball Murray74570d42006-01-29 21:50:59 -0500393 mixdev_release();
394 else if (!mousedev_mix.open) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700395 if (list->mousedev->exist)
396 input_close_device(&list->mousedev->handle);
397 else
398 mousedev_free(list->mousedev);
399 }
400 }
401
402 kfree(list);
403 return 0;
404}
405
406static int mousedev_open(struct inode * inode, struct file * file)
407{
408 struct mousedev_list *list;
409 struct input_handle *handle;
410 struct mousedev *mousedev;
411 int i;
412
413#ifdef CONFIG_INPUT_MOUSEDEV_PSAUX
414 if (imajor(inode) == MISC_MAJOR)
415 i = MOUSEDEV_MIX;
416 else
417#endif
418 i = iminor(inode) - MOUSEDEV_MINOR_BASE;
419
420 if (i >= MOUSEDEV_MINORS || !mousedev_table[i])
421 return -ENODEV;
422
Eric Sesterhennb39787a2006-03-14 00:09:16 -0500423 if (!(list = kzalloc(sizeof(struct mousedev_list), GFP_KERNEL)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700424 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700425
426 spin_lock_init(&list->packet_lock);
427 list->pos_x = xres / 2;
428 list->pos_y = yres / 2;
429 list->mousedev = mousedev_table[i];
430 list_add_tail(&list->node, &mousedev_table[i]->list);
431 file->private_data = list;
432
433 if (!list->mousedev->open++) {
434 if (list->mousedev->minor == MOUSEDEV_MIX) {
435 list_for_each_entry(handle, &mousedev_handler.h_list, h_node) {
436 mousedev = handle->private;
437 if (!mousedev->open && mousedev->exist)
438 input_open_device(handle);
439 }
440 } else
441 if (!mousedev_mix.open && list->mousedev->exist)
442 input_open_device(&list->mousedev->handle);
443 }
444
445 return 0;
446}
447
448static inline int mousedev_limit_delta(int delta, int limit)
449{
450 return delta > limit ? limit : (delta < -limit ? -limit : delta);
451}
452
453static void mousedev_packet(struct mousedev_list *list, signed char *ps2_data)
454{
455 struct mousedev_motion *p;
456 unsigned long flags;
457
458 spin_lock_irqsave(&list->packet_lock, flags);
459 p = &list->packets[list->tail];
460
461 ps2_data[0] = 0x08 | ((p->dx < 0) << 4) | ((p->dy < 0) << 5) | (p->buttons & 0x07);
462 ps2_data[1] = mousedev_limit_delta(p->dx, 127);
463 ps2_data[2] = mousedev_limit_delta(p->dy, 127);
464 p->dx -= ps2_data[1];
465 p->dy -= ps2_data[2];
466
467 switch (list->mode) {
468 case MOUSEDEV_EMUL_EXPS:
469 ps2_data[3] = mousedev_limit_delta(p->dz, 7);
470 p->dz -= ps2_data[3];
471 ps2_data[3] = (ps2_data[3] & 0x0f) | ((p->buttons & 0x18) << 1);
472 list->bufsiz = 4;
473 break;
474
475 case MOUSEDEV_EMUL_IMPS:
476 ps2_data[0] |= ((p->buttons & 0x10) >> 3) | ((p->buttons & 0x08) >> 1);
477 ps2_data[3] = mousedev_limit_delta(p->dz, 127);
478 p->dz -= ps2_data[3];
479 list->bufsiz = 4;
480 break;
481
482 case MOUSEDEV_EMUL_PS2:
483 default:
484 ps2_data[0] |= ((p->buttons & 0x10) >> 3) | ((p->buttons & 0x08) >> 1);
485 p->dz = 0;
486 list->bufsiz = 3;
487 break;
488 }
489
490 if (!p->dx && !p->dy && !p->dz) {
Pavel Machekc1e4c8d2005-05-27 12:53:03 -0700491 if (list->tail == list->head) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700492 list->ready = 0;
Pavel Machekc1e4c8d2005-05-27 12:53:03 -0700493 list->last_buttons = p->buttons;
494 } else
Linus Torvalds1da177e2005-04-16 15:20:36 -0700495 list->tail = (list->tail + 1) % PACKET_QUEUE_LEN;
496 }
497
498 spin_unlock_irqrestore(&list->packet_lock, flags);
499}
500
501
502static ssize_t mousedev_write(struct file * file, const char __user * buffer, size_t count, loff_t *ppos)
503{
504 struct mousedev_list *list = file->private_data;
505 unsigned char c;
506 unsigned int i;
507
508 for (i = 0; i < count; i++) {
509
510 if (get_user(c, buffer + i))
511 return -EFAULT;
512
513 if (c == mousedev_imex_seq[list->imexseq]) {
514 if (++list->imexseq == MOUSEDEV_SEQ_LEN) {
515 list->imexseq = 0;
516 list->mode = MOUSEDEV_EMUL_EXPS;
517 }
Dmitry Torokhov1e0afb22006-06-26 01:48:47 -0400518 } else
519 list->imexseq = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700520
521 if (c == mousedev_imps_seq[list->impsseq]) {
522 if (++list->impsseq == MOUSEDEV_SEQ_LEN) {
523 list->impsseq = 0;
524 list->mode = MOUSEDEV_EMUL_IMPS;
525 }
Dmitry Torokhov1e0afb22006-06-26 01:48:47 -0400526 } else
527 list->impsseq = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700528
529 list->ps2[0] = 0xfa;
530
531 switch (c) {
532
533 case 0xeb: /* Poll */
534 mousedev_packet(list, &list->ps2[1]);
535 list->bufsiz++; /* account for leading ACK */
536 break;
537
538 case 0xf2: /* Get ID */
539 switch (list->mode) {
540 case MOUSEDEV_EMUL_PS2: list->ps2[1] = 0; break;
541 case MOUSEDEV_EMUL_IMPS: list->ps2[1] = 3; break;
542 case MOUSEDEV_EMUL_EXPS: list->ps2[1] = 4; break;
543 }
544 list->bufsiz = 2;
545 break;
546
547 case 0xe9: /* Get info */
548 list->ps2[1] = 0x60; list->ps2[2] = 3; list->ps2[3] = 200;
549 list->bufsiz = 4;
550 break;
551
552 case 0xff: /* Reset */
553 list->impsseq = list->imexseq = 0;
554 list->mode = MOUSEDEV_EMUL_PS2;
555 list->ps2[1] = 0xaa; list->ps2[2] = 0x00;
556 list->bufsiz = 3;
557 break;
558
559 default:
560 list->bufsiz = 1;
561 break;
562 }
563
564 list->buffer = list->bufsiz;
565 }
566
567 kill_fasync(&list->fasync, SIGIO, POLL_IN);
568
569 wake_up_interruptible(&list->mousedev->wait);
570
571 return count;
572}
573
574static ssize_t mousedev_read(struct file * file, char __user * buffer, size_t count, loff_t *ppos)
575{
576 struct mousedev_list *list = file->private_data;
577 int retval = 0;
578
579 if (!list->ready && !list->buffer && (file->f_flags & O_NONBLOCK))
580 return -EAGAIN;
581
582 retval = wait_event_interruptible(list->mousedev->wait,
583 !list->mousedev->exist || list->ready || list->buffer);
584
585 if (retval)
586 return retval;
587
588 if (!list->mousedev->exist)
589 return -ENODEV;
590
591 if (!list->buffer && list->ready) {
592 mousedev_packet(list, list->ps2);
593 list->buffer = list->bufsiz;
594 }
595
596 if (count > list->buffer)
597 count = list->buffer;
598
599 list->buffer -= count;
600
601 if (copy_to_user(buffer, list->ps2 + list->bufsiz - list->buffer - count, count))
602 return -EFAULT;
603
604 return count;
605}
606
607/* No kernel lock - fine */
608static unsigned int mousedev_poll(struct file *file, poll_table *wait)
609{
610 struct mousedev_list *list = file->private_data;
Dmitry Torokhov1e0afb22006-06-26 01:48:47 -0400611
Linus Torvalds1da177e2005-04-16 15:20:36 -0700612 poll_wait(file, &list->mousedev->wait, wait);
613 return ((list->ready || list->buffer) ? (POLLIN | POLLRDNORM) : 0) |
614 (list->mousedev->exist ? 0 : (POLLHUP | POLLERR));
615}
616
Dmitry Torokhov66e66112006-09-14 01:31:59 -0400617static const struct file_operations mousedev_fops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700618 .owner = THIS_MODULE,
619 .read = mousedev_read,
620 .write = mousedev_write,
621 .poll = mousedev_poll,
622 .open = mousedev_open,
623 .release = mousedev_release,
624 .fasync = mousedev_fasync,
625};
626
Dmitry Torokhov66e66112006-09-14 01:31:59 -0400627static struct input_handle *mousedev_connect(struct input_handler *handler, struct input_dev *dev,
628 const struct input_device_id *id)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700629{
630 struct mousedev *mousedev;
Greg Kroah-Hartmanc9bcd582005-10-27 22:25:43 -0700631 struct class_device *cdev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700632 int minor = 0;
633
634 for (minor = 0; minor < MOUSEDEV_MINORS && mousedev_table[minor]; minor++);
635 if (minor == MOUSEDEV_MINORS) {
636 printk(KERN_ERR "mousedev: no more free mousedev devices\n");
637 return NULL;
638 }
639
Eric Sesterhennb39787a2006-03-14 00:09:16 -0500640 if (!(mousedev = kzalloc(sizeof(struct mousedev), GFP_KERNEL)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700641 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700642
643 INIT_LIST_HEAD(&mousedev->list);
644 init_waitqueue_head(&mousedev->wait);
645
646 mousedev->minor = minor;
647 mousedev->exist = 1;
648 mousedev->handle.dev = dev;
649 mousedev->handle.name = mousedev->name;
650 mousedev->handle.handler = handler;
651 mousedev->handle.private = mousedev;
652 sprintf(mousedev->name, "mouse%d", minor);
653
654 if (mousedev_mix.open)
655 input_open_device(&mousedev->handle);
656
657 mousedev_table[minor] = mousedev;
658
Greg Kroah-Hartmanc9bcd582005-10-27 22:25:43 -0700659 cdev = class_device_create(&input_class, &dev->cdev,
gregkh@suse.de12356862005-03-15 14:26:30 -0800660 MKDEV(INPUT_MAJOR, MOUSEDEV_MINOR_BASE + minor),
Greg Kroah-Hartmanc9bcd582005-10-27 22:25:43 -0700661 dev->cdev.dev, mousedev->name);
662
663 /* temporary symlink to keep userspace happy */
664 sysfs_create_link(&input_class.subsys.kset.kobj, &cdev->kobj,
665 mousedev->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700666
667 return &mousedev->handle;
668}
669
670static void mousedev_disconnect(struct input_handle *handle)
671{
672 struct mousedev *mousedev = handle->private;
673 struct mousedev_list *list;
674
Greg Kroah-Hartmanc9bcd582005-10-27 22:25:43 -0700675 sysfs_remove_link(&input_class.subsys.kset.kobj, mousedev->name);
Greg Kroah-Hartmanea9f2402005-10-27 22:25:43 -0700676 class_device_destroy(&input_class,
gregkh@suse.de12356862005-03-15 14:26:30 -0800677 MKDEV(INPUT_MAJOR, MOUSEDEV_MINOR_BASE + mousedev->minor));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700678 mousedev->exist = 0;
679
680 if (mousedev->open) {
681 input_close_device(handle);
682 wake_up_interruptible(&mousedev->wait);
683 list_for_each_entry(list, &mousedev->list, node)
684 kill_fasync(&list->fasync, SIGIO, POLL_HUP);
685 } else {
686 if (mousedev_mix.open)
687 input_close_device(handle);
688 mousedev_free(mousedev);
689 }
690}
691
Dmitry Torokhov66e66112006-09-14 01:31:59 -0400692static const struct input_device_id mousedev_ids[] = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700693 {
694 .flags = INPUT_DEVICE_ID_MATCH_EVBIT | INPUT_DEVICE_ID_MATCH_KEYBIT | INPUT_DEVICE_ID_MATCH_RELBIT,
695 .evbit = { BIT(EV_KEY) | BIT(EV_REL) },
696 .keybit = { [LONG(BTN_LEFT)] = BIT(BTN_LEFT) },
697 .relbit = { BIT(REL_X) | BIT(REL_Y) },
698 }, /* A mouse like device, at least one button, two relative axes */
699 {
700 .flags = INPUT_DEVICE_ID_MATCH_EVBIT | INPUT_DEVICE_ID_MATCH_RELBIT,
701 .evbit = { BIT(EV_KEY) | BIT(EV_REL) },
702 .relbit = { BIT(REL_WHEEL) },
703 }, /* A separate scrollwheel */
704 {
705 .flags = INPUT_DEVICE_ID_MATCH_EVBIT | INPUT_DEVICE_ID_MATCH_KEYBIT | INPUT_DEVICE_ID_MATCH_ABSBIT,
706 .evbit = { BIT(EV_KEY) | BIT(EV_ABS) },
707 .keybit = { [LONG(BTN_TOUCH)] = BIT(BTN_TOUCH) },
708 .absbit = { BIT(ABS_X) | BIT(ABS_Y) },
709 }, /* A tablet like device, at least touch detection, two absolute axes */
710 {
711 .flags = INPUT_DEVICE_ID_MATCH_EVBIT | INPUT_DEVICE_ID_MATCH_KEYBIT | INPUT_DEVICE_ID_MATCH_ABSBIT,
712 .evbit = { BIT(EV_KEY) | BIT(EV_ABS) },
713 .keybit = { [LONG(BTN_TOOL_FINGER)] = BIT(BTN_TOOL_FINGER) },
714 .absbit = { BIT(ABS_X) | BIT(ABS_Y) | BIT(ABS_PRESSURE) | BIT(ABS_TOOL_WIDTH) },
715 }, /* A touchpad */
716
717 { }, /* Terminating entry */
718};
719
720MODULE_DEVICE_TABLE(input, mousedev_ids);
721
722static struct input_handler mousedev_handler = {
723 .event = mousedev_event,
724 .connect = mousedev_connect,
725 .disconnect = mousedev_disconnect,
726 .fops = &mousedev_fops,
727 .minor = MOUSEDEV_MINOR_BASE,
728 .name = "mousedev",
729 .id_table = mousedev_ids,
730};
731
732#ifdef CONFIG_INPUT_MOUSEDEV_PSAUX
733static struct miscdevice psaux_mouse = {
734 PSMOUSE_MINOR, "psaux", &mousedev_fops
735};
736static int psaux_registered;
737#endif
738
739static int __init mousedev_init(void)
740{
741 input_register_handler(&mousedev_handler);
742
743 memset(&mousedev_mix, 0, sizeof(struct mousedev));
744 INIT_LIST_HEAD(&mousedev_mix.list);
745 init_waitqueue_head(&mousedev_mix.wait);
746 mousedev_table[MOUSEDEV_MIX] = &mousedev_mix;
747 mousedev_mix.exist = 1;
748 mousedev_mix.minor = MOUSEDEV_MIX;
749
Greg Kroah-Hartmanea9f2402005-10-27 22:25:43 -0700750 class_device_create(&input_class, NULL,
gregkh@suse.de12356862005-03-15 14:26:30 -0800751 MKDEV(INPUT_MAJOR, MOUSEDEV_MINOR_BASE + MOUSEDEV_MIX), NULL, "mice");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700752
753#ifdef CONFIG_INPUT_MOUSEDEV_PSAUX
754 if (!(psaux_registered = !misc_register(&psaux_mouse)))
755 printk(KERN_WARNING "mice: could not misc_register the device\n");
756#endif
757
758 printk(KERN_INFO "mice: PS/2 mouse device common for all mice\n");
759
760 return 0;
761}
762
763static void __exit mousedev_exit(void)
764{
765#ifdef CONFIG_INPUT_MOUSEDEV_PSAUX
766 if (psaux_registered)
767 misc_deregister(&psaux_mouse);
768#endif
Greg Kroah-Hartmanea9f2402005-10-27 22:25:43 -0700769 class_device_destroy(&input_class,
gregkh@suse.de12356862005-03-15 14:26:30 -0800770 MKDEV(INPUT_MAJOR, MOUSEDEV_MINOR_BASE + MOUSEDEV_MIX));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700771 input_unregister_handler(&mousedev_handler);
772}
773
774module_init(mousedev_init);
775module_exit(mousedev_exit);