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#include <linux/kernel.h>
32#include <linux/errno.h>
33#include <linux/slab.h>
34#include <linux/module.h>
35#include <linux/usb/input.h>
36
37
38
39
40
41
42
43struct atp_info {
44 int xsensors;
45 int xsensors_17;
46 int ysensors;
47 int xfact;
48 int yfact;
49 int datalen;
50 void (*callback)(struct urb *);
51 int fuzz;
52};
53
54static void atp_complete_geyser_1_2(struct urb *urb);
55static void atp_complete_geyser_3_4(struct urb *urb);
56
57static const struct atp_info fountain_info = {
58 .xsensors = 16,
59 .xsensors_17 = 26,
60 .ysensors = 16,
61 .xfact = 64,
62 .yfact = 43,
63 .datalen = 81,
64 .callback = atp_complete_geyser_1_2,
65 .fuzz = 16,
66};
67
68static const struct atp_info geyser1_info = {
69 .xsensors = 16,
70 .xsensors_17 = 26,
71 .ysensors = 16,
72 .xfact = 64,
73 .yfact = 43,
74 .datalen = 81,
75 .callback = atp_complete_geyser_1_2,
76 .fuzz = 16,
77};
78
79static const struct atp_info geyser2_info = {
80 .xsensors = 15,
81 .xsensors_17 = 20,
82 .ysensors = 9,
83 .xfact = 64,
84 .yfact = 43,
85 .datalen = 64,
86 .callback = atp_complete_geyser_1_2,
87 .fuzz = 0,
88};
89
90static const struct atp_info geyser3_info = {
91 .xsensors = 20,
92 .ysensors = 10,
93 .xfact = 64,
94 .yfact = 64,
95 .datalen = 64,
96 .callback = atp_complete_geyser_3_4,
97 .fuzz = 0,
98};
99
100static const struct atp_info geyser4_info = {
101 .xsensors = 20,
102 .ysensors = 10,
103 .xfact = 64,
104 .yfact = 64,
105 .datalen = 64,
106 .callback = atp_complete_geyser_3_4,
107 .fuzz = 0,
108};
109
110#define ATP_DEVICE(prod, info) \
111{ \
112 .match_flags = USB_DEVICE_ID_MATCH_DEVICE | \
113 USB_DEVICE_ID_MATCH_INT_CLASS | \
114 USB_DEVICE_ID_MATCH_INT_PROTOCOL, \
115 .idVendor = 0x05ac, \
116 .idProduct = (prod), \
117 .bInterfaceClass = 0x03, \
118 .bInterfaceProtocol = 0x02, \
119 .driver_info = (unsigned long) &info, \
120}
121
122
123
124
125
126
127
128static struct usb_device_id atp_table[] = {
129
130 ATP_DEVICE(0x020e, fountain_info),
131 ATP_DEVICE(0x020f, fountain_info),
132 ATP_DEVICE(0x030a, fountain_info),
133 ATP_DEVICE(0x030b, geyser1_info),
134
135
136 ATP_DEVICE(0x0214, geyser2_info),
137 ATP_DEVICE(0x0215, geyser2_info),
138 ATP_DEVICE(0x0216, geyser2_info),
139
140
141 ATP_DEVICE(0x0217, geyser3_info),
142 ATP_DEVICE(0x0218, geyser3_info),
143 ATP_DEVICE(0x0219, geyser3_info),
144
145
146 ATP_DEVICE(0x021a, geyser4_info),
147 ATP_DEVICE(0x021b, geyser4_info),
148 ATP_DEVICE(0x021c, geyser4_info),
149
150
151 ATP_DEVICE(0x0229, geyser4_info),
152 ATP_DEVICE(0x022a, geyser4_info),
153 ATP_DEVICE(0x022b, geyser4_info),
154
155
156 { }
157};
158MODULE_DEVICE_TABLE(usb, atp_table);
159
160
161#define ATP_XSENSORS 26
162#define ATP_YSENSORS 16
163
164
165
166
167
168#define ATP_SMOOTHSIZE 34
169
170
171#define ATP_PRESSURE 300
172
173
174
175
176
177#define ATP_THRESHOLD 5
178
179
180
181
182
183#define ATP_SCALE 12
184
185
186#define ATP_GEYSER_MODE_READ_REQUEST_ID 1
187#define ATP_GEYSER_MODE_WRITE_REQUEST_ID 9
188#define ATP_GEYSER_MODE_REQUEST_VALUE 0x300
189#define ATP_GEYSER_MODE_REQUEST_INDEX 0
190#define ATP_GEYSER_MODE_VENDOR_VALUE 0x04
191
192
193
194
195
196
197
198
199
200
201
202enum atp_status_bits {
203 ATP_STATUS_BUTTON = BIT(0),
204 ATP_STATUS_BASE_UPDATE = BIT(2),
205 ATP_STATUS_FROM_RESET = BIT(4),
206};
207
208
209struct atp {
210 char phys[64];
211 struct usb_device *udev;
212 struct usb_interface *intf;
213 struct urb *urb;
214 u8 *data;
215 struct input_dev *input;
216 const struct atp_info *info;
217 bool open;
218 bool valid;
219 bool size_detect_done;
220 bool overflow_warned;
221 int fingers_old;
222 int x_old;
223 int y_old;
224 signed char xy_cur[ATP_XSENSORS + ATP_YSENSORS];
225 signed char xy_old[ATP_XSENSORS + ATP_YSENSORS];
226 int xy_acc[ATP_XSENSORS + ATP_YSENSORS];
227 int smooth[ATP_SMOOTHSIZE];
228 int smooth_tmp[ATP_SMOOTHSIZE];
229 int idlecount;
230 struct work_struct work;
231};
232
233#define dbg_dump(msg, tab) \
234 if (debug > 1) { \
235 int __i; \
236 printk(KERN_DEBUG "appletouch: %s", msg); \
237 for (__i = 0; __i < ATP_XSENSORS + ATP_YSENSORS; __i++) \
238 printk(" %02x", tab[__i]); \
239 printk("\n"); \
240 }
241
242#define dprintk(format, a...) \
243 do { \
244 if (debug) \
245 printk(KERN_DEBUG format, ##a); \
246 } while (0)
247
248MODULE_AUTHOR("Johannes Berg");
249MODULE_AUTHOR("Stelian Pop");
250MODULE_AUTHOR("Frank Arnold");
251MODULE_AUTHOR("Michael Hanselmann");
252MODULE_AUTHOR("Sven Anders");
253MODULE_DESCRIPTION("Apple PowerBook and MacBook USB touchpad driver");
254MODULE_LICENSE("GPL");
255
256
257
258
259static int threshold = ATP_THRESHOLD;
260module_param(threshold, int, 0644);
261MODULE_PARM_DESC(threshold, "Discard any change in data from a sensor"
262 " (the trackpad has many of these sensors)"
263 " less than this value.");
264
265static int debug;
266module_param(debug, int, 0644);
267MODULE_PARM_DESC(debug, "Activate debugging output");
268
269
270
271
272
273
274static int atp_geyser_init(struct atp *dev)
275{
276 struct usb_device *udev = dev->udev;
277 char *data;
278 int size;
279 int i;
280 int ret;
281
282 data = kmalloc(8, GFP_KERNEL);
283 if (!data) {
284 dev_err(&dev->intf->dev, "Out of memory\n");
285 return -ENOMEM;
286 }
287
288 size = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
289 ATP_GEYSER_MODE_READ_REQUEST_ID,
290 USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
291 ATP_GEYSER_MODE_REQUEST_VALUE,
292 ATP_GEYSER_MODE_REQUEST_INDEX, data, 8, 5000);
293
294 if (size != 8) {
295 dprintk("atp_geyser_init: read error\n");
296 for (i = 0; i < 8; i++)
297 dprintk("appletouch[%d]: %d\n", i, data[i]);
298
299 dev_err(&dev->intf->dev, "Failed to read mode from device.\n");
300 ret = -EIO;
301 goto out_free;
302 }
303
304
305 data[0] = ATP_GEYSER_MODE_VENDOR_VALUE;
306
307 size = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
308 ATP_GEYSER_MODE_WRITE_REQUEST_ID,
309 USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
310 ATP_GEYSER_MODE_REQUEST_VALUE,
311 ATP_GEYSER_MODE_REQUEST_INDEX, data, 8, 5000);
312
313 if (size != 8) {
314 dprintk("atp_geyser_init: write error\n");
315 for (i = 0; i < 8; i++)
316 dprintk("appletouch[%d]: %d\n", i, data[i]);
317
318 dev_err(&dev->intf->dev, "Failed to request geyser raw mode\n");
319 ret = -EIO;
320 goto out_free;
321 }
322 ret = 0;
323out_free:
324 kfree(data);
325 return ret;
326}
327
328
329
330
331
332static void atp_reinit(struct work_struct *work)
333{
334 struct atp *dev = container_of(work, struct atp, work);
335 int retval;
336
337 dprintk("appletouch: putting appletouch to sleep (reinit)\n");
338 atp_geyser_init(dev);
339
340 retval = usb_submit_urb(dev->urb, GFP_ATOMIC);
341 if (retval)
342 dev_err(&dev->intf->dev,
343 "atp_reinit: usb_submit_urb failed with error %d\n",
344 retval);
345}
346
347static int atp_calculate_abs(struct atp *dev, int offset, int nb_sensors,
348 int fact, int *z, int *fingers)
349{
350 int i, pass;
351
352
353
354
355
356 int *xy_sensors = dev->xy_acc + offset;
357
358
359 int pcum = 0, psum = 0;
360 int is_increasing = 0;
361
362 *fingers = 0;
363
364 for (i = 0; i < nb_sensors; i++) {
365 if (xy_sensors[i] < threshold) {
366 if (is_increasing)
367 is_increasing = 0;
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384 } else if (i < 1 ||
385 (!is_increasing && xy_sensors[i - 1] < xy_sensors[i])) {
386 (*fingers)++;
387 is_increasing = 1;
388 } else if (i > 0 && (xy_sensors[i - 1] - xy_sensors[i] > threshold)) {
389 is_increasing = 0;
390 }
391 }
392
393 if (*fingers < 1)
394 return 0;
395
396
397
398
399
400
401
402
403
404
405 memset(dev->smooth, 0, 4 * sizeof(dev->smooth[0]));
406
407 for (i = 0; i < nb_sensors; i++)
408 dev->smooth[i + 4] = xy_sensors[i] << ATP_SCALE;
409 memset(&dev->smooth[nb_sensors + 4], 0, 4 * sizeof(dev->smooth[0]));
410
411 for (pass = 0; pass < 4; pass++) {
412
413 dev->smooth_tmp[0] = (dev->smooth[0] + dev->smooth[1]) / 2;
414
415
416 for (i = 1; i < nb_sensors + 7; i++)
417 dev->smooth_tmp[i] = (dev->smooth[i - 1] +
418 dev->smooth[i] * 2 +
419 dev->smooth[i + 1]) / 4;
420
421
422 dev->smooth_tmp[i] = (dev->smooth[i - 1] + dev->smooth[i]) / 2;
423
424 memcpy(dev->smooth, dev->smooth_tmp, sizeof(dev->smooth));
425 }
426
427 for (i = 0; i < nb_sensors + 8; i++) {
428
429
430
431
432 if ((dev->smooth[i] >> ATP_SCALE) > 0) {
433 pcum += dev->smooth[i] * i;
434 psum += dev->smooth[i];
435 }
436 }
437
438 if (psum > 0) {
439 *z = psum >> ATP_SCALE;
440 return pcum * fact / psum;
441 }
442
443 return 0;
444}
445
446static inline void atp_report_fingers(struct input_dev *input, int fingers)
447{
448 input_report_key(input, BTN_TOOL_FINGER, fingers == 1);
449 input_report_key(input, BTN_TOOL_DOUBLETAP, fingers == 2);
450 input_report_key(input, BTN_TOOL_TRIPLETAP, fingers > 2);
451}
452
453
454
455#define ATP_URB_STATUS_SUCCESS 0
456#define ATP_URB_STATUS_ERROR 1
457#define ATP_URB_STATUS_ERROR_FATAL 2
458
459static int atp_status_check(struct urb *urb)
460{
461 struct atp *dev = urb->context;
462 struct usb_interface *intf = dev->intf;
463
464 switch (urb->status) {
465 case 0:
466
467 break;
468 case -EOVERFLOW:
469 if (!dev->overflow_warned) {
470 dev_warn(&intf->dev,
471 "appletouch: OVERFLOW with data length %d, actual length is %d\n",
472 dev->info->datalen, dev->urb->actual_length);
473 dev->overflow_warned = true;
474 }
475 case -ECONNRESET:
476 case -ENOENT:
477 case -ESHUTDOWN:
478
479 dev_dbg(&intf->dev,
480 "atp_complete: urb shutting down with status: %d\n",
481 urb->status);
482 return ATP_URB_STATUS_ERROR_FATAL;
483
484 default:
485 dev_dbg(&intf->dev,
486 "atp_complete: nonzero urb status received: %d\n",
487 urb->status);
488 return ATP_URB_STATUS_ERROR;
489 }
490
491
492 if (dev->urb->actual_length != dev->info->datalen) {
493 dprintk("appletouch: incomplete data package"
494 " (first byte: %d, length: %d).\n",
495 dev->data[0], dev->urb->actual_length);
496 return ATP_URB_STATUS_ERROR;
497 }
498
499 return ATP_URB_STATUS_SUCCESS;
500}
501
502static void atp_detect_size(struct atp *dev)
503{
504 int i;
505
506
507 for (i = dev->info->xsensors; i < ATP_XSENSORS; i++) {
508 if (dev->xy_cur[i]) {
509
510 dev_info(&dev->intf->dev,
511 "appletouch: 17\" model detected.\n");
512
513 input_set_abs_params(dev->input, ABS_X, 0,
514 (dev->info->xsensors_17 - 1) *
515 dev->info->xfact - 1,
516 dev->info->fuzz, 0);
517 break;
518 }
519 }
520}
521
522
523
524
525
526
527
528static void atp_complete_geyser_1_2(struct urb *urb)
529{
530 int x, y, x_z, y_z, x_f, y_f;
531 int retval, i, j;
532 int key, fingers;
533 struct atp *dev = urb->context;
534 int status = atp_status_check(urb);
535
536 if (status == ATP_URB_STATUS_ERROR_FATAL)
537 return;
538 else if (status == ATP_URB_STATUS_ERROR)
539 goto exit;
540
541
542 if (dev->info == &geyser2_info) {
543 memset(dev->xy_cur, 0, sizeof(dev->xy_cur));
544
545
546
547
548
549
550
551
552 for (i = 0, j = 19; i < 20; i += 2, j += 3) {
553 dev->xy_cur[i] = dev->data[j];
554 dev->xy_cur[i + 1] = dev->data[j + 1];
555 }
556
557
558 for (i = 0, j = 1; i < 9; i += 2, j += 3) {
559 dev->xy_cur[ATP_XSENSORS + i] = dev->data[j];
560 dev->xy_cur[ATP_XSENSORS + i + 1] = dev->data[j + 1];
561 }
562 } else {
563 for (i = 0; i < 8; i++) {
564
565 dev->xy_cur[i + 0] = dev->data[5 * i + 2];
566 dev->xy_cur[i + 8] = dev->data[5 * i + 4];
567 dev->xy_cur[i + 16] = dev->data[5 * i + 42];
568 if (i < 2)
569 dev->xy_cur[i + 24] = dev->data[5 * i + 44];
570
571
572 dev->xy_cur[ATP_XSENSORS + i] = dev->data[5 * i + 1];
573 dev->xy_cur[ATP_XSENSORS + i + 8] = dev->data[5 * i + 3];
574 }
575 }
576
577 dbg_dump("sample", dev->xy_cur);
578
579 if (!dev->valid) {
580
581 dev->valid = true;
582 dev->x_old = dev->y_old = -1;
583
584
585 memcpy(dev->xy_old, dev->xy_cur, sizeof(dev->xy_old));
586
587
588 if (unlikely(!dev->size_detect_done)) {
589 atp_detect_size(dev);
590 dev->size_detect_done = 1;
591 goto exit;
592 }
593 }
594
595 for (i = 0; i < ATP_XSENSORS + ATP_YSENSORS; i++) {
596
597 signed char change = dev->xy_old[i] - dev->xy_cur[i];
598 dev->xy_acc[i] -= change;
599
600
601 if (dev->xy_acc[i] < 0)
602 dev->xy_acc[i] = 0;
603 }
604
605 memcpy(dev->xy_old, dev->xy_cur, sizeof(dev->xy_old));
606
607 dbg_dump("accumulator", dev->xy_acc);
608
609 x = atp_calculate_abs(dev, 0, ATP_XSENSORS,
610 dev->info->xfact, &x_z, &x_f);
611 y = atp_calculate_abs(dev, ATP_XSENSORS, ATP_YSENSORS,
612 dev->info->yfact, &y_z, &y_f);
613 key = dev->data[dev->info->datalen - 1] & ATP_STATUS_BUTTON;
614
615 fingers = max(x_f, y_f);
616
617 if (x && y && fingers == dev->fingers_old) {
618 if (dev->x_old != -1) {
619 x = (dev->x_old * 7 + x) >> 3;
620 y = (dev->y_old * 7 + y) >> 3;
621 dev->x_old = x;
622 dev->y_old = y;
623
624 if (debug > 1)
625 printk(KERN_DEBUG "appletouch: "
626 "X: %3d Y: %3d Xz: %3d Yz: %3d\n",
627 x, y, x_z, y_z);
628
629 input_report_key(dev->input, BTN_TOUCH, 1);
630 input_report_abs(dev->input, ABS_X, x);
631 input_report_abs(dev->input, ABS_Y, y);
632 input_report_abs(dev->input, ABS_PRESSURE,
633 min(ATP_PRESSURE, x_z + y_z));
634 atp_report_fingers(dev->input, fingers);
635 }
636 dev->x_old = x;
637 dev->y_old = y;
638
639 } else if (!x && !y) {
640
641 dev->x_old = dev->y_old = -1;
642 dev->fingers_old = 0;
643 input_report_key(dev->input, BTN_TOUCH, 0);
644 input_report_abs(dev->input, ABS_PRESSURE, 0);
645 atp_report_fingers(dev->input, 0);
646
647
648 memset(dev->xy_acc, 0, sizeof(dev->xy_acc));
649 }
650
651 if (fingers != dev->fingers_old)
652 dev->x_old = dev->y_old = -1;
653 dev->fingers_old = fingers;
654
655 input_report_key(dev->input, BTN_LEFT, key);
656 input_sync(dev->input);
657
658 exit:
659 retval = usb_submit_urb(dev->urb, GFP_ATOMIC);
660 if (retval)
661 dev_err(&dev->intf->dev,
662 "atp_complete: usb_submit_urb failed with result %d\n",
663 retval);
664}
665
666
667
668static void atp_complete_geyser_3_4(struct urb *urb)
669{
670 int x, y, x_z, y_z, x_f, y_f;
671 int retval, i, j;
672 int key, fingers;
673 struct atp *dev = urb->context;
674 int status = atp_status_check(urb);
675
676 if (status == ATP_URB_STATUS_ERROR_FATAL)
677 return;
678 else if (status == ATP_URB_STATUS_ERROR)
679 goto exit;
680
681
682
683
684
685
686
687
688
689 for (i = 0, j = 19; i < 20; i += 2, j += 3) {
690 dev->xy_cur[i] = dev->data[j + 1];
691 dev->xy_cur[i + 1] = dev->data[j + 2];
692 }
693
694 for (i = 0, j = 1; i < 9; i += 2, j += 3) {
695 dev->xy_cur[ATP_XSENSORS + i] = dev->data[j + 1];
696 dev->xy_cur[ATP_XSENSORS + i + 1] = dev->data[j + 2];
697 }
698
699 dbg_dump("sample", dev->xy_cur);
700
701
702 if (dev->data[dev->info->datalen - 1] & ATP_STATUS_BASE_UPDATE) {
703
704 dprintk("appletouch: updated base values\n");
705
706 memcpy(dev->xy_old, dev->xy_cur, sizeof(dev->xy_old));
707 goto exit;
708 }
709
710 for (i = 0; i < ATP_XSENSORS + ATP_YSENSORS; i++) {
711
712 dev->xy_acc[i] = dev->xy_cur[i] - dev->xy_old[i];
713
714
715 if (dev->xy_acc[i] > 127)
716 dev->xy_acc[i] -= 256;
717
718 if (dev->xy_acc[i] < -127)
719 dev->xy_acc[i] += 256;
720
721
722 if (dev->xy_acc[i] < 0)
723 dev->xy_acc[i] = 0;
724 }
725
726 dbg_dump("accumulator", dev->xy_acc);
727
728 x = atp_calculate_abs(dev, 0, ATP_XSENSORS,
729 dev->info->xfact, &x_z, &x_f);
730 y = atp_calculate_abs(dev, ATP_XSENSORS, ATP_YSENSORS,
731 dev->info->yfact, &y_z, &y_f);
732
733 key = dev->data[dev->info->datalen - 1] & ATP_STATUS_BUTTON;
734
735 fingers = max(x_f, y_f);
736
737 if (x && y && fingers == dev->fingers_old) {
738 if (dev->x_old != -1) {
739 x = (dev->x_old * 7 + x) >> 3;
740 y = (dev->y_old * 7 + y) >> 3;
741 dev->x_old = x;
742 dev->y_old = y;
743
744 if (debug > 1)
745 printk(KERN_DEBUG "appletouch: X: %3d Y: %3d "
746 "Xz: %3d Yz: %3d\n",
747 x, y, x_z, y_z);
748
749 input_report_key(dev->input, BTN_TOUCH, 1);
750 input_report_abs(dev->input, ABS_X, x);
751 input_report_abs(dev->input, ABS_Y, y);
752 input_report_abs(dev->input, ABS_PRESSURE,
753 min(ATP_PRESSURE, x_z + y_z));
754 atp_report_fingers(dev->input, fingers);
755 }
756 dev->x_old = x;
757 dev->y_old = y;
758
759 } else if (!x && !y) {
760
761 dev->x_old = dev->y_old = -1;
762 dev->fingers_old = 0;
763 input_report_key(dev->input, BTN_TOUCH, 0);
764 input_report_abs(dev->input, ABS_PRESSURE, 0);
765 atp_report_fingers(dev->input, 0);
766
767
768 memset(dev->xy_acc, 0, sizeof(dev->xy_acc));
769 }
770
771 if (fingers != dev->fingers_old)
772 dev->x_old = dev->y_old = -1;
773 dev->fingers_old = fingers;
774
775 input_report_key(dev->input, BTN_LEFT, key);
776 input_sync(dev->input);
777
778
779
780
781
782
783
784
785
786
787
788
789 if (!x && !y && !key) {
790 dev->idlecount++;
791 if (dev->idlecount == 10) {
792 dev->x_old = dev->y_old = -1;
793 dev->idlecount = 0;
794 schedule_work(&dev->work);
795
796 return;
797 }
798 } else
799 dev->idlecount = 0;
800
801 exit:
802 retval = usb_submit_urb(dev->urb, GFP_ATOMIC);
803 if (retval)
804 dev_err(&dev->intf->dev,
805 "atp_complete: usb_submit_urb failed with result %d\n",
806 retval);
807}
808
809static int atp_open(struct input_dev *input)
810{
811 struct atp *dev = input_get_drvdata(input);
812
813 if (usb_submit_urb(dev->urb, GFP_ATOMIC))
814 return -EIO;
815
816 dev->open = 1;
817 return 0;
818}
819
820static void atp_close(struct input_dev *input)
821{
822 struct atp *dev = input_get_drvdata(input);
823
824 usb_kill_urb(dev->urb);
825 cancel_work_sync(&dev->work);
826 dev->open = 0;
827}
828
829static int atp_handle_geyser(struct atp *dev)
830{
831 if (dev->info != &fountain_info) {
832
833 if (atp_geyser_init(dev))
834 return -EIO;
835
836 dev_info(&dev->intf->dev, "Geyser mode initialized.\n");
837 }
838
839 return 0;
840}
841
842static int atp_probe(struct usb_interface *iface,
843 const struct usb_device_id *id)
844{
845 struct atp *dev;
846 struct input_dev *input_dev;
847 struct usb_device *udev = interface_to_usbdev(iface);
848 struct usb_host_interface *iface_desc;
849 struct usb_endpoint_descriptor *endpoint;
850 int int_in_endpointAddr = 0;
851 int i, error = -ENOMEM;
852 const struct atp_info *info = (const struct atp_info *)id->driver_info;
853
854
855
856 iface_desc = iface->cur_altsetting;
857 for (i = 0; i < iface_desc->desc.bNumEndpoints; i++) {
858 endpoint = &iface_desc->endpoint[i].desc;
859 if (!int_in_endpointAddr && usb_endpoint_is_int_in(endpoint)) {
860
861 int_in_endpointAddr = endpoint->bEndpointAddress;
862 break;
863 }
864 }
865 if (!int_in_endpointAddr) {
866 dev_err(&iface->dev, "Could not find int-in endpoint\n");
867 return -EIO;
868 }
869
870
871 dev = kzalloc(sizeof(struct atp), GFP_KERNEL);
872 input_dev = input_allocate_device();
873 if (!dev || !input_dev) {
874 dev_err(&iface->dev, "Out of memory\n");
875 goto err_free_devs;
876 }
877
878 dev->udev = udev;
879 dev->intf = iface;
880 dev->input = input_dev;
881 dev->info = info;
882 dev->overflow_warned = false;
883
884 dev->urb = usb_alloc_urb(0, GFP_KERNEL);
885 if (!dev->urb)
886 goto err_free_devs;
887
888 dev->data = usb_alloc_coherent(dev->udev, dev->info->datalen, GFP_KERNEL,
889 &dev->urb->transfer_dma);
890 if (!dev->data)
891 goto err_free_urb;
892
893 usb_fill_int_urb(dev->urb, udev,
894 usb_rcvintpipe(udev, int_in_endpointAddr),
895 dev->data, dev->info->datalen,
896 dev->info->callback, dev, 1);
897
898 error = atp_handle_geyser(dev);
899 if (error)
900 goto err_free_buffer;
901
902 usb_make_path(udev, dev->phys, sizeof(dev->phys));
903 strlcat(dev->phys, "/input0", sizeof(dev->phys));
904
905 input_dev->name = "appletouch";
906 input_dev->phys = dev->phys;
907 usb_to_input_id(dev->udev, &input_dev->id);
908 input_dev->dev.parent = &iface->dev;
909
910 input_set_drvdata(input_dev, dev);
911
912 input_dev->open = atp_open;
913 input_dev->close = atp_close;
914
915 set_bit(EV_ABS, input_dev->evbit);
916
917 input_set_abs_params(input_dev, ABS_X, 0,
918 (dev->info->xsensors - 1) * dev->info->xfact - 1,
919 dev->info->fuzz, 0);
920 input_set_abs_params(input_dev, ABS_Y, 0,
921 (dev->info->ysensors - 1) * dev->info->yfact - 1,
922 dev->info->fuzz, 0);
923 input_set_abs_params(input_dev, ABS_PRESSURE, 0, ATP_PRESSURE, 0, 0);
924
925 set_bit(EV_KEY, input_dev->evbit);
926 set_bit(BTN_TOUCH, input_dev->keybit);
927 set_bit(BTN_TOOL_FINGER, input_dev->keybit);
928 set_bit(BTN_TOOL_DOUBLETAP, input_dev->keybit);
929 set_bit(BTN_TOOL_TRIPLETAP, input_dev->keybit);
930 set_bit(BTN_LEFT, input_dev->keybit);
931
932 error = input_register_device(dev->input);
933 if (error)
934 goto err_free_buffer;
935
936
937 usb_set_intfdata(iface, dev);
938
939 INIT_WORK(&dev->work, atp_reinit);
940
941 return 0;
942
943 err_free_buffer:
944 usb_free_coherent(dev->udev, dev->info->datalen,
945 dev->data, dev->urb->transfer_dma);
946 err_free_urb:
947 usb_free_urb(dev->urb);
948 err_free_devs:
949 usb_set_intfdata(iface, NULL);
950 kfree(dev);
951 input_free_device(input_dev);
952 return error;
953}
954
955static void atp_disconnect(struct usb_interface *iface)
956{
957 struct atp *dev = usb_get_intfdata(iface);
958
959 usb_set_intfdata(iface, NULL);
960 if (dev) {
961 usb_kill_urb(dev->urb);
962 input_unregister_device(dev->input);
963 usb_free_coherent(dev->udev, dev->info->datalen,
964 dev->data, dev->urb->transfer_dma);
965 usb_free_urb(dev->urb);
966 kfree(dev);
967 }
968 dev_info(&iface->dev, "input: appletouch disconnected\n");
969}
970
971static int atp_recover(struct atp *dev)
972{
973 int error;
974
975 error = atp_handle_geyser(dev);
976 if (error)
977 return error;
978
979 if (dev->open && usb_submit_urb(dev->urb, GFP_ATOMIC))
980 return -EIO;
981
982 return 0;
983}
984
985static int atp_suspend(struct usb_interface *iface, pm_message_t message)
986{
987 struct atp *dev = usb_get_intfdata(iface);
988
989 usb_kill_urb(dev->urb);
990 return 0;
991}
992
993static int atp_resume(struct usb_interface *iface)
994{
995 struct atp *dev = usb_get_intfdata(iface);
996
997 if (dev->open && usb_submit_urb(dev->urb, GFP_ATOMIC))
998 return -EIO;
999
1000 return 0;
1001}
1002
1003static int atp_reset_resume(struct usb_interface *iface)
1004{
1005 struct atp *dev = usb_get_intfdata(iface);
1006
1007 return atp_recover(dev);
1008}
1009
1010static struct usb_driver atp_driver = {
1011 .name = "appletouch",
1012 .probe = atp_probe,
1013 .disconnect = atp_disconnect,
1014 .suspend = atp_suspend,
1015 .resume = atp_resume,
1016 .reset_resume = atp_reset_resume,
1017 .id_table = atp_table,
1018};
1019
1020module_usb_driver(atp_driver);
1021