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