This source file includes following definitions.
- free_imon_context
- display_open
- display_close
- send_packet
- send_associate_24g
- send_set_imon_clock
- show_associate_remote
- store_associate_remote
- show_imon_clock
- store_imon_clock
- vfd_write
- lcd_write
- usb_tx_callback
- imon_touch_display_timeout
- imon_ir_change_protocol
- stabilize
- imon_remote_key_lookup
- imon_mce_key_lookup
- imon_panel_key_lookup
- imon_mouse_event
- imon_touch_event
- imon_pad_to_keys
- imon_parse_press_type
- imon_incoming_packet
- usb_rx_callback_intf0
- usb_rx_callback_intf1
- imon_get_ffdc_type
- imon_set_display_type
- imon_init_rdev
- imon_init_idev
- imon_init_touch
- imon_find_endpoints
- imon_init_intf0
- imon_init_intf1
- imon_init_display
- imon_probe
- imon_disconnect
- imon_suspend
- imon_resume
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
52 static int imon_probe(struct usb_interface *interface,
53 const struct usb_device_id *id);
54 static void imon_disconnect(struct usb_interface *interface);
55 static void usb_rx_callback_intf0(struct urb *urb);
56 static void usb_rx_callback_intf1(struct urb *urb);
57 static void usb_tx_callback(struct urb *urb);
58
59
60 static int imon_resume(struct usb_interface *intf);
61 static int imon_suspend(struct usb_interface *intf, pm_message_t message);
62
63
64 static int display_open(struct inode *inode, struct file *file);
65 static int display_close(struct inode *inode, struct file *file);
66
67
68 static ssize_t vfd_write(struct file *file, const char __user *buf,
69 size_t n_bytes, loff_t *pos);
70
71
72 static ssize_t lcd_write(struct file *file, const char __user *buf,
73 size_t n_bytes, loff_t *pos);
74
75
76
77 struct imon_panel_key_table {
78 u64 hw_code;
79 u32 keycode;
80 };
81
82 struct 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
89 struct 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
159 static 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
168 static 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
176 enum {
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
184 enum {
185 IMON_KEY_IMON = 0,
186 IMON_KEY_MCE = 1,
187 IMON_KEY_PANEL = 2,
188 };
189
190 static struct usb_class_driver imon_vfd_class = {
191 .name = DEVICE_NAME,
192 .fops = &vfd_fops,
193 .minor_base = DISPLAY_MINOR_BASE,
194 };
195
196 static struct usb_class_driver imon_lcd_class = {
197 .name = DEVICE_NAME,
198 .fops = &lcd_fops,
199 .minor_base = DISPLAY_MINOR_BASE,
200 };
201
202
203 static 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
252 static 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
298 static 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
329 static 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
405 static 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
415 static DEFINE_MUTEX(driver_lock);
416
417
418 MODULE_AUTHOR(MOD_AUTHOR);
419 MODULE_DESCRIPTION(MOD_DESC);
420 MODULE_VERSION(MOD_VERSION);
421 MODULE_LICENSE("GPL");
422 MODULE_DEVICE_TABLE(usb, imon_usb_id_table);
423
424 static bool debug;
425 module_param(debug, bool, S_IRUGO | S_IWUSR);
426 MODULE_PARM_DESC(debug, "Debug messages: 0=no, 1=yes (default: no)");
427
428
429 static int display_type;
430 module_param(display_type, int, S_IRUGO);
431 MODULE_PARM_DESC(display_type, "Type of attached display. 0=autodetect, 1=vfd, 2=lcd, 3=vga, 4=none (default: autodetect)");
432
433 static int pad_stabilize = 1;
434 module_param(pad_stabilize, int, S_IRUGO | S_IWUSR);
435 MODULE_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
441 static bool nomouse;
442 module_param(nomouse, bool, S_IRUGO | S_IWUSR);
443 MODULE_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
446 static int pad_thresh;
447 module_param(pad_thresh, int, S_IRUGO | S_IWUSR);
448 MODULE_PARM_DESC(pad_thresh, "Threshold at which a pad push registers as an arrow key in kbd mode (default: 28)");
449
450
451 static 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
467 static 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
508 exit:
509 mutex_unlock(&driver_lock);
510 return retval;
511 }
512
513
514
515
516
517 static 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
551 static 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
643 static 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
672 static 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
755 static 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
775 static 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
797 static 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
823 static 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;
863 exit:
864 mutex_unlock(&ictx->lock);
865
866 return retval;
867 }
868
869
870 static DEVICE_ATTR(imon_clock, S_IWUSR | S_IRUGO, show_imon_clock,
871 store_imon_clock);
872
873 static DEVICE_ATTR(associate_remote, S_IWUSR | S_IRUGO, show_associate_remote,
874 store_associate_remote);
875
876 static struct attribute *imon_display_sysfs_entries[] = {
877 &dev_attr_imon_clock.attr,
878 NULL
879 };
880
881 static const struct attribute_group imon_display_attr_group = {
882 .attrs = imon_display_sysfs_entries
883 };
884
885 static struct attribute *imon_rf_sysfs_entries[] = {
886 &dev_attr_associate_remote.attr,
887 NULL
888 };
889
890 static 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
905 static 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
973 exit:
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
992 static 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 }
1032 exit:
1033 mutex_unlock(&ictx->lock);
1034 return (!retval) ? n_bytes : retval;
1035 }
1036
1037
1038
1039
1040 static 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
1061 static 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
1088 static 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
1132 out:
1133 if (unlock)
1134 mutex_unlock(&ictx->lock);
1135
1136 return retval;
1137 }
1138
1139
1140
1141
1142
1143
1144
1145
1146
1147 static 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
1214 static 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
1238 static 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
1265 static 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
1281 static 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
1346 static 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
1357 static 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
1496 static 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
1543 static 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->touch && len == 8 && buf[7] == 0x86) {
1602 imon_touch_event(ictx, buf);
1603 return;
1604
1605
1606 } else if (ictx->pad_mouse) {
1607 if (imon_mouse_event(ictx, buf, len))
1608 return;
1609 }
1610
1611
1612 if (((len == 5) && (buf[0] == 0x01) && (buf[4] == 0x00)) ||
1613 ((len == 8) && (buf[0] & 0x40) &&
1614 !(buf[1] & 0x1 || buf[1] >> 2 & 0x1))) {
1615 len = 8;
1616 imon_pad_to_keys(ictx, buf);
1617 }
1618
1619 if (debug) {
1620 printk(KERN_INFO "intf%d decoded packet: %*ph\n",
1621 intf, len, buf);
1622 }
1623
1624 press_type = imon_parse_press_type(ictx, buf, ktype);
1625 if (press_type < 0)
1626 goto not_input_data;
1627
1628 if (ktype != IMON_KEY_PANEL) {
1629 if (press_type == 0)
1630 rc_keyup(ictx->rdev);
1631 else {
1632 enum rc_proto proto;
1633
1634 if (ictx->rc_proto == RC_PROTO_BIT_RC6_MCE)
1635 proto = RC_PROTO_RC6_MCE;
1636 else if (ictx->rc_proto == RC_PROTO_BIT_IMON)
1637 proto = RC_PROTO_IMON;
1638 else
1639 return;
1640
1641 rc_keydown(ictx->rdev, proto, ictx->rc_scancode,
1642 ictx->rc_toggle);
1643
1644 spin_lock_irqsave(&ictx->kc_lock, flags);
1645 ictx->last_keycode = ictx->kc;
1646 spin_unlock_irqrestore(&ictx->kc_lock, flags);
1647 }
1648 return;
1649 }
1650
1651
1652 spin_lock_irqsave(&ictx->kc_lock, flags);
1653
1654 t = ktime_get();
1655
1656 if (ictx->kc == KEY_MUTE && ictx->kc == ictx->last_keycode) {
1657 msec = ktime_ms_delta(t, prev_time);
1658 if (msec < ictx->idev->rep[REP_DELAY]) {
1659 spin_unlock_irqrestore(&ictx->kc_lock, flags);
1660 return;
1661 }
1662 }
1663 prev_time = t;
1664 kc = ictx->kc;
1665
1666 spin_unlock_irqrestore(&ictx->kc_lock, flags);
1667
1668 input_report_key(ictx->idev, kc, press_type);
1669 input_sync(ictx->idev);
1670
1671
1672 input_report_key(ictx->idev, kc, 0);
1673 input_sync(ictx->idev);
1674
1675 spin_lock_irqsave(&ictx->kc_lock, flags);
1676 ictx->last_keycode = kc;
1677 spin_unlock_irqrestore(&ictx->kc_lock, flags);
1678
1679 return;
1680
1681 not_input_data:
1682 if (len != 8) {
1683 dev_warn(dev, "imon %s: invalid incoming packet size (len = %d, intf%d)\n",
1684 __func__, len, intf);
1685 return;
1686 }
1687
1688
1689 if (buf[0] == 0x00 &&
1690 buf[2] == 0xFF &&
1691 buf[3] == 0xFF &&
1692 buf[4] == 0xFF &&
1693 buf[5] == 0xFF &&
1694 ((buf[6] == 0x4E && buf[7] == 0xDF) ||
1695 (buf[6] == 0x5E && buf[7] == 0xDF))) {
1696 dev_warn(dev, "%s: remote associated refid=%02X\n",
1697 __func__, buf[1]);
1698 ictx->rf_isassociating = false;
1699 }
1700 }
1701
1702
1703
1704
1705 static void usb_rx_callback_intf0(struct urb *urb)
1706 {
1707 struct imon_context *ictx;
1708 int intfnum = 0;
1709
1710 if (!urb)
1711 return;
1712
1713 ictx = (struct imon_context *)urb->context;
1714 if (!ictx)
1715 return;
1716
1717
1718
1719
1720
1721
1722 if (!ictx->dev_present_intf0)
1723 goto out;
1724
1725 switch (urb->status) {
1726 case -ENOENT:
1727 return;
1728
1729 case -ESHUTDOWN:
1730 break;
1731
1732 case 0:
1733 imon_incoming_packet(ictx, urb, intfnum);
1734 break;
1735
1736 default:
1737 dev_warn(ictx->dev, "imon %s: status(%d): ignored\n",
1738 __func__, urb->status);
1739 break;
1740 }
1741
1742 out:
1743 usb_submit_urb(ictx->rx_urb_intf0, GFP_ATOMIC);
1744 }
1745
1746 static void usb_rx_callback_intf1(struct urb *urb)
1747 {
1748 struct imon_context *ictx;
1749 int intfnum = 1;
1750
1751 if (!urb)
1752 return;
1753
1754 ictx = (struct imon_context *)urb->context;
1755 if (!ictx)
1756 return;
1757
1758
1759
1760
1761
1762
1763 if (!ictx->dev_present_intf1)
1764 goto out;
1765
1766 switch (urb->status) {
1767 case -ENOENT:
1768 return;
1769
1770 case -ESHUTDOWN:
1771 break;
1772
1773 case 0:
1774 imon_incoming_packet(ictx, urb, intfnum);
1775 break;
1776
1777 default:
1778 dev_warn(ictx->dev, "imon %s: status(%d): ignored\n",
1779 __func__, urb->status);
1780 break;
1781 }
1782
1783 out:
1784 usb_submit_urb(ictx->rx_urb_intf1, GFP_ATOMIC);
1785 }
1786
1787
1788
1789
1790
1791
1792
1793
1794
1795
1796 static void imon_get_ffdc_type(struct imon_context *ictx)
1797 {
1798 u8 ffdc_cfg_byte = ictx->usb_rx_buf[6];
1799 u8 detected_display_type = IMON_DISPLAY_TYPE_NONE;
1800 u64 allowed_protos = RC_PROTO_BIT_IMON;
1801
1802 switch (ffdc_cfg_byte) {
1803
1804 case 0x21:
1805 dev_info(ictx->dev, "0xffdc iMON Knob, iMON IR");
1806 ictx->display_supported = false;
1807 break;
1808
1809 case 0x4e:
1810 dev_info(ictx->dev, "0xffdc iMON 2.4G LT, iMON RF");
1811 ictx->display_supported = false;
1812 ictx->rf_device = true;
1813 break;
1814
1815 case 0x35:
1816 dev_info(ictx->dev, "0xffdc iMON VFD + knob, no IR");
1817 detected_display_type = IMON_DISPLAY_TYPE_VFD;
1818 break;
1819
1820 case 0x24:
1821 case 0x30:
1822 case 0x85:
1823 dev_info(ictx->dev, "0xffdc iMON VFD, iMON IR");
1824 detected_display_type = IMON_DISPLAY_TYPE_VFD;
1825 break;
1826
1827 case 0x46:
1828 case 0x9e:
1829 dev_info(ictx->dev, "0xffdc iMON VFD, MCE IR");
1830 detected_display_type = IMON_DISPLAY_TYPE_VFD;
1831 allowed_protos = RC_PROTO_BIT_RC6_MCE;
1832 break;
1833
1834 case 0x7e:
1835 dev_info(ictx->dev, "0xffdc iMON VFD, iMON or MCE IR");
1836 detected_display_type = IMON_DISPLAY_TYPE_VFD;
1837 allowed_protos |= RC_PROTO_BIT_RC6_MCE;
1838 break;
1839
1840 case 0x9f:
1841 dev_info(ictx->dev, "0xffdc iMON LCD, MCE IR");
1842 detected_display_type = IMON_DISPLAY_TYPE_LCD;
1843 allowed_protos = RC_PROTO_BIT_RC6_MCE;
1844 break;
1845
1846 case 0x26:
1847 dev_info(ictx->dev, "0xffdc iMON Inside, iMON IR");
1848 ictx->display_supported = false;
1849 break;
1850 default:
1851 dev_info(ictx->dev, "Unknown 0xffdc device, defaulting to VFD and iMON IR");
1852 detected_display_type = IMON_DISPLAY_TYPE_VFD;
1853
1854
1855
1856
1857 allowed_protos |= RC_PROTO_BIT_RC6_MCE;
1858 break;
1859 }
1860
1861 printk(KERN_CONT " (id 0x%02x)\n", ffdc_cfg_byte);
1862
1863 ictx->display_type = detected_display_type;
1864 ictx->rc_proto = allowed_protos;
1865 }
1866
1867 static void imon_set_display_type(struct imon_context *ictx)
1868 {
1869 u8 configured_display_type = IMON_DISPLAY_TYPE_VFD;
1870
1871
1872
1873
1874
1875
1876 if (display_type == IMON_DISPLAY_TYPE_AUTO) {
1877 switch (ictx->product) {
1878 case 0xffdc:
1879
1880 configured_display_type = ictx->display_type;
1881 break;
1882 case 0x0034:
1883 case 0x0035:
1884 configured_display_type = IMON_DISPLAY_TYPE_VGA;
1885 break;
1886 case 0x0038:
1887 case 0x0039:
1888 case 0x0045:
1889 configured_display_type = IMON_DISPLAY_TYPE_LCD;
1890 break;
1891 case 0x003c:
1892 case 0x0041:
1893 case 0x0042:
1894 case 0x0043:
1895 configured_display_type = IMON_DISPLAY_TYPE_NONE;
1896 ictx->display_supported = false;
1897 break;
1898 case 0x0036:
1899 case 0x0044:
1900 default:
1901 configured_display_type = IMON_DISPLAY_TYPE_VFD;
1902 break;
1903 }
1904 } else {
1905 configured_display_type = display_type;
1906 if (display_type == IMON_DISPLAY_TYPE_NONE)
1907 ictx->display_supported = false;
1908 else
1909 ictx->display_supported = true;
1910 dev_info(ictx->dev, "%s: overriding display type to %d via modparam\n",
1911 __func__, display_type);
1912 }
1913
1914 ictx->display_type = configured_display_type;
1915 }
1916
1917 static struct rc_dev *imon_init_rdev(struct imon_context *ictx)
1918 {
1919 struct rc_dev *rdev;
1920 int ret;
1921 static const unsigned char fp_packet[] = {
1922 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x88 };
1923
1924 rdev = rc_allocate_device(RC_DRIVER_SCANCODE);
1925 if (!rdev) {
1926 dev_err(ictx->dev, "remote control dev allocation failed\n");
1927 goto out;
1928 }
1929
1930 snprintf(ictx->name_rdev, sizeof(ictx->name_rdev),
1931 "iMON Remote (%04x:%04x)", ictx->vendor, ictx->product);
1932 usb_make_path(ictx->usbdev_intf0, ictx->phys_rdev,
1933 sizeof(ictx->phys_rdev));
1934 strlcat(ictx->phys_rdev, "/input0", sizeof(ictx->phys_rdev));
1935
1936 rdev->device_name = ictx->name_rdev;
1937 rdev->input_phys = ictx->phys_rdev;
1938 usb_to_input_id(ictx->usbdev_intf0, &rdev->input_id);
1939 rdev->dev.parent = ictx->dev;
1940
1941 rdev->priv = ictx;
1942
1943 rdev->allowed_protocols = RC_PROTO_BIT_IMON | RC_PROTO_BIT_RC6_MCE;
1944 rdev->change_protocol = imon_ir_change_protocol;
1945 rdev->driver_name = MOD_NAME;
1946
1947
1948 memcpy(ictx->usb_tx_buf, &fp_packet, sizeof(fp_packet));
1949 ret = send_packet(ictx);
1950
1951 if (ret)
1952 dev_info(ictx->dev, "panel buttons/knobs setup failed\n");
1953
1954 if (ictx->product == 0xffdc) {
1955 imon_get_ffdc_type(ictx);
1956 rdev->allowed_protocols = ictx->rc_proto;
1957 }
1958
1959 imon_set_display_type(ictx);
1960
1961 if (ictx->rc_proto == RC_PROTO_BIT_RC6_MCE)
1962 rdev->map_name = RC_MAP_IMON_MCE;
1963 else
1964 rdev->map_name = RC_MAP_IMON_PAD;
1965
1966 ret = rc_register_device(rdev);
1967 if (ret < 0) {
1968 dev_err(ictx->dev, "remote input dev register failed\n");
1969 goto out;
1970 }
1971
1972 return rdev;
1973
1974 out:
1975 rc_free_device(rdev);
1976 return NULL;
1977 }
1978
1979 static struct input_dev *imon_init_idev(struct imon_context *ictx)
1980 {
1981 struct imon_panel_key_table *key_table = ictx->dev_descr->key_table;
1982 struct input_dev *idev;
1983 int ret, i;
1984
1985 idev = input_allocate_device();
1986 if (!idev)
1987 goto out;
1988
1989 snprintf(ictx->name_idev, sizeof(ictx->name_idev),
1990 "iMON Panel, Knob and Mouse(%04x:%04x)",
1991 ictx->vendor, ictx->product);
1992 idev->name = ictx->name_idev;
1993
1994 usb_make_path(ictx->usbdev_intf0, ictx->phys_idev,
1995 sizeof(ictx->phys_idev));
1996 strlcat(ictx->phys_idev, "/input1", sizeof(ictx->phys_idev));
1997 idev->phys = ictx->phys_idev;
1998
1999 idev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REP) | BIT_MASK(EV_REL);
2000
2001 idev->keybit[BIT_WORD(BTN_MOUSE)] =
2002 BIT_MASK(BTN_LEFT) | BIT_MASK(BTN_RIGHT);
2003 idev->relbit[0] = BIT_MASK(REL_X) | BIT_MASK(REL_Y) |
2004 BIT_MASK(REL_WHEEL);
2005
2006
2007 for (i = 0; key_table[i].hw_code != 0; i++) {
2008 u32 kc = key_table[i].keycode;
2009 __set_bit(kc, idev->keybit);
2010 }
2011
2012 usb_to_input_id(ictx->usbdev_intf0, &idev->id);
2013 idev->dev.parent = ictx->dev;
2014 input_set_drvdata(idev, ictx);
2015
2016 ret = input_register_device(idev);
2017 if (ret < 0) {
2018 dev_err(ictx->dev, "input dev register failed\n");
2019 goto out;
2020 }
2021
2022 return idev;
2023
2024 out:
2025 input_free_device(idev);
2026 return NULL;
2027 }
2028
2029 static struct input_dev *imon_init_touch(struct imon_context *ictx)
2030 {
2031 struct input_dev *touch;
2032 int ret;
2033
2034 touch = input_allocate_device();
2035 if (!touch)
2036 goto touch_alloc_failed;
2037
2038 snprintf(ictx->name_touch, sizeof(ictx->name_touch),
2039 "iMON USB Touchscreen (%04x:%04x)",
2040 ictx->vendor, ictx->product);
2041 touch->name = ictx->name_touch;
2042
2043 usb_make_path(ictx->usbdev_intf1, ictx->phys_touch,
2044 sizeof(ictx->phys_touch));
2045 strlcat(ictx->phys_touch, "/input2", sizeof(ictx->phys_touch));
2046 touch->phys = ictx->phys_touch;
2047
2048 touch->evbit[0] =
2049 BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS);
2050 touch->keybit[BIT_WORD(BTN_TOUCH)] =
2051 BIT_MASK(BTN_TOUCH);
2052 input_set_abs_params(touch, ABS_X,
2053 0x00, 0xfff, 0, 0);
2054 input_set_abs_params(touch, ABS_Y,
2055 0x00, 0xfff, 0, 0);
2056
2057 input_set_drvdata(touch, ictx);
2058
2059 usb_to_input_id(ictx->usbdev_intf1, &touch->id);
2060 touch->dev.parent = ictx->dev;
2061 ret = input_register_device(touch);
2062 if (ret < 0) {
2063 dev_info(ictx->dev, "touchscreen input dev register failed\n");
2064 goto touch_register_failed;
2065 }
2066
2067 return touch;
2068
2069 touch_register_failed:
2070 input_free_device(touch);
2071
2072 touch_alloc_failed:
2073 return NULL;
2074 }
2075
2076 static bool imon_find_endpoints(struct imon_context *ictx,
2077 struct usb_host_interface *iface_desc)
2078 {
2079 struct usb_endpoint_descriptor *ep;
2080 struct usb_endpoint_descriptor *rx_endpoint = NULL;
2081 struct usb_endpoint_descriptor *tx_endpoint = NULL;
2082 int ifnum = iface_desc->desc.bInterfaceNumber;
2083 int num_endpts = iface_desc->desc.bNumEndpoints;
2084 int i, ep_dir, ep_type;
2085 bool ir_ep_found = false;
2086 bool display_ep_found = false;
2087 bool tx_control = false;
2088
2089
2090
2091
2092
2093
2094 for (i = 0; i < num_endpts && !(ir_ep_found && display_ep_found); ++i) {
2095 ep = &iface_desc->endpoint[i].desc;
2096 ep_dir = ep->bEndpointAddress & USB_ENDPOINT_DIR_MASK;
2097 ep_type = usb_endpoint_type(ep);
2098
2099 if (!ir_ep_found && ep_dir == USB_DIR_IN &&
2100 ep_type == USB_ENDPOINT_XFER_INT) {
2101
2102 rx_endpoint = ep;
2103 ir_ep_found = true;
2104 dev_dbg(ictx->dev, "%s: found IR endpoint\n", __func__);
2105
2106 } else if (!display_ep_found && ep_dir == USB_DIR_OUT &&
2107 ep_type == USB_ENDPOINT_XFER_INT) {
2108 tx_endpoint = ep;
2109 display_ep_found = true;
2110 dev_dbg(ictx->dev, "%s: found display endpoint\n", __func__);
2111 }
2112 }
2113
2114 if (ifnum == 0) {
2115 ictx->rx_endpoint_intf0 = rx_endpoint;
2116
2117
2118
2119
2120 ictx->tx_endpoint = tx_endpoint;
2121 } else {
2122 ictx->rx_endpoint_intf1 = rx_endpoint;
2123 }
2124
2125
2126
2127
2128
2129 if (!display_ep_found) {
2130 tx_control = true;
2131 display_ep_found = true;
2132 dev_dbg(ictx->dev, "%s: device uses control endpoint, not interface OUT endpoint\n",
2133 __func__);
2134 }
2135
2136
2137
2138
2139
2140
2141 if (ictx->display_type == IMON_DISPLAY_TYPE_NONE) {
2142 display_ep_found = false;
2143 dev_dbg(ictx->dev, "%s: device has no display\n", __func__);
2144 }
2145
2146
2147
2148
2149
2150 if (ictx->display_type == IMON_DISPLAY_TYPE_VGA) {
2151 display_ep_found = false;
2152 dev_dbg(ictx->dev, "%s: iMON Touch device found\n", __func__);
2153 }
2154
2155
2156 if (!ir_ep_found)
2157 pr_err("no valid input (IR) endpoint found\n");
2158
2159 ictx->tx_control = tx_control;
2160
2161 if (display_ep_found)
2162 ictx->display_supported = true;
2163
2164 return ir_ep_found;
2165
2166 }
2167
2168 static struct imon_context *imon_init_intf0(struct usb_interface *intf,
2169 const struct usb_device_id *id)
2170 {
2171 struct imon_context *ictx;
2172 struct urb *rx_urb;
2173 struct urb *tx_urb;
2174 struct device *dev = &intf->dev;
2175 struct usb_host_interface *iface_desc;
2176 int ret = -ENOMEM;
2177
2178 ictx = kzalloc(sizeof(*ictx), GFP_KERNEL);
2179 if (!ictx)
2180 goto exit;
2181
2182 rx_urb = usb_alloc_urb(0, GFP_KERNEL);
2183 if (!rx_urb)
2184 goto rx_urb_alloc_failed;
2185 tx_urb = usb_alloc_urb(0, GFP_KERNEL);
2186 if (!tx_urb)
2187 goto tx_urb_alloc_failed;
2188
2189 mutex_init(&ictx->lock);
2190 spin_lock_init(&ictx->kc_lock);
2191
2192 mutex_lock(&ictx->lock);
2193
2194 ictx->dev = dev;
2195 ictx->usbdev_intf0 = usb_get_dev(interface_to_usbdev(intf));
2196 ictx->rx_urb_intf0 = rx_urb;
2197 ictx->tx_urb = tx_urb;
2198 ictx->rf_device = false;
2199
2200 init_completion(&ictx->tx.finished);
2201
2202 ictx->vendor = le16_to_cpu(ictx->usbdev_intf0->descriptor.idVendor);
2203 ictx->product = le16_to_cpu(ictx->usbdev_intf0->descriptor.idProduct);
2204
2205
2206 ictx->dev_descr = (struct imon_usb_dev_descr *)id->driver_info;
2207
2208 ictx->send_packet_delay = ictx->dev_descr->flags &
2209 IMON_NEED_20MS_PKT_DELAY ? 20 : 5;
2210
2211 ret = -ENODEV;
2212 iface_desc = intf->cur_altsetting;
2213 if (!imon_find_endpoints(ictx, iface_desc)) {
2214 goto find_endpoint_failed;
2215 }
2216
2217 usb_fill_int_urb(ictx->rx_urb_intf0, ictx->usbdev_intf0,
2218 usb_rcvintpipe(ictx->usbdev_intf0,
2219 ictx->rx_endpoint_intf0->bEndpointAddress),
2220 ictx->usb_rx_buf, sizeof(ictx->usb_rx_buf),
2221 usb_rx_callback_intf0, ictx,
2222 ictx->rx_endpoint_intf0->bInterval);
2223
2224 ret = usb_submit_urb(ictx->rx_urb_intf0, GFP_KERNEL);
2225 if (ret) {
2226 pr_err("usb_submit_urb failed for intf0 (%d)\n", ret);
2227 goto urb_submit_failed;
2228 }
2229
2230 ictx->idev = imon_init_idev(ictx);
2231 if (!ictx->idev) {
2232 dev_err(dev, "%s: input device setup failed\n", __func__);
2233 goto idev_setup_failed;
2234 }
2235
2236 ictx->rdev = imon_init_rdev(ictx);
2237 if (!ictx->rdev) {
2238 dev_err(dev, "%s: rc device setup failed\n", __func__);
2239 goto rdev_setup_failed;
2240 }
2241
2242 ictx->dev_present_intf0 = true;
2243
2244 mutex_unlock(&ictx->lock);
2245 return ictx;
2246
2247 rdev_setup_failed:
2248 input_unregister_device(ictx->idev);
2249 idev_setup_failed:
2250 usb_kill_urb(ictx->rx_urb_intf0);
2251 urb_submit_failed:
2252 find_endpoint_failed:
2253 usb_put_dev(ictx->usbdev_intf0);
2254 mutex_unlock(&ictx->lock);
2255 usb_free_urb(tx_urb);
2256 tx_urb_alloc_failed:
2257 usb_free_urb(rx_urb);
2258 rx_urb_alloc_failed:
2259 kfree(ictx);
2260 exit:
2261 dev_err(dev, "unable to initialize intf0, err %d\n", ret);
2262
2263 return NULL;
2264 }
2265
2266 static struct imon_context *imon_init_intf1(struct usb_interface *intf,
2267 struct imon_context *ictx)
2268 {
2269 struct urb *rx_urb;
2270 struct usb_host_interface *iface_desc;
2271 int ret = -ENOMEM;
2272
2273 rx_urb = usb_alloc_urb(0, GFP_KERNEL);
2274 if (!rx_urb)
2275 goto rx_urb_alloc_failed;
2276
2277 mutex_lock(&ictx->lock);
2278
2279 if (ictx->display_type == IMON_DISPLAY_TYPE_VGA) {
2280 timer_setup(&ictx->ttimer, imon_touch_display_timeout, 0);
2281 }
2282
2283 ictx->usbdev_intf1 = usb_get_dev(interface_to_usbdev(intf));
2284 ictx->rx_urb_intf1 = rx_urb;
2285
2286 ret = -ENODEV;
2287 iface_desc = intf->cur_altsetting;
2288 if (!imon_find_endpoints(ictx, iface_desc))
2289 goto find_endpoint_failed;
2290
2291 if (ictx->display_type == IMON_DISPLAY_TYPE_VGA) {
2292 ictx->touch = imon_init_touch(ictx);
2293 if (!ictx->touch)
2294 goto touch_setup_failed;
2295 } else
2296 ictx->touch = NULL;
2297
2298 usb_fill_int_urb(ictx->rx_urb_intf1, ictx->usbdev_intf1,
2299 usb_rcvintpipe(ictx->usbdev_intf1,
2300 ictx->rx_endpoint_intf1->bEndpointAddress),
2301 ictx->usb_rx_buf, sizeof(ictx->usb_rx_buf),
2302 usb_rx_callback_intf1, ictx,
2303 ictx->rx_endpoint_intf1->bInterval);
2304
2305 ret = usb_submit_urb(ictx->rx_urb_intf1, GFP_KERNEL);
2306
2307 if (ret) {
2308 pr_err("usb_submit_urb failed for intf1 (%d)\n", ret);
2309 goto urb_submit_failed;
2310 }
2311
2312 ictx->dev_present_intf1 = true;
2313
2314 mutex_unlock(&ictx->lock);
2315 return ictx;
2316
2317 urb_submit_failed:
2318 if (ictx->touch)
2319 input_unregister_device(ictx->touch);
2320 touch_setup_failed:
2321 find_endpoint_failed:
2322 usb_put_dev(ictx->usbdev_intf1);
2323 mutex_unlock(&ictx->lock);
2324 usb_free_urb(rx_urb);
2325 rx_urb_alloc_failed:
2326 dev_err(ictx->dev, "unable to initialize intf1, err %d\n", ret);
2327
2328 return NULL;
2329 }
2330
2331 static void imon_init_display(struct imon_context *ictx,
2332 struct usb_interface *intf)
2333 {
2334 int ret;
2335
2336 dev_dbg(ictx->dev, "Registering iMON display with sysfs\n");
2337
2338
2339 ret = sysfs_create_group(&intf->dev.kobj, &imon_display_attr_group);
2340 if (ret)
2341 dev_err(ictx->dev, "Could not create display sysfs entries(%d)",
2342 ret);
2343
2344 if (ictx->display_type == IMON_DISPLAY_TYPE_LCD)
2345 ret = usb_register_dev(intf, &imon_lcd_class);
2346 else
2347 ret = usb_register_dev(intf, &imon_vfd_class);
2348 if (ret)
2349
2350 dev_info(ictx->dev, "could not get a minor number for display\n");
2351
2352 }
2353
2354
2355
2356
2357 static int imon_probe(struct usb_interface *interface,
2358 const struct usb_device_id *id)
2359 {
2360 struct usb_device *usbdev = NULL;
2361 struct usb_host_interface *iface_desc = NULL;
2362 struct usb_interface *first_if;
2363 struct device *dev = &interface->dev;
2364 int ifnum, sysfs_err;
2365 int ret = 0;
2366 struct imon_context *ictx = NULL;
2367 struct imon_context *first_if_ctx = NULL;
2368 u16 vendor, product;
2369
2370 usbdev = usb_get_dev(interface_to_usbdev(interface));
2371 iface_desc = interface->cur_altsetting;
2372 ifnum = iface_desc->desc.bInterfaceNumber;
2373 vendor = le16_to_cpu(usbdev->descriptor.idVendor);
2374 product = le16_to_cpu(usbdev->descriptor.idProduct);
2375
2376 dev_dbg(dev, "%s: found iMON device (%04x:%04x, intf%d)\n",
2377 __func__, vendor, product, ifnum);
2378
2379
2380 mutex_lock(&driver_lock);
2381
2382 first_if = usb_ifnum_to_if(usbdev, 0);
2383 if (!first_if) {
2384 ret = -ENODEV;
2385 goto fail;
2386 }
2387
2388 first_if_ctx = usb_get_intfdata(first_if);
2389
2390 if (ifnum == 0) {
2391 ictx = imon_init_intf0(interface, id);
2392 if (!ictx) {
2393 pr_err("failed to initialize context!\n");
2394 ret = -ENODEV;
2395 goto fail;
2396 }
2397
2398 } else {
2399
2400
2401
2402 if (!first_if_ctx) {
2403 ret = -ENODEV;
2404 goto fail;
2405 }
2406
2407 ictx = imon_init_intf1(interface, first_if_ctx);
2408 if (!ictx) {
2409 pr_err("failed to attach to context!\n");
2410 ret = -ENODEV;
2411 goto fail;
2412 }
2413
2414 }
2415
2416 usb_set_intfdata(interface, ictx);
2417
2418 if (ifnum == 0) {
2419 mutex_lock(&ictx->lock);
2420
2421 if (product == 0xffdc && ictx->rf_device) {
2422 sysfs_err = sysfs_create_group(&interface->dev.kobj,
2423 &imon_rf_attr_group);
2424 if (sysfs_err)
2425 pr_err("Could not create RF sysfs entries(%d)\n",
2426 sysfs_err);
2427 }
2428
2429 if (ictx->display_supported)
2430 imon_init_display(ictx, interface);
2431
2432 mutex_unlock(&ictx->lock);
2433 }
2434
2435 dev_info(dev, "iMON device (%04x:%04x, intf%d) on usb<%d:%d> initialized\n",
2436 vendor, product, ifnum,
2437 usbdev->bus->busnum, usbdev->devnum);
2438
2439 mutex_unlock(&driver_lock);
2440 usb_put_dev(usbdev);
2441
2442 return 0;
2443
2444 fail:
2445 mutex_unlock(&driver_lock);
2446 usb_put_dev(usbdev);
2447 dev_err(dev, "unable to register, err %d\n", ret);
2448
2449 return ret;
2450 }
2451
2452
2453
2454
2455 static void imon_disconnect(struct usb_interface *interface)
2456 {
2457 struct imon_context *ictx;
2458 struct device *dev;
2459 int ifnum;
2460
2461
2462 mutex_lock(&driver_lock);
2463
2464 ictx = usb_get_intfdata(interface);
2465 dev = ictx->dev;
2466 ifnum = interface->cur_altsetting->desc.bInterfaceNumber;
2467
2468
2469
2470
2471
2472 sysfs_remove_group(&interface->dev.kobj, &imon_display_attr_group);
2473 sysfs_remove_group(&interface->dev.kobj, &imon_rf_attr_group);
2474
2475 usb_set_intfdata(interface, NULL);
2476
2477
2478 if (ictx->tx.busy) {
2479 usb_kill_urb(ictx->tx_urb);
2480 complete(&ictx->tx.finished);
2481 }
2482
2483 if (ifnum == 0) {
2484 ictx->dev_present_intf0 = false;
2485 usb_kill_urb(ictx->rx_urb_intf0);
2486 usb_put_dev(ictx->usbdev_intf0);
2487 input_unregister_device(ictx->idev);
2488 rc_unregister_device(ictx->rdev);
2489 if (ictx->display_supported) {
2490 if (ictx->display_type == IMON_DISPLAY_TYPE_LCD)
2491 usb_deregister_dev(interface, &imon_lcd_class);
2492 else if (ictx->display_type == IMON_DISPLAY_TYPE_VFD)
2493 usb_deregister_dev(interface, &imon_vfd_class);
2494 }
2495 } else {
2496 ictx->dev_present_intf1 = false;
2497 usb_kill_urb(ictx->rx_urb_intf1);
2498 usb_put_dev(ictx->usbdev_intf1);
2499 if (ictx->display_type == IMON_DISPLAY_TYPE_VGA) {
2500 input_unregister_device(ictx->touch);
2501 del_timer_sync(&ictx->ttimer);
2502 }
2503 }
2504
2505 if (!ictx->dev_present_intf0 && !ictx->dev_present_intf1)
2506 free_imon_context(ictx);
2507
2508 mutex_unlock(&driver_lock);
2509
2510 dev_dbg(dev, "%s: iMON device (intf%d) disconnected\n",
2511 __func__, ifnum);
2512 }
2513
2514 static int imon_suspend(struct usb_interface *intf, pm_message_t message)
2515 {
2516 struct imon_context *ictx = usb_get_intfdata(intf);
2517 int ifnum = intf->cur_altsetting->desc.bInterfaceNumber;
2518
2519 if (ifnum == 0)
2520 usb_kill_urb(ictx->rx_urb_intf0);
2521 else
2522 usb_kill_urb(ictx->rx_urb_intf1);
2523
2524 return 0;
2525 }
2526
2527 static int imon_resume(struct usb_interface *intf)
2528 {
2529 int rc = 0;
2530 struct imon_context *ictx = usb_get_intfdata(intf);
2531 int ifnum = intf->cur_altsetting->desc.bInterfaceNumber;
2532
2533 if (ifnum == 0) {
2534 usb_fill_int_urb(ictx->rx_urb_intf0, ictx->usbdev_intf0,
2535 usb_rcvintpipe(ictx->usbdev_intf0,
2536 ictx->rx_endpoint_intf0->bEndpointAddress),
2537 ictx->usb_rx_buf, sizeof(ictx->usb_rx_buf),
2538 usb_rx_callback_intf0, ictx,
2539 ictx->rx_endpoint_intf0->bInterval);
2540
2541 rc = usb_submit_urb(ictx->rx_urb_intf0, GFP_ATOMIC);
2542
2543 } else {
2544 usb_fill_int_urb(ictx->rx_urb_intf1, ictx->usbdev_intf1,
2545 usb_rcvintpipe(ictx->usbdev_intf1,
2546 ictx->rx_endpoint_intf1->bEndpointAddress),
2547 ictx->usb_rx_buf, sizeof(ictx->usb_rx_buf),
2548 usb_rx_callback_intf1, ictx,
2549 ictx->rx_endpoint_intf1->bInterval);
2550
2551 rc = usb_submit_urb(ictx->rx_urb_intf1, GFP_ATOMIC);
2552 }
2553
2554 return rc;
2555 }
2556
2557 module_usb_driver(imon_driver);