This source file includes following definitions.
- vsxxxaa_drop_bytes
- vsxxxaa_queue_byte
- vsxxxaa_detection_done
- vsxxxaa_check_packet
- vsxxxaa_smells_like_packet
- vsxxxaa_handle_REL_packet
- vsxxxaa_handle_ABS_packet
- vsxxxaa_handle_POR_packet
- vsxxxaa_parse_buffer
- vsxxxaa_interrupt
- vsxxxaa_disconnect
- vsxxxaa_connect
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67 #include <linux/delay.h>
68 #include <linux/module.h>
69 #include <linux/slab.h>
70 #include <linux/interrupt.h>
71 #include <linux/input.h>
72 #include <linux/serio.h>
73
74 #define DRIVER_DESC "Driver for DEC VSXXX-AA and -GA mice and VSXXX-AB tablet"
75
76 MODULE_AUTHOR("Jan-Benedict Glaw <jbglaw@lug-owl.de>");
77 MODULE_DESCRIPTION(DRIVER_DESC);
78 MODULE_LICENSE("GPL");
79
80 #undef VSXXXAA_DEBUG
81 #ifdef VSXXXAA_DEBUG
82 #define DBG(x...) printk(x)
83 #else
84 #define DBG(x...) do {} while (0)
85 #endif
86
87 #define VSXXXAA_INTRO_MASK 0x80
88 #define VSXXXAA_INTRO_HEAD 0x80
89 #define IS_HDR_BYTE(x) \
90 (((x) & VSXXXAA_INTRO_MASK) == VSXXXAA_INTRO_HEAD)
91
92 #define VSXXXAA_PACKET_MASK 0xe0
93 #define VSXXXAA_PACKET_REL 0x80
94 #define VSXXXAA_PACKET_ABS 0xc0
95 #define VSXXXAA_PACKET_POR 0xa0
96 #define MATCH_PACKET_TYPE(data, type) \
97 (((data) & VSXXXAA_PACKET_MASK) == (type))
98
99
100
101 struct vsxxxaa {
102 struct input_dev *dev;
103 struct serio *serio;
104 #define BUFLEN 15
105 unsigned char buf[BUFLEN];
106 unsigned char count;
107 unsigned char version;
108 unsigned char country;
109 unsigned char type;
110 char name[64];
111 char phys[32];
112 };
113
114 static void vsxxxaa_drop_bytes(struct vsxxxaa *mouse, int num)
115 {
116 if (num >= mouse->count) {
117 mouse->count = 0;
118 } else {
119 memmove(mouse->buf, mouse->buf + num, BUFLEN - num);
120 mouse->count -= num;
121 }
122 }
123
124 static void vsxxxaa_queue_byte(struct vsxxxaa *mouse, unsigned char byte)
125 {
126 if (mouse->count == BUFLEN) {
127 printk(KERN_ERR "%s on %s: Dropping a byte of full buffer.\n",
128 mouse->name, mouse->phys);
129 vsxxxaa_drop_bytes(mouse, 1);
130 }
131
132 DBG(KERN_INFO "Queueing byte 0x%02x\n", byte);
133
134 mouse->buf[mouse->count++] = byte;
135 }
136
137 static void vsxxxaa_detection_done(struct vsxxxaa *mouse)
138 {
139 switch (mouse->type) {
140 case 0x02:
141 strlcpy(mouse->name, "DEC VSXXX-AA/-GA mouse",
142 sizeof(mouse->name));
143 break;
144
145 case 0x04:
146 strlcpy(mouse->name, "DEC VSXXX-AB digitizer",
147 sizeof(mouse->name));
148 break;
149
150 default:
151 snprintf(mouse->name, sizeof(mouse->name),
152 "unknown DEC pointer device (type = 0x%02x)",
153 mouse->type);
154 break;
155 }
156
157 printk(KERN_INFO
158 "Found %s version 0x%02x from country 0x%02x on port %s\n",
159 mouse->name, mouse->version, mouse->country, mouse->phys);
160 }
161
162
163
164
165 static int vsxxxaa_check_packet(struct vsxxxaa *mouse, int packet_len)
166 {
167 int i;
168
169
170 if (!IS_HDR_BYTE(mouse->buf[0])) {
171 DBG("vsck: len=%d, 1st=0x%02x\n", packet_len, mouse->buf[0]);
172 return 1;
173 }
174
175
176 for (i = 1; i < packet_len; i++) {
177 if (IS_HDR_BYTE(mouse->buf[i])) {
178 printk(KERN_ERR
179 "Need to drop %d bytes of a broken packet.\n",
180 i - 1);
181 DBG(KERN_INFO "check: len=%d, b[%d]=0x%02x\n",
182 packet_len, i, mouse->buf[i]);
183 return i - 1;
184 }
185 }
186
187 return 0;
188 }
189
190 static inline int vsxxxaa_smells_like_packet(struct vsxxxaa *mouse,
191 unsigned char type, size_t len)
192 {
193 return mouse->count >= len && MATCH_PACKET_TYPE(mouse->buf[0], type);
194 }
195
196 static void vsxxxaa_handle_REL_packet(struct vsxxxaa *mouse)
197 {
198 struct input_dev *dev = mouse->dev;
199 unsigned char *buf = mouse->buf;
200 int left, middle, right;
201 int dx, dy;
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216 dx = buf[1] & 0x7f;
217 dx *= ((buf[0] >> 4) & 0x01) ? 1 : -1;
218
219
220
221
222
223 dy = buf[2] & 0x7f;
224 dy *= ((buf[0] >> 3) & 0x01) ? -1 : 1;
225
226
227
228
229
230 left = buf[0] & 0x04;
231 middle = buf[0] & 0x02;
232 right = buf[0] & 0x01;
233
234 vsxxxaa_drop_bytes(mouse, 3);
235
236 DBG(KERN_INFO "%s on %s: dx=%d, dy=%d, buttons=%s%s%s\n",
237 mouse->name, mouse->phys, dx, dy,
238 left ? "L" : "l", middle ? "M" : "m", right ? "R" : "r");
239
240
241
242
243 input_report_key(dev, BTN_LEFT, left);
244 input_report_key(dev, BTN_MIDDLE, middle);
245 input_report_key(dev, BTN_RIGHT, right);
246 input_report_key(dev, BTN_TOUCH, 0);
247 input_report_rel(dev, REL_X, dx);
248 input_report_rel(dev, REL_Y, dy);
249 input_sync(dev);
250 }
251
252 static void vsxxxaa_handle_ABS_packet(struct vsxxxaa *mouse)
253 {
254 struct input_dev *dev = mouse->dev;
255 unsigned char *buf = mouse->buf;
256 int left, middle, right, touch;
257 int x, y;
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273 x = ((buf[2] & 0x3f) << 6) | (buf[1] & 0x3f);
274 y = ((buf[4] & 0x3f) << 6) | (buf[3] & 0x3f);
275 y = 1023 - y;
276
277
278
279
280 left = buf[0] & 0x02;
281 middle = buf[0] & 0x04;
282 right = buf[0] & 0x08;
283 touch = buf[0] & 0x10;
284
285 vsxxxaa_drop_bytes(mouse, 5);
286
287 DBG(KERN_INFO "%s on %s: x=%d, y=%d, buttons=%s%s%s%s\n",
288 mouse->name, mouse->phys, x, y,
289 left ? "L" : "l", middle ? "M" : "m",
290 right ? "R" : "r", touch ? "T" : "t");
291
292
293
294
295 input_report_key(dev, BTN_LEFT, left);
296 input_report_key(dev, BTN_MIDDLE, middle);
297 input_report_key(dev, BTN_RIGHT, right);
298 input_report_key(dev, BTN_TOUCH, touch);
299 input_report_abs(dev, ABS_X, x);
300 input_report_abs(dev, ABS_Y, y);
301 input_sync(dev);
302 }
303
304 static void vsxxxaa_handle_POR_packet(struct vsxxxaa *mouse)
305 {
306 struct input_dev *dev = mouse->dev;
307 unsigned char *buf = mouse->buf;
308 int left, middle, right;
309 unsigned char error;
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329 mouse->version = buf[0] & 0x0f;
330 mouse->country = (buf[1] >> 4) & 0x07;
331 mouse->type = buf[1] & 0x0f;
332 error = buf[2] & 0x7f;
333
334
335
336
337
338
339 left = buf[0] & 0x04;
340 middle = buf[0] & 0x02;
341 right = buf[0] & 0x01;
342
343 vsxxxaa_drop_bytes(mouse, 4);
344 vsxxxaa_detection_done(mouse);
345
346 if (error <= 0x1f) {
347
348 input_report_key(dev, BTN_LEFT, left);
349 input_report_key(dev, BTN_MIDDLE, middle);
350 input_report_key(dev, BTN_RIGHT, right);
351 input_report_key(dev, BTN_TOUCH, 0);
352 input_sync(dev);
353
354 if (error != 0)
355 printk(KERN_INFO "Your %s on %s reports error=0x%02x\n",
356 mouse->name, mouse->phys, error);
357
358 }
359
360
361
362
363
364 printk(KERN_NOTICE
365 "%s on %s: Forcing standard packet format, "
366 "incremental streaming mode and 72 samples/sec\n",
367 mouse->name, mouse->phys);
368 serio_write(mouse->serio, 'S');
369 mdelay(50);
370 serio_write(mouse->serio, 'R');
371 mdelay(50);
372 serio_write(mouse->serio, 'L');
373 }
374
375 static void vsxxxaa_parse_buffer(struct vsxxxaa *mouse)
376 {
377 unsigned char *buf = mouse->buf;
378 int stray_bytes;
379
380
381
382
383 do {
384
385
386
387
388
389
390
391 while (mouse->count > 0 && !IS_HDR_BYTE(buf[0])) {
392 printk(KERN_ERR "%s on %s: Dropping a byte to regain "
393 "sync with mouse data stream...\n",
394 mouse->name, mouse->phys);
395 vsxxxaa_drop_bytes(mouse, 1);
396 }
397
398
399
400
401
402 if (vsxxxaa_smells_like_packet(mouse, VSXXXAA_PACKET_REL, 3)) {
403
404 stray_bytes = vsxxxaa_check_packet(mouse, 3);
405 if (!stray_bytes)
406 vsxxxaa_handle_REL_packet(mouse);
407
408 } else if (vsxxxaa_smells_like_packet(mouse,
409 VSXXXAA_PACKET_ABS, 5)) {
410
411 stray_bytes = vsxxxaa_check_packet(mouse, 5);
412 if (!stray_bytes)
413 vsxxxaa_handle_ABS_packet(mouse);
414
415 } else if (vsxxxaa_smells_like_packet(mouse,
416 VSXXXAA_PACKET_POR, 4)) {
417
418 stray_bytes = vsxxxaa_check_packet(mouse, 4);
419 if (!stray_bytes)
420 vsxxxaa_handle_POR_packet(mouse);
421
422 } else {
423 break;
424 }
425
426 if (stray_bytes > 0) {
427 printk(KERN_ERR "Dropping %d bytes now...\n",
428 stray_bytes);
429 vsxxxaa_drop_bytes(mouse, stray_bytes);
430 }
431
432 } while (1);
433 }
434
435 static irqreturn_t vsxxxaa_interrupt(struct serio *serio,
436 unsigned char data, unsigned int flags)
437 {
438 struct vsxxxaa *mouse = serio_get_drvdata(serio);
439
440 vsxxxaa_queue_byte(mouse, data);
441 vsxxxaa_parse_buffer(mouse);
442
443 return IRQ_HANDLED;
444 }
445
446 static void vsxxxaa_disconnect(struct serio *serio)
447 {
448 struct vsxxxaa *mouse = serio_get_drvdata(serio);
449
450 serio_close(serio);
451 serio_set_drvdata(serio, NULL);
452 input_unregister_device(mouse->dev);
453 kfree(mouse);
454 }
455
456 static int vsxxxaa_connect(struct serio *serio, struct serio_driver *drv)
457 {
458 struct vsxxxaa *mouse;
459 struct input_dev *input_dev;
460 int err = -ENOMEM;
461
462 mouse = kzalloc(sizeof(struct vsxxxaa), GFP_KERNEL);
463 input_dev = input_allocate_device();
464 if (!mouse || !input_dev)
465 goto fail1;
466
467 mouse->dev = input_dev;
468 mouse->serio = serio;
469 strlcat(mouse->name, "DEC VSXXX-AA/-GA mouse or VSXXX-AB digitizer",
470 sizeof(mouse->name));
471 snprintf(mouse->phys, sizeof(mouse->phys), "%s/input0", serio->phys);
472
473 input_dev->name = mouse->name;
474 input_dev->phys = mouse->phys;
475 input_dev->id.bustype = BUS_RS232;
476 input_dev->dev.parent = &serio->dev;
477
478 __set_bit(EV_KEY, input_dev->evbit);
479 __set_bit(EV_REL, input_dev->evbit);
480 __set_bit(EV_ABS, input_dev->evbit);
481 __set_bit(BTN_LEFT, input_dev->keybit);
482 __set_bit(BTN_MIDDLE, input_dev->keybit);
483 __set_bit(BTN_RIGHT, input_dev->keybit);
484 __set_bit(BTN_TOUCH, input_dev->keybit);
485 __set_bit(REL_X, input_dev->relbit);
486 __set_bit(REL_Y, input_dev->relbit);
487 input_set_abs_params(input_dev, ABS_X, 0, 1023, 0, 0);
488 input_set_abs_params(input_dev, ABS_Y, 0, 1023, 0, 0);
489
490 serio_set_drvdata(serio, mouse);
491
492 err = serio_open(serio, drv);
493 if (err)
494 goto fail2;
495
496
497
498
499
500 serio_write(serio, 'T');
501
502 err = input_register_device(input_dev);
503 if (err)
504 goto fail3;
505
506 return 0;
507
508 fail3: serio_close(serio);
509 fail2: serio_set_drvdata(serio, NULL);
510 fail1: input_free_device(input_dev);
511 kfree(mouse);
512 return err;
513 }
514
515 static struct serio_device_id vsxxaa_serio_ids[] = {
516 {
517 .type = SERIO_RS232,
518 .proto = SERIO_VSXXXAA,
519 .id = SERIO_ANY,
520 .extra = SERIO_ANY,
521 },
522 { 0 }
523 };
524
525 MODULE_DEVICE_TABLE(serio, vsxxaa_serio_ids);
526
527 static struct serio_driver vsxxxaa_drv = {
528 .driver = {
529 .name = "vsxxxaa",
530 },
531 .description = DRIVER_DESC,
532 .id_table = vsxxaa_serio_ids,
533 .connect = vsxxxaa_connect,
534 .interrupt = vsxxxaa_interrupt,
535 .disconnect = vsxxxaa_disconnect,
536 };
537
538 module_serio_driver(vsxxxaa_drv);