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#define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
30
31#include <linux/errno.h>
32#include <linux/init.h>
33#include <linux/kernel.h>
34#include <linux/module.h>
35#include <linux/slab.h>
36#include <linux/uaccess.h>
37#include <linux/ratelimit.h>
38
39#include <linux/input.h>
40#include <linux/usb.h>
41#include <linux/usb/input.h>
42#include <media/rc-core.h>
43
44#include <linux/time.h>
45#include <linux/timer.h>
46
47#define MOD_AUTHOR "Jarod Wilson <jarod@wilsonet.com>"
48#define MOD_DESC "Driver for SoundGraph iMON MultiMedia IR/Display"
49#define MOD_NAME "imon"
50#define MOD_VERSION "0.9.4"
51
52#define DISPLAY_MINOR_BASE 144
53#define DEVICE_NAME "lcd%d"
54
55#define BUF_CHUNK_SIZE 8
56#define BUF_SIZE 128
57
58#define BIT_DURATION 250
59
60#define IMON_CLOCK_ENABLE_PACKETS 2
61
62
63
64
65static int imon_probe(struct usb_interface *interface,
66 const struct usb_device_id *id);
67static void imon_disconnect(struct usb_interface *interface);
68static void usb_rx_callback_intf0(struct urb *urb);
69static void usb_rx_callback_intf1(struct urb *urb);
70static void usb_tx_callback(struct urb *urb);
71
72
73static int imon_resume(struct usb_interface *intf);
74static int imon_suspend(struct usb_interface *intf, pm_message_t message);
75
76
77static int display_open(struct inode *inode, struct file *file);
78static int display_close(struct inode *inode, struct file *file);
79
80
81static ssize_t vfd_write(struct file *file, const char *buf,
82 size_t n_bytes, loff_t *pos);
83
84
85static ssize_t lcd_write(struct file *file, const char *buf,
86 size_t n_bytes, loff_t *pos);
87
88
89
90struct imon_context {
91 struct device *dev;
92
93 struct usb_device *usbdev_intf0;
94 struct usb_device *usbdev_intf1;
95
96 bool display_supported;
97 bool display_isopen;
98 bool rf_device;
99 bool rf_isassociating;
100 bool dev_present_intf0;
101 bool dev_present_intf1;
102
103 struct mutex lock;
104 wait_queue_head_t remove_ok;
105
106 struct usb_endpoint_descriptor *rx_endpoint_intf0;
107 struct usb_endpoint_descriptor *rx_endpoint_intf1;
108 struct usb_endpoint_descriptor *tx_endpoint;
109 struct urb *rx_urb_intf0;
110 struct urb *rx_urb_intf1;
111 struct urb *tx_urb;
112 bool tx_control;
113 unsigned char usb_rx_buf[8];
114 unsigned char usb_tx_buf[8];
115 unsigned int send_packet_delay;
116
117 struct tx_t {
118 unsigned char data_buf[35];
119 struct completion finished;
120 bool busy;
121 int status;
122 } tx;
123
124 u16 vendor;
125 u16 product;
126
127 struct rc_dev *rdev;
128 struct input_dev *idev;
129 struct input_dev *touch;
130
131 spinlock_t kc_lock;
132 u32 kc;
133 u32 last_keycode;
134 u32 rc_scancode;
135 u8 rc_toggle;
136 u64 rc_type;
137 bool release_code;
138
139 u8 display_type;
140 bool pad_mouse;
141
142 char name_rdev[128];
143 char phys_rdev[64];
144
145 char name_idev[128];
146 char phys_idev[64];
147
148 char name_touch[128];
149 char phys_touch[64];
150 struct timer_list ttimer;
151 int touch_x;
152 int touch_y;
153};
154
155#define TOUCH_TIMEOUT (HZ/30)
156
157
158static const struct file_operations vfd_fops = {
159 .owner = THIS_MODULE,
160 .open = &display_open,
161 .write = &vfd_write,
162 .release = &display_close,
163 .llseek = noop_llseek,
164};
165
166
167static const struct file_operations lcd_fops = {
168 .owner = THIS_MODULE,
169 .open = &display_open,
170 .write = &lcd_write,
171 .release = &display_close,
172 .llseek = noop_llseek,
173};
174
175enum {
176 IMON_DISPLAY_TYPE_AUTO = 0,
177 IMON_DISPLAY_TYPE_VFD = 1,
178 IMON_DISPLAY_TYPE_LCD = 2,
179 IMON_DISPLAY_TYPE_VGA = 3,
180 IMON_DISPLAY_TYPE_NONE = 4,
181};
182
183enum {
184 IMON_KEY_IMON = 0,
185 IMON_KEY_MCE = 1,
186 IMON_KEY_PANEL = 2,
187};
188
189enum {
190 IMON_NEED_20MS_PKT_DELAY = 1
191};
192
193
194
195
196
197
198
199
200
201
202
203
204static struct usb_device_id imon_usb_id_table[] = {
205
206
207
208
209
210
211 { USB_DEVICE(0x15c2, 0xffdc) },
212
213
214
215
216
217
218
219 { USB_DEVICE(0x15c2, 0x0034) },
220
221 { USB_DEVICE(0x15c2, 0x0035) },
222
223 { USB_DEVICE(0x15c2, 0x0036), .driver_info = IMON_NEED_20MS_PKT_DELAY },
224
225 { USB_DEVICE(0x15c2, 0x0037) },
226
227 { USB_DEVICE(0x15c2, 0x0038) },
228
229 { USB_DEVICE(0x15c2, 0x0039) },
230
231 { USB_DEVICE(0x15c2, 0x003a) },
232
233 { USB_DEVICE(0x15c2, 0x003b) },
234
235 { USB_DEVICE(0x15c2, 0x003c) },
236
237 { USB_DEVICE(0x15c2, 0x003d) },
238
239 { USB_DEVICE(0x15c2, 0x003e) },
240
241 { USB_DEVICE(0x15c2, 0x003f) },
242
243 { USB_DEVICE(0x15c2, 0x0040) },
244
245 { USB_DEVICE(0x15c2, 0x0041) },
246
247 { USB_DEVICE(0x15c2, 0x0042) },
248
249 { USB_DEVICE(0x15c2, 0x0043) },
250
251 { USB_DEVICE(0x15c2, 0x0044) },
252
253 { USB_DEVICE(0x15c2, 0x0045) },
254
255 { USB_DEVICE(0x15c2, 0x0046) },
256 {}
257};
258
259
260static struct usb_driver imon_driver = {
261 .name = MOD_NAME,
262 .probe = imon_probe,
263 .disconnect = imon_disconnect,
264 .suspend = imon_suspend,
265 .resume = imon_resume,
266 .id_table = imon_usb_id_table,
267};
268
269static struct usb_class_driver imon_vfd_class = {
270 .name = DEVICE_NAME,
271 .fops = &vfd_fops,
272 .minor_base = DISPLAY_MINOR_BASE,
273};
274
275static struct usb_class_driver imon_lcd_class = {
276 .name = DEVICE_NAME,
277 .fops = &lcd_fops,
278 .minor_base = DISPLAY_MINOR_BASE,
279};
280
281
282static const struct {
283 u64 hw_code;
284 u32 keycode;
285} imon_panel_key_table[] = {
286 { 0x000000000f00ffeell, KEY_MEDIA },
287 { 0x000000001200ffeell, KEY_UP },
288 { 0x000000001300ffeell, KEY_DOWN },
289 { 0x000000001400ffeell, KEY_LEFT },
290 { 0x000000001500ffeell, KEY_RIGHT },
291 { 0x000000001600ffeell, KEY_ENTER },
292 { 0x000000001700ffeell, KEY_ESC },
293 { 0x000000001f00ffeell, KEY_AUDIO },
294 { 0x000000002000ffeell, KEY_VIDEO },
295 { 0x000000002100ffeell, KEY_CAMERA },
296 { 0x000000002700ffeell, KEY_DVD },
297 { 0x000000002300ffeell, KEY_TV },
298 { 0x000000002b00ffeell, KEY_EXIT },
299 { 0x000000002c00ffeell, KEY_SELECT },
300 { 0x000000002d00ffeell, KEY_MENU },
301 { 0x000000000500ffeell, KEY_PREVIOUS },
302 { 0x000000000700ffeell, KEY_REWIND },
303 { 0x000000000400ffeell, KEY_STOP },
304 { 0x000000003c00ffeell, KEY_PLAYPAUSE },
305 { 0x000000000800ffeell, KEY_FASTFORWARD },
306 { 0x000000000600ffeell, KEY_NEXT },
307 { 0x000000010000ffeell, KEY_RIGHT },
308 { 0x000001000000ffeell, KEY_LEFT },
309 { 0x000000003d00ffeell, KEY_SELECT },
310 { 0x000100000000ffeell, KEY_VOLUMEUP },
311 { 0x010000000000ffeell, KEY_VOLUMEDOWN },
312 { 0x000000000100ffeell, KEY_MUTE },
313
314 { 0x00010000ffffffeell, KEY_VOLUMEUP },
315 { 0x01000000ffffffeell, KEY_VOLUMEDOWN },
316 { 0x00000001ffffffeell, KEY_MUTE },
317 { 0x0000000fffffffeell, KEY_MEDIA },
318 { 0x00000012ffffffeell, KEY_UP },
319 { 0x00000013ffffffeell, KEY_DOWN },
320 { 0x00000014ffffffeell, KEY_LEFT },
321 { 0x00000015ffffffeell, KEY_RIGHT },
322 { 0x00000016ffffffeell, KEY_ENTER },
323 { 0x00000017ffffffeell, KEY_ESC },
324
325 { 0x000100ffffffffeell, KEY_VOLUMEUP },
326 { 0x010000ffffffffeell, KEY_VOLUMEDOWN },
327 { 0x000008ffffffffeell, KEY_MUTE },
328};
329
330
331static DEFINE_MUTEX(driver_lock);
332
333
334MODULE_AUTHOR(MOD_AUTHOR);
335MODULE_DESCRIPTION(MOD_DESC);
336MODULE_VERSION(MOD_VERSION);
337MODULE_LICENSE("GPL");
338MODULE_DEVICE_TABLE(usb, imon_usb_id_table);
339
340static bool debug;
341module_param(debug, bool, S_IRUGO | S_IWUSR);
342MODULE_PARM_DESC(debug, "Debug messages: 0=no, 1=yes (default: no)");
343
344
345static int display_type;
346module_param(display_type, int, S_IRUGO);
347MODULE_PARM_DESC(display_type, "Type of attached display. 0=autodetect, "
348 "1=vfd, 2=lcd, 3=vga, 4=none (default: autodetect)");
349
350static int pad_stabilize = 1;
351module_param(pad_stabilize, int, S_IRUGO | S_IWUSR);
352MODULE_PARM_DESC(pad_stabilize, "Apply stabilization algorithm to iMON PAD "
353 "presses in arrow key mode. 0=disable, 1=enable (default).");
354
355
356
357
358
359static bool nomouse;
360module_param(nomouse, bool, S_IRUGO | S_IWUSR);
361MODULE_PARM_DESC(nomouse, "Disable mouse input device mode when IR device is "
362 "open. 0=don't disable, 1=disable. (default: don't disable)");
363
364
365static int pad_thresh;
366module_param(pad_thresh, int, S_IRUGO | S_IWUSR);
367MODULE_PARM_DESC(pad_thresh, "Threshold at which a pad push registers as an "
368 "arrow key in kbd mode (default: 28)");
369
370
371static void free_imon_context(struct imon_context *ictx)
372{
373 struct device *dev = ictx->dev;
374
375 usb_free_urb(ictx->tx_urb);
376 usb_free_urb(ictx->rx_urb_intf0);
377 usb_free_urb(ictx->rx_urb_intf1);
378 kfree(ictx);
379
380 dev_dbg(dev, "%s: iMON context freed\n", __func__);
381}
382
383
384
385
386
387static int display_open(struct inode *inode, struct file *file)
388{
389 struct usb_interface *interface;
390 struct imon_context *ictx = NULL;
391 int subminor;
392 int retval = 0;
393
394
395 mutex_lock(&driver_lock);
396
397 subminor = iminor(inode);
398 interface = usb_find_interface(&imon_driver, subminor);
399 if (!interface) {
400 pr_err("could not find interface for minor %d\n", subminor);
401 retval = -ENODEV;
402 goto exit;
403 }
404 ictx = usb_get_intfdata(interface);
405
406 if (!ictx) {
407 pr_err("no context found for minor %d\n", subminor);
408 retval = -ENODEV;
409 goto exit;
410 }
411
412 mutex_lock(&ictx->lock);
413
414 if (!ictx->display_supported) {
415 pr_err("display not supported by device\n");
416 retval = -ENODEV;
417 } else if (ictx->display_isopen) {
418 pr_err("display port is already open\n");
419 retval = -EBUSY;
420 } else {
421 ictx->display_isopen = true;
422 file->private_data = ictx;
423 dev_dbg(ictx->dev, "display port opened\n");
424 }
425
426 mutex_unlock(&ictx->lock);
427
428exit:
429 mutex_unlock(&driver_lock);
430 return retval;
431}
432
433
434
435
436
437static int display_close(struct inode *inode, struct file *file)
438{
439 struct imon_context *ictx = NULL;
440 int retval = 0;
441
442 ictx = file->private_data;
443
444 if (!ictx) {
445 pr_err("no context for device\n");
446 return -ENODEV;
447 }
448
449 mutex_lock(&ictx->lock);
450
451 if (!ictx->display_supported) {
452 pr_err("display not supported by device\n");
453 retval = -ENODEV;
454 } else if (!ictx->display_isopen) {
455 pr_err("display is not open\n");
456 retval = -EIO;
457 } else {
458 ictx->display_isopen = false;
459 dev_dbg(ictx->dev, "display port closed\n");
460 }
461
462 mutex_unlock(&ictx->lock);
463 return retval;
464}
465
466
467
468
469
470
471static int send_packet(struct imon_context *ictx)
472{
473 unsigned int pipe;
474 unsigned long timeout;
475 int interval = 0;
476 int retval = 0;
477 struct usb_ctrlrequest *control_req = NULL;
478
479
480 if (!ictx->tx_control) {
481 pipe = usb_sndintpipe(ictx->usbdev_intf0,
482 ictx->tx_endpoint->bEndpointAddress);
483 interval = ictx->tx_endpoint->bInterval;
484
485 usb_fill_int_urb(ictx->tx_urb, ictx->usbdev_intf0, pipe,
486 ictx->usb_tx_buf,
487 sizeof(ictx->usb_tx_buf),
488 usb_tx_callback, ictx, interval);
489
490 ictx->tx_urb->actual_length = 0;
491 } else {
492
493 control_req = kmalloc(sizeof(struct usb_ctrlrequest),
494 GFP_KERNEL);
495 if (control_req == NULL)
496 return -ENOMEM;
497
498
499 control_req->bRequestType = 0x21;
500 control_req->bRequest = 0x09;
501 control_req->wValue = cpu_to_le16(0x0200);
502 control_req->wIndex = cpu_to_le16(0x0001);
503 control_req->wLength = cpu_to_le16(0x0008);
504
505
506 pipe = usb_sndctrlpipe(ictx->usbdev_intf0, 0);
507
508
509 usb_fill_control_urb(ictx->tx_urb, ictx->usbdev_intf0,
510 pipe, (unsigned char *)control_req,
511 ictx->usb_tx_buf,
512 sizeof(ictx->usb_tx_buf),
513 usb_tx_callback, ictx);
514 ictx->tx_urb->actual_length = 0;
515 }
516
517 init_completion(&ictx->tx.finished);
518 ictx->tx.busy = true;
519 smp_rmb();
520
521 retval = usb_submit_urb(ictx->tx_urb, GFP_KERNEL);
522 if (retval) {
523 ictx->tx.busy = false;
524 smp_rmb();
525 pr_err_ratelimited("error submitting urb(%d)\n", retval);
526 } else {
527
528 mutex_unlock(&ictx->lock);
529 retval = wait_for_completion_interruptible(
530 &ictx->tx.finished);
531 if (retval) {
532 usb_kill_urb(ictx->tx_urb);
533 pr_err_ratelimited("task interrupted\n");
534 }
535 mutex_lock(&ictx->lock);
536
537 retval = ictx->tx.status;
538 if (retval)
539 pr_err_ratelimited("packet tx failed (%d)\n", retval);
540 }
541
542 kfree(control_req);
543
544
545
546
547
548
549 timeout = msecs_to_jiffies(ictx->send_packet_delay);
550 set_current_state(TASK_INTERRUPTIBLE);
551 schedule_timeout(timeout);
552
553 return retval;
554}
555
556
557
558
559
560
561
562
563
564static int send_associate_24g(struct imon_context *ictx)
565{
566 int retval;
567 const unsigned char packet[8] = { 0x01, 0x00, 0x00, 0x00,
568 0x00, 0x00, 0x00, 0x20 };
569
570 if (!ictx) {
571 pr_err("no context for device\n");
572 return -ENODEV;
573 }
574
575 if (!ictx->dev_present_intf0) {
576 pr_err("no iMON device present\n");
577 return -ENODEV;
578 }
579
580 memcpy(ictx->usb_tx_buf, packet, sizeof(packet));
581 retval = send_packet(ictx);
582
583 return retval;
584}
585
586
587
588
589
590
591
592
593static int send_set_imon_clock(struct imon_context *ictx,
594 unsigned int year, unsigned int month,
595 unsigned int day, unsigned int dow,
596 unsigned int hour, unsigned int minute,
597 unsigned int second)
598{
599 unsigned char clock_enable_pkt[IMON_CLOCK_ENABLE_PACKETS][8];
600 int retval = 0;
601 int i;
602
603 if (!ictx) {
604 pr_err("no context for device\n");
605 return -ENODEV;
606 }
607
608 switch (ictx->display_type) {
609 case IMON_DISPLAY_TYPE_LCD:
610 clock_enable_pkt[0][0] = 0x80;
611 clock_enable_pkt[0][1] = year;
612 clock_enable_pkt[0][2] = month-1;
613 clock_enable_pkt[0][3] = day;
614 clock_enable_pkt[0][4] = hour;
615 clock_enable_pkt[0][5] = minute;
616 clock_enable_pkt[0][6] = second;
617
618 clock_enable_pkt[1][0] = 0x80;
619 clock_enable_pkt[1][1] = 0;
620 clock_enable_pkt[1][2] = 0;
621 clock_enable_pkt[1][3] = 0;
622 clock_enable_pkt[1][4] = 0;
623 clock_enable_pkt[1][5] = 0;
624 clock_enable_pkt[1][6] = 0;
625
626 if (ictx->product == 0xffdc) {
627 clock_enable_pkt[0][7] = 0x50;
628 clock_enable_pkt[1][7] = 0x51;
629 } else {
630 clock_enable_pkt[0][7] = 0x88;
631 clock_enable_pkt[1][7] = 0x8a;
632 }
633
634 break;
635
636 case IMON_DISPLAY_TYPE_VFD:
637 clock_enable_pkt[0][0] = year;
638 clock_enable_pkt[0][1] = month-1;
639 clock_enable_pkt[0][2] = day;
640 clock_enable_pkt[0][3] = dow;
641 clock_enable_pkt[0][4] = hour;
642 clock_enable_pkt[0][5] = minute;
643 clock_enable_pkt[0][6] = second;
644 clock_enable_pkt[0][7] = 0x40;
645
646 clock_enable_pkt[1][0] = 0;
647 clock_enable_pkt[1][1] = 0;
648 clock_enable_pkt[1][2] = 1;
649 clock_enable_pkt[1][3] = 0;
650 clock_enable_pkt[1][4] = 0;
651 clock_enable_pkt[1][5] = 0;
652 clock_enable_pkt[1][6] = 0;
653 clock_enable_pkt[1][7] = 0x42;
654
655 break;
656
657 default:
658 return -ENODEV;
659 }
660
661 for (i = 0; i < IMON_CLOCK_ENABLE_PACKETS; i++) {
662 memcpy(ictx->usb_tx_buf, clock_enable_pkt[i], 8);
663 retval = send_packet(ictx);
664 if (retval) {
665 pr_err("send_packet failed for packet %d\n", i);
666 break;
667 }
668 }
669
670 return retval;
671}
672
673
674
675
676static ssize_t show_associate_remote(struct device *d,
677 struct device_attribute *attr,
678 char *buf)
679{
680 struct imon_context *ictx = dev_get_drvdata(d);
681
682 if (!ictx)
683 return -ENODEV;
684
685 mutex_lock(&ictx->lock);
686 if (ictx->rf_isassociating)
687 strcpy(buf, "associating\n");
688 else
689 strcpy(buf, "closed\n");
690
691 dev_info(d, "Visit http://www.lirc.org/html/imon-24g.html for "
692 "instructions on how to associate your iMON 2.4G DT/LT "
693 "remote\n");
694 mutex_unlock(&ictx->lock);
695 return strlen(buf);
696}
697
698static ssize_t store_associate_remote(struct device *d,
699 struct device_attribute *attr,
700 const char *buf, size_t count)
701{
702 struct imon_context *ictx;
703
704 ictx = dev_get_drvdata(d);
705
706 if (!ictx)
707 return -ENODEV;
708
709 mutex_lock(&ictx->lock);
710 ictx->rf_isassociating = true;
711 send_associate_24g(ictx);
712 mutex_unlock(&ictx->lock);
713
714 return count;
715}
716
717
718
719
720static ssize_t show_imon_clock(struct device *d,
721 struct device_attribute *attr, char *buf)
722{
723 struct imon_context *ictx = dev_get_drvdata(d);
724 size_t len;
725
726 if (!ictx)
727 return -ENODEV;
728
729 mutex_lock(&ictx->lock);
730
731 if (!ictx->display_supported) {
732 len = snprintf(buf, PAGE_SIZE, "Not supported.");
733 } else {
734 len = snprintf(buf, PAGE_SIZE,
735 "To set the clock on your iMON display:\n"
736 "# date \"+%%y %%m %%d %%w %%H %%M %%S\" > imon_clock\n"
737 "%s", ictx->display_isopen ?
738 "\nNOTE: imon device must be closed\n" : "");
739 }
740
741 mutex_unlock(&ictx->lock);
742
743 return len;
744}
745
746static ssize_t store_imon_clock(struct device *d,
747 struct device_attribute *attr,
748 const char *buf, size_t count)
749{
750 struct imon_context *ictx = dev_get_drvdata(d);
751 ssize_t retval;
752 unsigned int year, month, day, dow, hour, minute, second;
753
754 if (!ictx)
755 return -ENODEV;
756
757 mutex_lock(&ictx->lock);
758
759 if (!ictx->display_supported) {
760 retval = -ENODEV;
761 goto exit;
762 } else if (ictx->display_isopen) {
763 retval = -EBUSY;
764 goto exit;
765 }
766
767 if (sscanf(buf, "%u %u %u %u %u %u %u", &year, &month, &day, &dow,
768 &hour, &minute, &second) != 7) {
769 retval = -EINVAL;
770 goto exit;
771 }
772
773 if ((month < 1 || month > 12) ||
774 (day < 1 || day > 31) || (dow > 6) ||
775 (hour > 23) || (minute > 59) || (second > 59)) {
776 retval = -EINVAL;
777 goto exit;
778 }
779
780 retval = send_set_imon_clock(ictx, year, month, day, dow,
781 hour, minute, second);
782 if (retval)
783 goto exit;
784
785 retval = count;
786exit:
787 mutex_unlock(&ictx->lock);
788
789 return retval;
790}
791
792
793static DEVICE_ATTR(imon_clock, S_IWUSR | S_IRUGO, show_imon_clock,
794 store_imon_clock);
795
796static DEVICE_ATTR(associate_remote, S_IWUSR | S_IRUGO, show_associate_remote,
797 store_associate_remote);
798
799static struct attribute *imon_display_sysfs_entries[] = {
800 &dev_attr_imon_clock.attr,
801 NULL
802};
803
804static struct attribute_group imon_display_attr_group = {
805 .attrs = imon_display_sysfs_entries
806};
807
808static struct attribute *imon_rf_sysfs_entries[] = {
809 &dev_attr_associate_remote.attr,
810 NULL
811};
812
813static struct attribute_group imon_rf_attr_group = {
814 .attrs = imon_rf_sysfs_entries
815};
816
817
818
819
820
821
822
823
824
825
826
827
828static ssize_t vfd_write(struct file *file, const char *buf,
829 size_t n_bytes, loff_t *pos)
830{
831 int i;
832 int offset;
833 int seq;
834 int retval = 0;
835 struct imon_context *ictx;
836 const unsigned char vfd_packet6[] = {
837 0x01, 0x00, 0x00, 0x00, 0x00, 0xFF, 0xFF };
838
839 ictx = file->private_data;
840 if (!ictx) {
841 pr_err_ratelimited("no context for device\n");
842 return -ENODEV;
843 }
844
845 mutex_lock(&ictx->lock);
846
847 if (!ictx->dev_present_intf0) {
848 pr_err_ratelimited("no iMON device present\n");
849 retval = -ENODEV;
850 goto exit;
851 }
852
853 if (n_bytes <= 0 || n_bytes > 32) {
854 pr_err_ratelimited("invalid payload size\n");
855 retval = -EINVAL;
856 goto exit;
857 }
858
859 if (copy_from_user(ictx->tx.data_buf, buf, n_bytes)) {
860 retval = -EFAULT;
861 goto exit;
862 }
863
864
865 for (i = n_bytes; i < 32; ++i)
866 ictx->tx.data_buf[i] = ' ';
867
868 for (i = 32; i < 35; ++i)
869 ictx->tx.data_buf[i] = 0xFF;
870
871 offset = 0;
872 seq = 0;
873
874 do {
875 memcpy(ictx->usb_tx_buf, ictx->tx.data_buf + offset, 7);
876 ictx->usb_tx_buf[7] = (unsigned char) seq;
877
878 retval = send_packet(ictx);
879 if (retval) {
880 pr_err_ratelimited("send packet #%d failed\n", seq / 2);
881 goto exit;
882 } else {
883 seq += 2;
884 offset += 7;
885 }
886
887 } while (offset < 35);
888
889
890 memcpy(ictx->usb_tx_buf, &vfd_packet6, sizeof(vfd_packet6));
891 ictx->usb_tx_buf[7] = (unsigned char) seq;
892 retval = send_packet(ictx);
893 if (retval)
894 pr_err_ratelimited("send packet #%d failed\n", seq / 2);
895
896exit:
897 mutex_unlock(&ictx->lock);
898
899 return (!retval) ? n_bytes : retval;
900}
901
902
903
904
905
906
907
908
909
910
911
912
913
914
915static ssize_t lcd_write(struct file *file, const char *buf,
916 size_t n_bytes, loff_t *pos)
917{
918 int retval = 0;
919 struct imon_context *ictx;
920
921 ictx = file->private_data;
922 if (!ictx) {
923 pr_err_ratelimited("no context for device\n");
924 return -ENODEV;
925 }
926
927 mutex_lock(&ictx->lock);
928
929 if (!ictx->display_supported) {
930 pr_err_ratelimited("no iMON display present\n");
931 retval = -ENODEV;
932 goto exit;
933 }
934
935 if (n_bytes != 8) {
936 pr_err_ratelimited("invalid payload size: %d (expected 8)\n",
937 (int)n_bytes);
938 retval = -EINVAL;
939 goto exit;
940 }
941
942 if (copy_from_user(ictx->usb_tx_buf, buf, 8)) {
943 retval = -EFAULT;
944 goto exit;
945 }
946
947 retval = send_packet(ictx);
948 if (retval) {
949 pr_err_ratelimited("send packet failed!\n");
950 goto exit;
951 } else {
952 dev_dbg(ictx->dev, "%s: write %d bytes to LCD\n",
953 __func__, (int) n_bytes);
954 }
955exit:
956 mutex_unlock(&ictx->lock);
957 return (!retval) ? n_bytes : retval;
958}
959
960
961
962
963static void usb_tx_callback(struct urb *urb)
964{
965 struct imon_context *ictx;
966
967 if (!urb)
968 return;
969 ictx = (struct imon_context *)urb->context;
970 if (!ictx)
971 return;
972
973 ictx->tx.status = urb->status;
974
975
976 ictx->tx.busy = false;
977 smp_rmb();
978 complete(&ictx->tx.finished);
979}
980
981
982
983
984static void imon_touch_display_timeout(unsigned long data)
985{
986 struct imon_context *ictx = (struct imon_context *)data;
987
988 if (ictx->display_type != IMON_DISPLAY_TYPE_VGA)
989 return;
990
991 input_report_abs(ictx->touch, ABS_X, ictx->touch_x);
992 input_report_abs(ictx->touch, ABS_Y, ictx->touch_y);
993 input_report_key(ictx->touch, BTN_TOUCH, 0x00);
994 input_sync(ictx->touch);
995}
996
997
998
999
1000
1001
1002
1003
1004
1005
1006
1007
1008
1009
1010
1011static int imon_ir_change_protocol(struct rc_dev *rc, u64 *rc_type)
1012{
1013 int retval;
1014 struct imon_context *ictx = rc->priv;
1015 struct device *dev = ictx->dev;
1016 bool unlock = false;
1017 unsigned char ir_proto_packet[] = {
1018 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x86 };
1019
1020 if (*rc_type && !rc_protocols_allowed(rc, *rc_type))
1021 dev_warn(dev, "Looks like you're trying to use an IR protocol "
1022 "this device does not support\n");
1023
1024 if (*rc_type & RC_BIT_RC6_MCE) {
1025 dev_dbg(dev, "Configuring IR receiver for MCE protocol\n");
1026 ir_proto_packet[0] = 0x01;
1027 *rc_type = RC_BIT_RC6_MCE;
1028 } else if (*rc_type & RC_BIT_OTHER) {
1029 dev_dbg(dev, "Configuring IR receiver for iMON protocol\n");
1030 if (!pad_stabilize)
1031 dev_dbg(dev, "PAD stabilize functionality disabled\n");
1032
1033 *rc_type = RC_BIT_OTHER;
1034 } else {
1035 dev_warn(dev, "Unsupported IR protocol specified, overriding "
1036 "to iMON IR protocol\n");
1037 if (!pad_stabilize)
1038 dev_dbg(dev, "PAD stabilize functionality disabled\n");
1039
1040 *rc_type = RC_BIT_OTHER;
1041 }
1042
1043 memcpy(ictx->usb_tx_buf, &ir_proto_packet, sizeof(ir_proto_packet));
1044
1045 if (!mutex_is_locked(&ictx->lock)) {
1046 unlock = true;
1047 mutex_lock(&ictx->lock);
1048 }
1049
1050 retval = send_packet(ictx);
1051 if (retval)
1052 goto out;
1053
1054 ictx->rc_type = *rc_type;
1055 ictx->pad_mouse = false;
1056
1057out:
1058 if (unlock)
1059 mutex_unlock(&ictx->lock);
1060
1061 return retval;
1062}
1063
1064static inline int tv2int(const struct timeval *a, const struct timeval *b)
1065{
1066 int usecs = 0;
1067 int sec = 0;
1068
1069 if (b->tv_usec > a->tv_usec) {
1070 usecs = 1000000;
1071 sec--;
1072 }
1073
1074 usecs += a->tv_usec - b->tv_usec;
1075
1076 sec += a->tv_sec - b->tv_sec;
1077 sec *= 1000;
1078 usecs /= 1000;
1079 sec += usecs;
1080
1081 if (sec < 0)
1082 sec = 1000;
1083
1084 return sec;
1085}
1086
1087
1088
1089
1090
1091
1092
1093
1094
1095static int stabilize(int a, int b, u16 timeout, u16 threshold)
1096{
1097 struct timeval ct;
1098 static struct timeval prev_time = {0, 0};
1099 static struct timeval hit_time = {0, 0};
1100 static int x, y, prev_result, hits;
1101 int result = 0;
1102 int msec, msec_hit;
1103
1104 do_gettimeofday(&ct);
1105 msec = tv2int(&ct, &prev_time);
1106 msec_hit = tv2int(&ct, &hit_time);
1107
1108 if (msec > 100) {
1109 x = 0;
1110 y = 0;
1111 hits = 0;
1112 }
1113
1114 x += a;
1115 y += b;
1116
1117 prev_time = ct;
1118
1119 if (abs(x) > threshold || abs(y) > threshold) {
1120 if (abs(y) > abs(x))
1121 result = (y > 0) ? 0x7F : 0x80;
1122 else
1123 result = (x > 0) ? 0x7F00 : 0x8000;
1124
1125 x = 0;
1126 y = 0;
1127
1128 if (result == prev_result) {
1129 hits++;
1130
1131 if (hits > 3) {
1132 switch (result) {
1133 case 0x7F:
1134 y = 17 * threshold / 30;
1135 break;
1136 case 0x80:
1137 y -= 17 * threshold / 30;
1138 break;
1139 case 0x7F00:
1140 x = 17 * threshold / 30;
1141 break;
1142 case 0x8000:
1143 x -= 17 * threshold / 30;
1144 break;
1145 }
1146 }
1147
1148 if (hits == 2 && msec_hit < timeout) {
1149 result = 0;
1150 hits = 1;
1151 }
1152 } else {
1153 prev_result = result;
1154 hits = 1;
1155 hit_time = ct;
1156 }
1157 }
1158
1159 return result;
1160}
1161
1162static u32 imon_remote_key_lookup(struct imon_context *ictx, u32 scancode)
1163{
1164 u32 keycode;
1165 u32 release;
1166 bool is_release_code = false;
1167
1168
1169 keycode = rc_g_keycode_from_table(ictx->rdev, scancode);
1170 ictx->rc_toggle = 0x0;
1171 ictx->rc_scancode = scancode;
1172
1173
1174 if (keycode == KEY_RESERVED) {
1175 release = scancode & ~0x4000;
1176 keycode = rc_g_keycode_from_table(ictx->rdev, release);
1177 if (keycode != KEY_RESERVED)
1178 is_release_code = true;
1179 }
1180
1181 ictx->release_code = is_release_code;
1182
1183 return keycode;
1184}
1185
1186static u32 imon_mce_key_lookup(struct imon_context *ictx, u32 scancode)
1187{
1188 u32 keycode;
1189
1190#define MCE_KEY_MASK 0x7000
1191#define MCE_TOGGLE_BIT 0x8000
1192
1193
1194
1195
1196
1197
1198
1199
1200
1201 if (scancode & 0x80000000)
1202 scancode = scancode | MCE_KEY_MASK | MCE_TOGGLE_BIT;
1203
1204 ictx->rc_scancode = scancode;
1205 keycode = rc_g_keycode_from_table(ictx->rdev, scancode);
1206
1207
1208 ictx->release_code = false;
1209
1210 return keycode;
1211}
1212
1213static u32 imon_panel_key_lookup(u64 code)
1214{
1215 int i;
1216 u32 keycode = KEY_RESERVED;
1217
1218 for (i = 0; i < ARRAY_SIZE(imon_panel_key_table); i++) {
1219 if (imon_panel_key_table[i].hw_code == (code | 0xffee)) {
1220 keycode = imon_panel_key_table[i].keycode;
1221 break;
1222 }
1223 }
1224
1225 return keycode;
1226}
1227
1228static bool imon_mouse_event(struct imon_context *ictx,
1229 unsigned char *buf, int len)
1230{
1231 signed char rel_x = 0x00, rel_y = 0x00;
1232 u8 right_shift = 1;
1233 bool mouse_input = true;
1234 int dir = 0;
1235 unsigned long flags;
1236
1237 spin_lock_irqsave(&ictx->kc_lock, flags);
1238
1239
1240 if (ictx->product != 0xffdc && (buf[0] & 0x01) && len == 5) {
1241 rel_x = buf[2];
1242 rel_y = buf[3];
1243 right_shift = 1;
1244
1245 } else if (ictx->product == 0xffdc && (buf[0] & 0x40) &&
1246 !((buf[1] & 0x01) || ((buf[1] >> 2) & 0x01))) {
1247 rel_x = (buf[1] & 0x08) | (buf[1] & 0x10) >> 2 |
1248 (buf[1] & 0x20) >> 4 | (buf[1] & 0x40) >> 6;
1249 if (buf[0] & 0x02)
1250 rel_x |= ~0x0f;
1251 rel_x = rel_x + rel_x / 2;
1252 rel_y = (buf[2] & 0x08) | (buf[2] & 0x10) >> 2 |
1253 (buf[2] & 0x20) >> 4 | (buf[2] & 0x40) >> 6;
1254 if (buf[0] & 0x01)
1255 rel_y |= ~0x0f;
1256 rel_y = rel_y + rel_y / 2;
1257 right_shift = 2;
1258
1259 } else if (ictx->product == 0xffdc && (buf[0] == 0x68)) {
1260 right_shift = 2;
1261
1262 } else if (ictx->kc == KEY_CHANNELUP && (buf[2] & 0x40) != 0x40) {
1263 dir = 1;
1264 } else if (ictx->kc == KEY_CHANNELDOWN && (buf[2] & 0x40) != 0x40) {
1265 dir = -1;
1266 } else
1267 mouse_input = false;
1268
1269 spin_unlock_irqrestore(&ictx->kc_lock, flags);
1270
1271 if (mouse_input) {
1272 dev_dbg(ictx->dev, "sending mouse data via input subsystem\n");
1273
1274 if (dir) {
1275 input_report_rel(ictx->idev, REL_WHEEL, dir);
1276 } else if (rel_x || rel_y) {
1277 input_report_rel(ictx->idev, REL_X, rel_x);
1278 input_report_rel(ictx->idev, REL_Y, rel_y);
1279 } else {
1280 input_report_key(ictx->idev, BTN_LEFT, buf[1] & 0x1);
1281 input_report_key(ictx->idev, BTN_RIGHT,
1282 buf[1] >> right_shift & 0x1);
1283 }
1284 input_sync(ictx->idev);
1285 spin_lock_irqsave(&ictx->kc_lock, flags);
1286 ictx->last_keycode = ictx->kc;
1287 spin_unlock_irqrestore(&ictx->kc_lock, flags);
1288 }
1289
1290 return mouse_input;
1291}
1292
1293static void imon_touch_event(struct imon_context *ictx, unsigned char *buf)
1294{
1295 mod_timer(&ictx->ttimer, jiffies + TOUCH_TIMEOUT);
1296 ictx->touch_x = (buf[0] << 4) | (buf[1] >> 4);
1297 ictx->touch_y = 0xfff - ((buf[2] << 4) | (buf[1] & 0xf));
1298 input_report_abs(ictx->touch, ABS_X, ictx->touch_x);
1299 input_report_abs(ictx->touch, ABS_Y, ictx->touch_y);
1300 input_report_key(ictx->touch, BTN_TOUCH, 0x01);
1301 input_sync(ictx->touch);
1302}
1303
1304static void imon_pad_to_keys(struct imon_context *ictx, unsigned char *buf)
1305{
1306 int dir = 0;
1307 signed char rel_x = 0x00, rel_y = 0x00;
1308 u16 timeout, threshold;
1309 u32 scancode = KEY_RESERVED;
1310 unsigned long flags;
1311
1312
1313
1314
1315
1316
1317
1318
1319
1320 if (ictx->product != 0xffdc) {
1321
1322 buf[5] = buf[6] = buf[7] = 0;
1323 timeout = 500;
1324
1325 threshold = pad_thresh ? pad_thresh : 28;
1326 rel_x = buf[2];
1327 rel_y = buf[3];
1328
1329 if (ictx->rc_type == RC_BIT_OTHER && pad_stabilize) {
1330 if ((buf[1] == 0) && ((rel_x != 0) || (rel_y != 0))) {
1331 dir = stabilize((int)rel_x, (int)rel_y,
1332 timeout, threshold);
1333 if (!dir) {
1334 spin_lock_irqsave(&ictx->kc_lock,
1335 flags);
1336 ictx->kc = KEY_UNKNOWN;
1337 spin_unlock_irqrestore(&ictx->kc_lock,
1338 flags);
1339 return;
1340 }
1341 buf[2] = dir & 0xFF;
1342 buf[3] = (dir >> 8) & 0xFF;
1343 scancode = be32_to_cpu(*((u32 *)buf));
1344 }
1345 } else {
1346
1347
1348
1349
1350 if (abs(rel_y) > abs(rel_x)) {
1351 buf[2] = (rel_y > 0) ? 0x7F : 0x80;
1352 buf[3] = 0;
1353 if (rel_y > 0)
1354 scancode = 0x01007f00;
1355 else
1356 scancode = 0x01008000;
1357 } else {
1358 buf[2] = 0;
1359 buf[3] = (rel_x > 0) ? 0x7F : 0x80;
1360 if (rel_x > 0)
1361 scancode = 0x0100007f;
1362 else
1363 scancode = 0x01000080;
1364 }
1365 }
1366
1367
1368
1369
1370
1371
1372
1373
1374
1375
1376
1377 } else {
1378 timeout = 10;
1379
1380 threshold = pad_thresh ? pad_thresh : 15;
1381
1382
1383 rel_x = (buf[1] & 0x08) | (buf[1] & 0x10) >> 2 |
1384 (buf[1] & 0x20) >> 4 | (buf[1] & 0x40) >> 6;
1385 if (buf[0] & 0x02)
1386 rel_x |= ~0x10+1;
1387
1388 rel_y = (buf[2] & 0x08) | (buf[2] & 0x10) >> 2 |
1389 (buf[2] & 0x20) >> 4 | (buf[2] & 0x40) >> 6;
1390 if (buf[0] & 0x01)
1391 rel_y |= ~0x10+1;
1392
1393 buf[0] = 0x01;
1394 buf[1] = buf[4] = buf[5] = buf[6] = buf[7] = 0;
1395
1396 if (ictx->rc_type == RC_BIT_OTHER && pad_stabilize) {
1397 dir = stabilize((int)rel_x, (int)rel_y,
1398 timeout, threshold);
1399 if (!dir) {
1400 spin_lock_irqsave(&ictx->kc_lock, flags);
1401 ictx->kc = KEY_UNKNOWN;
1402 spin_unlock_irqrestore(&ictx->kc_lock, flags);
1403 return;
1404 }
1405 buf[2] = dir & 0xFF;
1406 buf[3] = (dir >> 8) & 0xFF;
1407 scancode = be32_to_cpu(*((u32 *)buf));
1408 } else {
1409
1410
1411
1412
1413 if (abs(rel_y) > abs(rel_x)) {
1414 buf[2] = (rel_y > 0) ? 0x7F : 0x80;
1415 buf[3] = 0;
1416 if (rel_y > 0)
1417 scancode = 0x01007f00;
1418 else
1419 scancode = 0x01008000;
1420 } else {
1421 buf[2] = 0;
1422 buf[3] = (rel_x > 0) ? 0x7F : 0x80;
1423 if (rel_x > 0)
1424 scancode = 0x0100007f;
1425 else
1426 scancode = 0x01000080;
1427 }
1428 }
1429 }
1430
1431 if (scancode) {
1432 spin_lock_irqsave(&ictx->kc_lock, flags);
1433 ictx->kc = imon_remote_key_lookup(ictx, scancode);
1434 spin_unlock_irqrestore(&ictx->kc_lock, flags);
1435 }
1436}
1437
1438
1439
1440
1441
1442
1443static int imon_parse_press_type(struct imon_context *ictx,
1444 unsigned char *buf, u8 ktype)
1445{
1446 int press_type = 0;
1447 unsigned long flags;
1448
1449 spin_lock_irqsave(&ictx->kc_lock, flags);
1450
1451
1452 if (ictx->kc == KEY_RESERVED && buf[0] == 0x02 && buf[3] == 0x00)
1453 ictx->kc = ictx->last_keycode;
1454
1455
1456 else if (ictx->kc == KEY_RESERVED && buf[0] == 0x68 && buf[1] == 0x82 &&
1457 buf[2] == 0x81 && buf[3] == 0xb7)
1458 ictx->kc = ictx->last_keycode;
1459
1460
1461 else if (ictx->kc == KEY_RESERVED && buf[0] == 0x01 && buf[1] == 0x00 &&
1462 buf[2] == 0x81 && buf[3] == 0xb7)
1463 ictx->kc = ictx->last_keycode;
1464
1465
1466 else if (ktype == IMON_KEY_MCE) {
1467 ictx->rc_toggle = buf[2];
1468 press_type = 1;
1469
1470
1471 } else if (ictx->kc == KEY_RESERVED)
1472 press_type = -EINVAL;
1473
1474
1475 else if (ictx->release_code)
1476 press_type = 0;
1477
1478
1479 else
1480 press_type = 1;
1481
1482 spin_unlock_irqrestore(&ictx->kc_lock, flags);
1483
1484 return press_type;
1485}
1486
1487
1488
1489
1490static void imon_incoming_packet(struct imon_context *ictx,
1491 struct urb *urb, int intf)
1492{
1493 int len = urb->actual_length;
1494 unsigned char *buf = urb->transfer_buffer;
1495 struct device *dev = ictx->dev;
1496 unsigned long flags;
1497 u32 kc;
1498 int i;
1499 u64 scancode;
1500 int press_type = 0;
1501 int msec;
1502 struct timeval t;
1503 static struct timeval prev_time = { 0, 0 };
1504 u8 ktype;
1505
1506
1507 if ((buf[0] == 0xff) && (buf[1] == 0xff) && (buf[2] == 0xff))
1508 return;
1509
1510
1511 if (len == 8 && buf[7] == 0xee) {
1512 scancode = be64_to_cpu(*((u64 *)buf));
1513 ktype = IMON_KEY_PANEL;
1514 kc = imon_panel_key_lookup(scancode);
1515 } else {
1516 scancode = be32_to_cpu(*((u32 *)buf));
1517 if (ictx->rc_type == RC_BIT_RC6_MCE) {
1518 ktype = IMON_KEY_IMON;
1519 if (buf[0] == 0x80)
1520 ktype = IMON_KEY_MCE;
1521 kc = imon_mce_key_lookup(ictx, scancode);
1522 } else {
1523 ktype = IMON_KEY_IMON;
1524 kc = imon_remote_key_lookup(ictx, scancode);
1525 }
1526 }
1527
1528 spin_lock_irqsave(&ictx->kc_lock, flags);
1529
1530 if (kc == KEY_KEYBOARD && !ictx->release_code) {
1531 ictx->last_keycode = kc;
1532 if (!nomouse) {
1533 ictx->pad_mouse = ~(ictx->pad_mouse) & 0x1;
1534 dev_dbg(dev, "toggling to %s mode\n",
1535 ictx->pad_mouse ? "mouse" : "keyboard");
1536 spin_unlock_irqrestore(&ictx->kc_lock, flags);
1537 return;
1538 } else {
1539 ictx->pad_mouse = false;
1540 dev_dbg(dev, "mouse mode disabled, passing key value\n");
1541 }
1542 }
1543
1544 ictx->kc = kc;
1545 spin_unlock_irqrestore(&ictx->kc_lock, flags);
1546
1547
1548 if (ictx->display_type == IMON_DISPLAY_TYPE_VGA && len == 8 &&
1549 buf[7] == 0x86) {
1550 imon_touch_event(ictx, buf);
1551 return;
1552
1553
1554 } else if (ictx->pad_mouse) {
1555 if (imon_mouse_event(ictx, buf, len))
1556 return;
1557 }
1558
1559
1560 if (((len == 5) && (buf[0] == 0x01) && (buf[4] == 0x00)) ||
1561 ((len == 8) && (buf[0] & 0x40) &&
1562 !(buf[1] & 0x1 || buf[1] >> 2 & 0x1))) {
1563 len = 8;
1564 imon_pad_to_keys(ictx, buf);
1565 }
1566
1567 if (debug) {
1568 printk(KERN_INFO "intf%d decoded packet: ", intf);
1569 for (i = 0; i < len; ++i)
1570 printk("%02x ", buf[i]);
1571 printk("\n");
1572 }
1573
1574 press_type = imon_parse_press_type(ictx, buf, ktype);
1575 if (press_type < 0)
1576 goto not_input_data;
1577
1578 if (ktype != IMON_KEY_PANEL) {
1579 if (press_type == 0)
1580 rc_keyup(ictx->rdev);
1581 else {
1582 rc_keydown(ictx->rdev, ictx->rc_scancode, ictx->rc_toggle);
1583 spin_lock_irqsave(&ictx->kc_lock, flags);
1584 ictx->last_keycode = ictx->kc;
1585 spin_unlock_irqrestore(&ictx->kc_lock, flags);
1586 }
1587 return;
1588 }
1589
1590
1591 spin_lock_irqsave(&ictx->kc_lock, flags);
1592
1593 do_gettimeofday(&t);
1594
1595 if (ictx->kc == KEY_MUTE && ictx->kc == ictx->last_keycode) {
1596 msec = tv2int(&t, &prev_time);
1597 if (msec < ictx->idev->rep[REP_DELAY]) {
1598 spin_unlock_irqrestore(&ictx->kc_lock, flags);
1599 return;
1600 }
1601 }
1602 prev_time = t;
1603 kc = ictx->kc;
1604
1605 spin_unlock_irqrestore(&ictx->kc_lock, flags);
1606
1607 input_report_key(ictx->idev, kc, press_type);
1608 input_sync(ictx->idev);
1609
1610
1611 input_report_key(ictx->idev, kc, 0);
1612 input_sync(ictx->idev);
1613
1614 spin_lock_irqsave(&ictx->kc_lock, flags);
1615 ictx->last_keycode = kc;
1616 spin_unlock_irqrestore(&ictx->kc_lock, flags);
1617
1618 return;
1619
1620not_input_data:
1621 if (len != 8) {
1622 dev_warn(dev, "imon %s: invalid incoming packet "
1623 "size (len = %d, intf%d)\n", __func__, len, intf);
1624 return;
1625 }
1626
1627
1628 if (buf[0] == 0x00 &&
1629 buf[2] == 0xFF &&
1630 buf[3] == 0xFF &&
1631 buf[4] == 0xFF &&
1632 buf[5] == 0xFF &&
1633 ((buf[6] == 0x4E && buf[7] == 0xDF) ||
1634 (buf[6] == 0x5E && buf[7] == 0xDF))) {
1635 dev_warn(dev, "%s: remote associated refid=%02X\n",
1636 __func__, buf[1]);
1637 ictx->rf_isassociating = false;
1638 }
1639}
1640
1641
1642
1643
1644static void usb_rx_callback_intf0(struct urb *urb)
1645{
1646 struct imon_context *ictx;
1647 int intfnum = 0;
1648
1649 if (!urb)
1650 return;
1651
1652 ictx = (struct imon_context *)urb->context;
1653 if (!ictx)
1654 return;
1655
1656
1657
1658
1659
1660
1661 if (!ictx->dev_present_intf0)
1662 goto out;
1663
1664 switch (urb->status) {
1665 case -ENOENT:
1666 return;
1667
1668 case -ESHUTDOWN:
1669 break;
1670
1671 case 0:
1672 imon_incoming_packet(ictx, urb, intfnum);
1673 break;
1674
1675 default:
1676 dev_warn(ictx->dev, "imon %s: status(%d): ignored\n",
1677 __func__, urb->status);
1678 break;
1679 }
1680
1681out:
1682 usb_submit_urb(ictx->rx_urb_intf0, GFP_ATOMIC);
1683}
1684
1685static void usb_rx_callback_intf1(struct urb *urb)
1686{
1687 struct imon_context *ictx;
1688 int intfnum = 1;
1689
1690 if (!urb)
1691 return;
1692
1693 ictx = (struct imon_context *)urb->context;
1694 if (!ictx)
1695 return;
1696
1697
1698
1699
1700
1701
1702 if (!ictx->dev_present_intf1)
1703 goto out;
1704
1705 switch (urb->status) {
1706 case -ENOENT:
1707 return;
1708
1709 case -ESHUTDOWN:
1710 break;
1711
1712 case 0:
1713 imon_incoming_packet(ictx, urb, intfnum);
1714 break;
1715
1716 default:
1717 dev_warn(ictx->dev, "imon %s: status(%d): ignored\n",
1718 __func__, urb->status);
1719 break;
1720 }
1721
1722out:
1723 usb_submit_urb(ictx->rx_urb_intf1, GFP_ATOMIC);
1724}
1725
1726
1727
1728
1729
1730
1731
1732
1733
1734
1735static void imon_get_ffdc_type(struct imon_context *ictx)
1736{
1737 u8 ffdc_cfg_byte = ictx->usb_rx_buf[6];
1738 u8 detected_display_type = IMON_DISPLAY_TYPE_NONE;
1739 u64 allowed_protos = RC_BIT_OTHER;
1740
1741 switch (ffdc_cfg_byte) {
1742
1743 case 0x21:
1744 dev_info(ictx->dev, "0xffdc iMON Knob, iMON IR");
1745 ictx->display_supported = false;
1746 break;
1747
1748 case 0x4e:
1749 dev_info(ictx->dev, "0xffdc iMON 2.4G LT, iMON RF");
1750 ictx->display_supported = false;
1751 ictx->rf_device = true;
1752 break;
1753
1754 case 0x35:
1755 dev_info(ictx->dev, "0xffdc iMON VFD + knob, no IR");
1756 detected_display_type = IMON_DISPLAY_TYPE_VFD;
1757 break;
1758
1759 case 0x24:
1760 case 0x85:
1761 dev_info(ictx->dev, "0xffdc iMON VFD, iMON IR");
1762 detected_display_type = IMON_DISPLAY_TYPE_VFD;
1763 break;
1764
1765 case 0x46:
1766 case 0x7e:
1767 case 0x9e:
1768 dev_info(ictx->dev, "0xffdc iMON VFD, MCE IR");
1769 detected_display_type = IMON_DISPLAY_TYPE_VFD;
1770 allowed_protos = RC_BIT_RC6_MCE;
1771 break;
1772
1773 case 0x9f:
1774 dev_info(ictx->dev, "0xffdc iMON LCD, MCE IR");
1775 detected_display_type = IMON_DISPLAY_TYPE_LCD;
1776 allowed_protos = RC_BIT_RC6_MCE;
1777 break;
1778 default:
1779 dev_info(ictx->dev, "Unknown 0xffdc device, "
1780 "defaulting to VFD and iMON IR");
1781 detected_display_type = IMON_DISPLAY_TYPE_VFD;
1782
1783
1784 allowed_protos |= RC_BIT_RC6_MCE;
1785 break;
1786 }
1787
1788 printk(KERN_CONT " (id 0x%02x)\n", ffdc_cfg_byte);
1789
1790 ictx->display_type = detected_display_type;
1791 ictx->rc_type = allowed_protos;
1792}
1793
1794static void imon_set_display_type(struct imon_context *ictx)
1795{
1796 u8 configured_display_type = IMON_DISPLAY_TYPE_VFD;
1797
1798
1799
1800
1801
1802
1803 if (display_type == IMON_DISPLAY_TYPE_AUTO) {
1804 switch (ictx->product) {
1805 case 0xffdc:
1806
1807 configured_display_type = ictx->display_type;
1808 break;
1809 case 0x0034:
1810 case 0x0035:
1811 configured_display_type = IMON_DISPLAY_TYPE_VGA;
1812 break;
1813 case 0x0038:
1814 case 0x0039:
1815 case 0x0045:
1816 configured_display_type = IMON_DISPLAY_TYPE_LCD;
1817 break;
1818 case 0x003c:
1819 case 0x0041:
1820 case 0x0042:
1821 case 0x0043:
1822 configured_display_type = IMON_DISPLAY_TYPE_NONE;
1823 ictx->display_supported = false;
1824 break;
1825 case 0x0036:
1826 case 0x0044:
1827 default:
1828 configured_display_type = IMON_DISPLAY_TYPE_VFD;
1829 break;
1830 }
1831 } else {
1832 configured_display_type = display_type;
1833 if (display_type == IMON_DISPLAY_TYPE_NONE)
1834 ictx->display_supported = false;
1835 else
1836 ictx->display_supported = true;
1837 dev_info(ictx->dev, "%s: overriding display type to %d via "
1838 "modparam\n", __func__, display_type);
1839 }
1840
1841 ictx->display_type = configured_display_type;
1842}
1843
1844static struct rc_dev *imon_init_rdev(struct imon_context *ictx)
1845{
1846 struct rc_dev *rdev;
1847 int ret;
1848 const unsigned char fp_packet[] = { 0x40, 0x00, 0x00, 0x00,
1849 0x00, 0x00, 0x00, 0x88 };
1850
1851 rdev = rc_allocate_device();
1852 if (!rdev) {
1853 dev_err(ictx->dev, "remote control dev allocation failed\n");
1854 goto out;
1855 }
1856
1857 snprintf(ictx->name_rdev, sizeof(ictx->name_rdev),
1858 "iMON Remote (%04x:%04x)", ictx->vendor, ictx->product);
1859 usb_make_path(ictx->usbdev_intf0, ictx->phys_rdev,
1860 sizeof(ictx->phys_rdev));
1861 strlcat(ictx->phys_rdev, "/input0", sizeof(ictx->phys_rdev));
1862
1863 rdev->input_name = ictx->name_rdev;
1864 rdev->input_phys = ictx->phys_rdev;
1865 usb_to_input_id(ictx->usbdev_intf0, &rdev->input_id);
1866 rdev->dev.parent = ictx->dev;
1867
1868 rdev->priv = ictx;
1869 rdev->driver_type = RC_DRIVER_SCANCODE;
1870
1871 rc_set_allowed_protocols(rdev, RC_BIT_OTHER | RC_BIT_RC6_MCE);
1872 rdev->change_protocol = imon_ir_change_protocol;
1873 rdev->driver_name = MOD_NAME;
1874
1875
1876 memcpy(ictx->usb_tx_buf, &fp_packet, sizeof(fp_packet));
1877 ret = send_packet(ictx);
1878
1879 if (ret)
1880 dev_info(ictx->dev, "panel buttons/knobs setup failed\n");
1881
1882 if (ictx->product == 0xffdc) {
1883 imon_get_ffdc_type(ictx);
1884 rc_set_allowed_protocols(rdev, ictx->rc_type);
1885 }
1886
1887 imon_set_display_type(ictx);
1888
1889 if (ictx->rc_type == RC_BIT_RC6_MCE)
1890 rdev->map_name = RC_MAP_IMON_MCE;
1891 else
1892 rdev->map_name = RC_MAP_IMON_PAD;
1893
1894 ret = rc_register_device(rdev);
1895 if (ret < 0) {
1896 dev_err(ictx->dev, "remote input dev register failed\n");
1897 goto out;
1898 }
1899
1900 return rdev;
1901
1902out:
1903 rc_free_device(rdev);
1904 return NULL;
1905}
1906
1907static struct input_dev *imon_init_idev(struct imon_context *ictx)
1908{
1909 struct input_dev *idev;
1910 int ret, i;
1911
1912 idev = input_allocate_device();
1913 if (!idev)
1914 goto out;
1915
1916 snprintf(ictx->name_idev, sizeof(ictx->name_idev),
1917 "iMON Panel, Knob and Mouse(%04x:%04x)",
1918 ictx->vendor, ictx->product);
1919 idev->name = ictx->name_idev;
1920
1921 usb_make_path(ictx->usbdev_intf0, ictx->phys_idev,
1922 sizeof(ictx->phys_idev));
1923 strlcat(ictx->phys_idev, "/input1", sizeof(ictx->phys_idev));
1924 idev->phys = ictx->phys_idev;
1925
1926 idev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REP) | BIT_MASK(EV_REL);
1927
1928 idev->keybit[BIT_WORD(BTN_MOUSE)] =
1929 BIT_MASK(BTN_LEFT) | BIT_MASK(BTN_RIGHT);
1930 idev->relbit[0] = BIT_MASK(REL_X) | BIT_MASK(REL_Y) |
1931 BIT_MASK(REL_WHEEL);
1932
1933
1934 for (i = 0; i < ARRAY_SIZE(imon_panel_key_table); i++) {
1935 u32 kc = imon_panel_key_table[i].keycode;
1936 __set_bit(kc, idev->keybit);
1937 }
1938
1939 usb_to_input_id(ictx->usbdev_intf0, &idev->id);
1940 idev->dev.parent = ictx->dev;
1941 input_set_drvdata(idev, ictx);
1942
1943 ret = input_register_device(idev);
1944 if (ret < 0) {
1945 dev_err(ictx->dev, "input dev register failed\n");
1946 goto out;
1947 }
1948
1949 return idev;
1950
1951out:
1952 input_free_device(idev);
1953 return NULL;
1954}
1955
1956static struct input_dev *imon_init_touch(struct imon_context *ictx)
1957{
1958 struct input_dev *touch;
1959 int ret;
1960
1961 touch = input_allocate_device();
1962 if (!touch)
1963 goto touch_alloc_failed;
1964
1965 snprintf(ictx->name_touch, sizeof(ictx->name_touch),
1966 "iMON USB Touchscreen (%04x:%04x)",
1967 ictx->vendor, ictx->product);
1968 touch->name = ictx->name_touch;
1969
1970 usb_make_path(ictx->usbdev_intf1, ictx->phys_touch,
1971 sizeof(ictx->phys_touch));
1972 strlcat(ictx->phys_touch, "/input2", sizeof(ictx->phys_touch));
1973 touch->phys = ictx->phys_touch;
1974
1975 touch->evbit[0] =
1976 BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS);
1977 touch->keybit[BIT_WORD(BTN_TOUCH)] =
1978 BIT_MASK(BTN_TOUCH);
1979 input_set_abs_params(touch, ABS_X,
1980 0x00, 0xfff, 0, 0);
1981 input_set_abs_params(touch, ABS_Y,
1982 0x00, 0xfff, 0, 0);
1983
1984 input_set_drvdata(touch, ictx);
1985
1986 usb_to_input_id(ictx->usbdev_intf1, &touch->id);
1987 touch->dev.parent = ictx->dev;
1988 ret = input_register_device(touch);
1989 if (ret < 0) {
1990 dev_info(ictx->dev, "touchscreen input dev register failed\n");
1991 goto touch_register_failed;
1992 }
1993
1994 return touch;
1995
1996touch_register_failed:
1997 input_free_device(touch);
1998
1999touch_alloc_failed:
2000 return NULL;
2001}
2002
2003static bool imon_find_endpoints(struct imon_context *ictx,
2004 struct usb_host_interface *iface_desc)
2005{
2006 struct usb_endpoint_descriptor *ep;
2007 struct usb_endpoint_descriptor *rx_endpoint = NULL;
2008 struct usb_endpoint_descriptor *tx_endpoint = NULL;
2009 int ifnum = iface_desc->desc.bInterfaceNumber;
2010 int num_endpts = iface_desc->desc.bNumEndpoints;
2011 int i, ep_dir, ep_type;
2012 bool ir_ep_found = false;
2013 bool display_ep_found = false;
2014 bool tx_control = false;
2015
2016
2017
2018
2019
2020
2021 for (i = 0; i < num_endpts && !(ir_ep_found && display_ep_found); ++i) {
2022 ep = &iface_desc->endpoint[i].desc;
2023 ep_dir = ep->bEndpointAddress & USB_ENDPOINT_DIR_MASK;
2024 ep_type = ep->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK;
2025
2026 if (!ir_ep_found && ep_dir == USB_DIR_IN &&
2027 ep_type == USB_ENDPOINT_XFER_INT) {
2028
2029 rx_endpoint = ep;
2030 ir_ep_found = true;
2031 dev_dbg(ictx->dev, "%s: found IR endpoint\n", __func__);
2032
2033 } else if (!display_ep_found && ep_dir == USB_DIR_OUT &&
2034 ep_type == USB_ENDPOINT_XFER_INT) {
2035 tx_endpoint = ep;
2036 display_ep_found = true;
2037 dev_dbg(ictx->dev, "%s: found display endpoint\n", __func__);
2038 }
2039 }
2040
2041 if (ifnum == 0) {
2042 ictx->rx_endpoint_intf0 = rx_endpoint;
2043
2044
2045
2046
2047 ictx->tx_endpoint = tx_endpoint;
2048 } else {
2049 ictx->rx_endpoint_intf1 = rx_endpoint;
2050 }
2051
2052
2053
2054
2055
2056 if (!display_ep_found) {
2057 tx_control = true;
2058 display_ep_found = true;
2059 dev_dbg(ictx->dev, "%s: device uses control endpoint, not "
2060 "interface OUT endpoint\n", __func__);
2061 }
2062
2063
2064
2065
2066
2067
2068 if (ictx->display_type == IMON_DISPLAY_TYPE_NONE) {
2069 display_ep_found = false;
2070 dev_dbg(ictx->dev, "%s: device has no display\n", __func__);
2071 }
2072
2073
2074
2075
2076
2077 if (ictx->display_type == IMON_DISPLAY_TYPE_VGA) {
2078 display_ep_found = false;
2079 dev_dbg(ictx->dev, "%s: iMON Touch device found\n", __func__);
2080 }
2081
2082
2083 if (!ir_ep_found)
2084 pr_err("no valid input (IR) endpoint found\n");
2085
2086 ictx->tx_control = tx_control;
2087
2088 if (display_ep_found)
2089 ictx->display_supported = true;
2090
2091 return ir_ep_found;
2092
2093}
2094
2095static struct imon_context *imon_init_intf0(struct usb_interface *intf,
2096 const struct usb_device_id *id)
2097{
2098 struct imon_context *ictx;
2099 struct urb *rx_urb;
2100 struct urb *tx_urb;
2101 struct device *dev = &intf->dev;
2102 struct usb_host_interface *iface_desc;
2103 int ret = -ENOMEM;
2104
2105 ictx = kzalloc(sizeof(struct imon_context), GFP_KERNEL);
2106 if (!ictx) {
2107 dev_err(dev, "%s: kzalloc failed for context", __func__);
2108 goto exit;
2109 }
2110 rx_urb = usb_alloc_urb(0, GFP_KERNEL);
2111 if (!rx_urb) {
2112 dev_err(dev, "%s: usb_alloc_urb failed for IR urb", __func__);
2113 goto rx_urb_alloc_failed;
2114 }
2115 tx_urb = usb_alloc_urb(0, GFP_KERNEL);
2116 if (!tx_urb) {
2117 dev_err(dev, "%s: usb_alloc_urb failed for display urb",
2118 __func__);
2119 goto tx_urb_alloc_failed;
2120 }
2121
2122 mutex_init(&ictx->lock);
2123 spin_lock_init(&ictx->kc_lock);
2124
2125 mutex_lock(&ictx->lock);
2126
2127 ictx->dev = dev;
2128 ictx->usbdev_intf0 = usb_get_dev(interface_to_usbdev(intf));
2129 ictx->rx_urb_intf0 = rx_urb;
2130 ictx->tx_urb = tx_urb;
2131 ictx->rf_device = false;
2132
2133 ictx->vendor = le16_to_cpu(ictx->usbdev_intf0->descriptor.idVendor);
2134 ictx->product = le16_to_cpu(ictx->usbdev_intf0->descriptor.idProduct);
2135
2136
2137 ictx->send_packet_delay = id->driver_info & IMON_NEED_20MS_PKT_DELAY ?
2138 20 : 5;
2139
2140 ret = -ENODEV;
2141 iface_desc = intf->cur_altsetting;
2142 if (!imon_find_endpoints(ictx, iface_desc)) {
2143 goto find_endpoint_failed;
2144 }
2145
2146 usb_fill_int_urb(ictx->rx_urb_intf0, ictx->usbdev_intf0,
2147 usb_rcvintpipe(ictx->usbdev_intf0,
2148 ictx->rx_endpoint_intf0->bEndpointAddress),
2149 ictx->usb_rx_buf, sizeof(ictx->usb_rx_buf),
2150 usb_rx_callback_intf0, ictx,
2151 ictx->rx_endpoint_intf0->bInterval);
2152
2153 ret = usb_submit_urb(ictx->rx_urb_intf0, GFP_KERNEL);
2154 if (ret) {
2155 pr_err("usb_submit_urb failed for intf0 (%d)\n", ret);
2156 goto urb_submit_failed;
2157 }
2158
2159 ictx->idev = imon_init_idev(ictx);
2160 if (!ictx->idev) {
2161 dev_err(dev, "%s: input device setup failed\n", __func__);
2162 goto idev_setup_failed;
2163 }
2164
2165 ictx->rdev = imon_init_rdev(ictx);
2166 if (!ictx->rdev) {
2167 dev_err(dev, "%s: rc device setup failed\n", __func__);
2168 goto rdev_setup_failed;
2169 }
2170
2171 ictx->dev_present_intf0 = true;
2172
2173 mutex_unlock(&ictx->lock);
2174 return ictx;
2175
2176rdev_setup_failed:
2177 input_unregister_device(ictx->idev);
2178idev_setup_failed:
2179 usb_kill_urb(ictx->rx_urb_intf0);
2180urb_submit_failed:
2181find_endpoint_failed:
2182 mutex_unlock(&ictx->lock);
2183 usb_free_urb(tx_urb);
2184tx_urb_alloc_failed:
2185 usb_free_urb(rx_urb);
2186rx_urb_alloc_failed:
2187 kfree(ictx);
2188exit:
2189 dev_err(dev, "unable to initialize intf0, err %d\n", ret);
2190
2191 return NULL;
2192}
2193
2194static struct imon_context *imon_init_intf1(struct usb_interface *intf,
2195 struct imon_context *ictx)
2196{
2197 struct urb *rx_urb;
2198 struct usb_host_interface *iface_desc;
2199 int ret = -ENOMEM;
2200
2201 rx_urb = usb_alloc_urb(0, GFP_KERNEL);
2202 if (!rx_urb) {
2203 pr_err("usb_alloc_urb failed for IR urb\n");
2204 goto rx_urb_alloc_failed;
2205 }
2206
2207 mutex_lock(&ictx->lock);
2208
2209 if (ictx->display_type == IMON_DISPLAY_TYPE_VGA) {
2210 init_timer(&ictx->ttimer);
2211 ictx->ttimer.data = (unsigned long)ictx;
2212 ictx->ttimer.function = imon_touch_display_timeout;
2213 }
2214
2215 ictx->usbdev_intf1 = usb_get_dev(interface_to_usbdev(intf));
2216 ictx->rx_urb_intf1 = rx_urb;
2217
2218 ret = -ENODEV;
2219 iface_desc = intf->cur_altsetting;
2220 if (!imon_find_endpoints(ictx, iface_desc))
2221 goto find_endpoint_failed;
2222
2223 if (ictx->display_type == IMON_DISPLAY_TYPE_VGA) {
2224 ictx->touch = imon_init_touch(ictx);
2225 if (!ictx->touch)
2226 goto touch_setup_failed;
2227 } else
2228 ictx->touch = NULL;
2229
2230 usb_fill_int_urb(ictx->rx_urb_intf1, ictx->usbdev_intf1,
2231 usb_rcvintpipe(ictx->usbdev_intf1,
2232 ictx->rx_endpoint_intf1->bEndpointAddress),
2233 ictx->usb_rx_buf, sizeof(ictx->usb_rx_buf),
2234 usb_rx_callback_intf1, ictx,
2235 ictx->rx_endpoint_intf1->bInterval);
2236
2237 ret = usb_submit_urb(ictx->rx_urb_intf1, GFP_KERNEL);
2238
2239 if (ret) {
2240 pr_err("usb_submit_urb failed for intf1 (%d)\n", ret);
2241 goto urb_submit_failed;
2242 }
2243
2244 ictx->dev_present_intf1 = true;
2245
2246 mutex_unlock(&ictx->lock);
2247 return ictx;
2248
2249urb_submit_failed:
2250 if (ictx->touch)
2251 input_unregister_device(ictx->touch);
2252touch_setup_failed:
2253find_endpoint_failed:
2254 mutex_unlock(&ictx->lock);
2255 usb_free_urb(rx_urb);
2256rx_urb_alloc_failed:
2257 dev_err(ictx->dev, "unable to initialize intf1, err %d\n", ret);
2258
2259 return NULL;
2260}
2261
2262static void imon_init_display(struct imon_context *ictx,
2263 struct usb_interface *intf)
2264{
2265 int ret;
2266
2267 dev_dbg(ictx->dev, "Registering iMON display with sysfs\n");
2268
2269
2270 ret = sysfs_create_group(&intf->dev.kobj, &imon_display_attr_group);
2271 if (ret)
2272 dev_err(ictx->dev, "Could not create display sysfs "
2273 "entries(%d)", ret);
2274
2275 if (ictx->display_type == IMON_DISPLAY_TYPE_LCD)
2276 ret = usb_register_dev(intf, &imon_lcd_class);
2277 else
2278 ret = usb_register_dev(intf, &imon_vfd_class);
2279 if (ret)
2280
2281 dev_info(ictx->dev, "could not get a minor number for "
2282 "display\n");
2283
2284}
2285
2286
2287
2288
2289static int imon_probe(struct usb_interface *interface,
2290 const struct usb_device_id *id)
2291{
2292 struct usb_device *usbdev = NULL;
2293 struct usb_host_interface *iface_desc = NULL;
2294 struct usb_interface *first_if;
2295 struct device *dev = &interface->dev;
2296 int ifnum, sysfs_err;
2297 int ret = 0;
2298 struct imon_context *ictx = NULL;
2299 struct imon_context *first_if_ctx = NULL;
2300 u16 vendor, product;
2301
2302 usbdev = usb_get_dev(interface_to_usbdev(interface));
2303 iface_desc = interface->cur_altsetting;
2304 ifnum = iface_desc->desc.bInterfaceNumber;
2305 vendor = le16_to_cpu(usbdev->descriptor.idVendor);
2306 product = le16_to_cpu(usbdev->descriptor.idProduct);
2307
2308 dev_dbg(dev, "%s: found iMON device (%04x:%04x, intf%d)\n",
2309 __func__, vendor, product, ifnum);
2310
2311
2312 mutex_lock(&driver_lock);
2313
2314 first_if = usb_ifnum_to_if(usbdev, 0);
2315 first_if_ctx = usb_get_intfdata(first_if);
2316
2317 if (ifnum == 0) {
2318 ictx = imon_init_intf0(interface, id);
2319 if (!ictx) {
2320 pr_err("failed to initialize context!\n");
2321 ret = -ENODEV;
2322 goto fail;
2323 }
2324
2325 } else {
2326
2327
2328
2329 if (!first_if_ctx) {
2330 ret = -ENODEV;
2331 goto fail;
2332 }
2333
2334 ictx = imon_init_intf1(interface, first_if_ctx);
2335 if (!ictx) {
2336 pr_err("failed to attach to context!\n");
2337 ret = -ENODEV;
2338 goto fail;
2339 }
2340
2341 }
2342
2343 usb_set_intfdata(interface, ictx);
2344
2345 if (ifnum == 0) {
2346 mutex_lock(&ictx->lock);
2347
2348 if (product == 0xffdc && ictx->rf_device) {
2349 sysfs_err = sysfs_create_group(&interface->dev.kobj,
2350 &imon_rf_attr_group);
2351 if (sysfs_err)
2352 pr_err("Could not create RF sysfs entries(%d)\n",
2353 sysfs_err);
2354 }
2355
2356 if (ictx->display_supported)
2357 imon_init_display(ictx, interface);
2358
2359 mutex_unlock(&ictx->lock);
2360 }
2361
2362 dev_info(dev, "iMON device (%04x:%04x, intf%d) on "
2363 "usb<%d:%d> initialized\n", vendor, product, ifnum,
2364 usbdev->bus->busnum, usbdev->devnum);
2365
2366 mutex_unlock(&driver_lock);
2367
2368 return 0;
2369
2370fail:
2371 mutex_unlock(&driver_lock);
2372 dev_err(dev, "unable to register, err %d\n", ret);
2373
2374 return ret;
2375}
2376
2377
2378
2379
2380static void imon_disconnect(struct usb_interface *interface)
2381{
2382 struct imon_context *ictx;
2383 struct device *dev;
2384 int ifnum;
2385
2386
2387 mutex_lock(&driver_lock);
2388
2389 ictx = usb_get_intfdata(interface);
2390 dev = ictx->dev;
2391 ifnum = interface->cur_altsetting->desc.bInterfaceNumber;
2392
2393
2394
2395
2396
2397 sysfs_remove_group(&interface->dev.kobj, &imon_display_attr_group);
2398 sysfs_remove_group(&interface->dev.kobj, &imon_rf_attr_group);
2399
2400 usb_set_intfdata(interface, NULL);
2401
2402
2403 if (ictx->tx.busy) {
2404 usb_kill_urb(ictx->tx_urb);
2405 complete_all(&ictx->tx.finished);
2406 }
2407
2408 if (ifnum == 0) {
2409 ictx->dev_present_intf0 = false;
2410 usb_kill_urb(ictx->rx_urb_intf0);
2411 input_unregister_device(ictx->idev);
2412 rc_unregister_device(ictx->rdev);
2413 if (ictx->display_supported) {
2414 if (ictx->display_type == IMON_DISPLAY_TYPE_LCD)
2415 usb_deregister_dev(interface, &imon_lcd_class);
2416 else if (ictx->display_type == IMON_DISPLAY_TYPE_VFD)
2417 usb_deregister_dev(interface, &imon_vfd_class);
2418 }
2419 } else {
2420 ictx->dev_present_intf1 = false;
2421 usb_kill_urb(ictx->rx_urb_intf1);
2422 if (ictx->display_type == IMON_DISPLAY_TYPE_VGA) {
2423 input_unregister_device(ictx->touch);
2424 del_timer_sync(&ictx->ttimer);
2425 }
2426 }
2427
2428 if (!ictx->dev_present_intf0 && !ictx->dev_present_intf1)
2429 free_imon_context(ictx);
2430
2431 mutex_unlock(&driver_lock);
2432
2433 dev_dbg(dev, "%s: iMON device (intf%d) disconnected\n",
2434 __func__, ifnum);
2435}
2436
2437static int imon_suspend(struct usb_interface *intf, pm_message_t message)
2438{
2439 struct imon_context *ictx = usb_get_intfdata(intf);
2440 int ifnum = intf->cur_altsetting->desc.bInterfaceNumber;
2441
2442 if (ifnum == 0)
2443 usb_kill_urb(ictx->rx_urb_intf0);
2444 else
2445 usb_kill_urb(ictx->rx_urb_intf1);
2446
2447 return 0;
2448}
2449
2450static int imon_resume(struct usb_interface *intf)
2451{
2452 int rc = 0;
2453 struct imon_context *ictx = usb_get_intfdata(intf);
2454 int ifnum = intf->cur_altsetting->desc.bInterfaceNumber;
2455
2456 if (ifnum == 0) {
2457 usb_fill_int_urb(ictx->rx_urb_intf0, ictx->usbdev_intf0,
2458 usb_rcvintpipe(ictx->usbdev_intf0,
2459 ictx->rx_endpoint_intf0->bEndpointAddress),
2460 ictx->usb_rx_buf, sizeof(ictx->usb_rx_buf),
2461 usb_rx_callback_intf0, ictx,
2462 ictx->rx_endpoint_intf0->bInterval);
2463
2464 rc = usb_submit_urb(ictx->rx_urb_intf0, GFP_ATOMIC);
2465
2466 } else {
2467 usb_fill_int_urb(ictx->rx_urb_intf1, ictx->usbdev_intf1,
2468 usb_rcvintpipe(ictx->usbdev_intf1,
2469 ictx->rx_endpoint_intf1->bEndpointAddress),
2470 ictx->usb_rx_buf, sizeof(ictx->usb_rx_buf),
2471 usb_rx_callback_intf1, ictx,
2472 ictx->rx_endpoint_intf1->bInterval);
2473
2474 rc = usb_submit_urb(ictx->rx_urb_intf1, GFP_ATOMIC);
2475 }
2476
2477 return rc;
2478}
2479
2480module_usb_driver(imon_driver);
2481