xref: /openbmc/linux/drivers/media/rc/imon.c (revision f2f4bf5a)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  *   imon.c:	input and display driver for SoundGraph iMON IR/VFD/LCD
4  *
5  *   Copyright(C) 2010  Jarod Wilson <jarod@wilsonet.com>
6  *   Portions based on the original lirc_imon driver,
7  *	Copyright(C) 2004  Venky Raju(dev@venky.ws)
8  *
9  *   Huge thanks to R. Geoff Newbury for invaluable debugging on the
10  *   0xffdc iMON devices, and for sending me one to hack on, without
11  *   which the support for them wouldn't be nearly as good. Thanks
12  *   also to the numerous 0xffdc device owners that tested auto-config
13  *   support for me and provided debug dumps from their devices.
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	/* each bit received is 250us */
46 
47 #define IMON_CLOCK_ENABLE_PACKETS	2
48 
49 /*** P R O T O T Y P E S ***/
50 
51 /* USB Callback prototypes */
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 /* suspend/resume support */
60 static int imon_resume(struct usb_interface *intf);
61 static int imon_suspend(struct usb_interface *intf, pm_message_t message);
62 
63 /* Display file_operations function prototypes */
64 static int display_open(struct inode *inode, struct file *file);
65 static int display_close(struct inode *inode, struct file *file);
66 
67 /* VFD write operation */
68 static ssize_t vfd_write(struct file *file, const char __user *buf,
69 			 size_t n_bytes, loff_t *pos);
70 
71 /* LCD file_operations override function prototypes */
72 static ssize_t lcd_write(struct file *file, const char __user *buf,
73 			 size_t n_bytes, loff_t *pos);
74 
75 /*** G L O B A L S ***/
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 	/* Newer devices have two interfaces */
92 	struct usb_device *usbdev_intf0;
93 	struct usb_device *usbdev_intf1;
94 
95 	bool display_supported;		/* not all controllers do */
96 	bool display_isopen;		/* display port has been opened */
97 	bool rf_device;			/* true if iMON 2.4G LT/DT RF device */
98 	bool rf_isassociating;		/* RF remote associating */
99 	bool dev_present_intf0;		/* USB device presence, interface 0 */
100 	bool dev_present_intf1;		/* USB device presence, interface 1 */
101 
102 	struct mutex lock;		/* to lock this object */
103 	wait_queue_head_t remove_ok;	/* For unexpected USB disconnects */
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];	/* user data buffer */
118 		struct completion finished;	/* wait for write to finish */
119 		bool busy;			/* write in progress */
120 		int status;			/* status of tx completion */
121 	} tx;
122 
123 	u16 vendor;			/* usb vendor ID */
124 	u16 product;			/* usb product ID */
125 
126 	struct rc_dev *rdev;		/* rc-core device for remote */
127 	struct input_dev *idev;		/* input device for panel & IR mouse */
128 	struct input_dev *touch;	/* input device for touchscreen */
129 
130 	spinlock_t kc_lock;		/* make sure we get keycodes right */
131 	u32 kc;				/* current input keycode */
132 	u32 last_keycode;		/* last reported input keycode */
133 	u32 rc_scancode;		/* the computed remote scancode */
134 	u8 rc_toggle;			/* the computed remote toggle bit */
135 	u64 rc_proto;			/* iMON or MCE (RC6) IR protocol? */
136 	bool release_code;		/* some keys send a release code */
137 
138 	u8 display_type;		/* store the display type */
139 	bool pad_mouse;			/* toggle kbd(0)/mouse(1) mode */
140 
141 	char name_rdev[128];		/* rc input device name */
142 	char phys_rdev[64];		/* rc input device phys path */
143 
144 	char name_idev[128];		/* input device name */
145 	char phys_idev[64];		/* input device phys path */
146 
147 	char name_touch[128];		/* touch screen name */
148 	char phys_touch[64];		/* touch screen phys path */
149 	struct timer_list ttimer;	/* touch screen timer */
150 	int touch_x;			/* x coordinate on touchscreen */
151 	int touch_y;			/* y coordinate on touchscreen */
152 	struct imon_usb_dev_descr *dev_descr; /* device description with key
153 						 table for front panels */
154 };
155 
156 #define TOUCH_TIMEOUT	(HZ/30)
157 
158 /* vfd character device file operations */
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 /* lcd character device file operations */
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 /* imon receiver front panel/knob key table */
203 static const struct imon_usb_dev_descr imon_default_table = {
204 	.flags = IMON_NO_FLAGS,
205 	.key_table = {
206 		{ 0x000000000f00ffeell, KEY_MEDIA }, /* Go */
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 		/* 0xffdc iMON MCE VFD */
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 		/* iMON Knob values */
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 }, /* Go */
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 		/* 0xffdc iMON MCE VFD */
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 		/* iMON Knob values */
290 		{ 0x000100ffffffffeell, KEY_VOLUMEUP },
291 		{ 0x010000ffffffffeell, KEY_VOLUMEDOWN },
292 		{ 0x000008ffffffffeell, KEY_MUTE },
293 		{ 0, KEY_RESERVED },
294 	}
295 };
296 
297 /* imon receiver front panel/knob key table for DH102*/
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  * USB Device ID for iMON USB Control Boards
320  *
321  * The Windows drivers contain 6 different inf files, more or less one for
322  * each new device until the 0x0034-0x0046 devices, which all use the same
323  * driver. Some of the devices in the 34-46 range haven't been definitively
324  * identified yet. Early devices have either a TriGem Computer, Inc. or a
325  * Samsung vendor ID (0x0aa8 and 0x04e8 respectively), while all later
326  * devices use the SoundGraph vendor ID (0x15c2). This driver only supports
327  * the ffdc and later devices, which do onboard decoding.
328  */
329 static const struct usb_device_id imon_usb_id_table[] = {
330 	/*
331 	 * Several devices with this same device ID, all use iMON_PAD.inf
332 	 * SoundGraph iMON PAD (IR & VFD)
333 	 * SoundGraph iMON PAD (IR & LCD)
334 	 * SoundGraph iMON Knob (IR only)
335 	 */
336 	{ USB_DEVICE(0x15c2, 0xffdc),
337 	  .driver_info = (unsigned long)&imon_default_table },
338 
339 	/*
340 	 * Newer devices, all driven by the latest iMON Windows driver, full
341 	 * list of device IDs extracted via 'strings Setup/data1.hdr |grep 15c2'
342 	 * Need user input to fill in details on unknown devices.
343 	 */
344 	/* SoundGraph iMON OEM Touch LCD (IR & 7" VGA LCD) */
345 	{ USB_DEVICE(0x15c2, 0x0034),
346 	  .driver_info = (unsigned long)&imon_DH102 },
347 	/* SoundGraph iMON OEM Touch LCD (IR & 4.3" VGA LCD) */
348 	{ USB_DEVICE(0x15c2, 0x0035),
349 	  .driver_info = (unsigned long)&imon_default_table},
350 	/* SoundGraph iMON OEM VFD (IR & VFD) */
351 	{ USB_DEVICE(0x15c2, 0x0036),
352 	  .driver_info = (unsigned long)&imon_OEM_VFD },
353 	/* device specifics unknown */
354 	{ USB_DEVICE(0x15c2, 0x0037),
355 	  .driver_info = (unsigned long)&imon_default_table},
356 	/* SoundGraph iMON OEM LCD (IR & LCD) */
357 	{ USB_DEVICE(0x15c2, 0x0038),
358 	  .driver_info = (unsigned long)&imon_default_table},
359 	/* SoundGraph iMON UltraBay (IR & LCD) */
360 	{ USB_DEVICE(0x15c2, 0x0039),
361 	  .driver_info = (unsigned long)&imon_default_table},
362 	/* device specifics unknown */
363 	{ USB_DEVICE(0x15c2, 0x003a),
364 	  .driver_info = (unsigned long)&imon_default_table},
365 	/* device specifics unknown */
366 	{ USB_DEVICE(0x15c2, 0x003b),
367 	  .driver_info = (unsigned long)&imon_default_table},
368 	/* SoundGraph iMON OEM Inside (IR only) */
369 	{ USB_DEVICE(0x15c2, 0x003c),
370 	  .driver_info = (unsigned long)&imon_default_table},
371 	/* device specifics unknown */
372 	{ USB_DEVICE(0x15c2, 0x003d),
373 	  .driver_info = (unsigned long)&imon_default_table},
374 	/* device specifics unknown */
375 	{ USB_DEVICE(0x15c2, 0x003e),
376 	  .driver_info = (unsigned long)&imon_default_table},
377 	/* device specifics unknown */
378 	{ USB_DEVICE(0x15c2, 0x003f),
379 	  .driver_info = (unsigned long)&imon_default_table},
380 	/* device specifics unknown */
381 	{ USB_DEVICE(0x15c2, 0x0040),
382 	  .driver_info = (unsigned long)&imon_default_table},
383 	/* SoundGraph iMON MINI (IR only) */
384 	{ USB_DEVICE(0x15c2, 0x0041),
385 	  .driver_info = (unsigned long)&imon_default_table},
386 	/* Antec Veris Multimedia Station EZ External (IR only) */
387 	{ USB_DEVICE(0x15c2, 0x0042),
388 	  .driver_info = (unsigned long)&imon_default_table},
389 	/* Antec Veris Multimedia Station Basic Internal (IR only) */
390 	{ USB_DEVICE(0x15c2, 0x0043),
391 	  .driver_info = (unsigned long)&imon_default_table},
392 	/* Antec Veris Multimedia Station Elite (IR & VFD) */
393 	{ USB_DEVICE(0x15c2, 0x0044),
394 	  .driver_info = (unsigned long)&imon_default_table},
395 	/* Antec Veris Multimedia Station Premiere (IR & LCD) */
396 	{ USB_DEVICE(0x15c2, 0x0045),
397 	  .driver_info = (unsigned long)&imon_default_table},
398 	/* device specifics unknown */
399 	{ USB_DEVICE(0x15c2, 0x0046),
400 	  .driver_info = (unsigned long)&imon_default_table},
401 	{}
402 };
403 
404 /* USB Device data */
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 /* to prevent races between open() and disconnect(), probing, etc */
415 static DEFINE_MUTEX(driver_lock);
416 
417 /* Module bookkeeping bits */
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 /* lcd, vfd, vga or none? should be auto-detected, but can be overridden... */
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  * In certain use cases, mouse mode isn't really helpful, and could actually
439  * cause confusion, so allow disabling it when the IR device is open.
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 /* threshold at which a pad push registers as an arrow key in kbd mode */
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  * Called when the Display device (e.g. /dev/lcd0)
465  * is opened by the application.
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 	/* prevent races with disconnect */
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  * Called when the display device (e.g. /dev/lcd0)
515  * is closed by the application.
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  * Sends a packet to the device -- this function must be called with
548  * ictx->lock held, or its unlock/lock sequence while waiting for tx
549  * to complete can/will lead to a deadlock.
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 	/* Check if we need to use control or interrupt urb */
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 		/* fill request into kmalloc'ed space: */
573 		control_req = kmalloc(sizeof(*control_req), GFP_KERNEL);
574 		if (control_req == NULL)
575 			return -ENOMEM;
576 
577 		/* setup packet is '21 09 0200 0001 0008' */
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 		/* control pipe is endpoint 0x00 */
585 		pipe = usb_sndctrlpipe(ictx->usbdev_intf0, 0);
586 
587 		/* build the control urb */
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(); /* ensure later readers know we're busy */
599 
600 	retval = usb_submit_urb(ictx->tx_urb, GFP_KERNEL);
601 	if (retval) {
602 		ictx->tx.busy = false;
603 		smp_rmb(); /* ensure later readers know we're not busy */
604 		pr_err_ratelimited("error submitting urb(%d)\n", retval);
605 	} else {
606 		/* Wait for transmission to complete (or abort) */
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 	 * Induce a mandatory delay before returning, as otherwise,
625 	 * send_packet can get called so rapidly as to overwhelm the device,
626 	 * particularly on faster systems and/or those with quirky usb.
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  * Sends an associate packet to the iMON 2.4G.
637  *
638  * This might not be such a good idea, since it has an id collision with
639  * some versions of the "IR & VFD" combo. The only way to determine if it
640  * is an RF version is to look at the product description string. (Which
641  * we currently do not fetch).
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  * Sends packets to setup and show clock on iMON display
667  *
668  * Arguments: year - last 2 digits of year, month - 1..12,
669  * day - 1..31, dow - day of the week (0-Sun...6-Sat),
670  * hour - 0..23, minute - 0..59, second - 0..59
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  * These are the sysfs functions to handle the association on the iMON 2.4G LT.
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  * sysfs functions to control internal imon clock
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  * Writes data to the VFD.  The iMON VFD is 2x16 characters
896  * and requires data in 5 consecutive USB interrupt packets,
897  * each packet but the last carrying 7 bytes.
898  *
899  * I don't know if the VFD board supports features such as
900  * scrolling, clearing rows, blanking, etc. so at
901  * the caller must provide a full screen of data.  If fewer
902  * than 32 bytes are provided spaces will be appended to
903  * generate a full screen.
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 	/* Pad with spaces */
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 	/* Send packet #6 */
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  * Writes data to the LCD.  The iMON OEM LCD screen expects 8-byte
981  * packets. We accept data as 16 hexadecimal digits, followed by a
982  * newline (to make it easy to drive the device from a command-line
983  * -- even though the actual binary data is a bit complicated).
984  *
985  * The device itself is not a "traditional" text-mode display. It's
986  * actually a 16x96 pixel bitmap display. That means if you want to
987  * display text, you've got to have your own "font" and translate the
988  * text into bitmaps for display. This is really flexible (you can
989  * display whatever diacritics you need, and so on), but it's also
990  * a lot more complicated than most LCDs...
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  * Callback function for USB core API: transmit data
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 	/* notify waiters that write has finished */
1053 	ictx->tx.busy = false;
1054 	smp_rmb(); /* ensure later readers know we're not busy */
1055 	complete(&ictx->tx.finished);
1056 }
1057 
1058 /*
1059  * report touchscreen input
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  * iMON IR receivers support two different signal sets -- those used by
1076  * the iMON remotes, and those used by the Windows MCE remotes (which is
1077  * really just RC-6), but only one or the other at a time, as the signals
1078  * are decoded onboard the receiver.
1079  *
1080  * This function gets called two different ways, one way is from
1081  * rc_register_device, for initial protocol selection/setup, and the other is
1082  * via a userspace-initiated protocol change request, either by direct sysfs
1083  * prodding or by something like ir-keytable. In the rc_register_device case,
1084  * the imon context lock is already held, but when initiated from userspace,
1085  * it is not, so we must acquire it prior to calling send_packet, which
1086  * requires that the lock is held.
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 		/* ir_proto_packet[0] = 0x00; // already the default */
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 		/* ir_proto_packet[0] = 0x00; // already the default */
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  * The directional pad behaves a bit differently, depending on whether this is
1141  * one of the older ffdc devices or a newer device. Newer devices appear to
1142  * have a higher resolution matrix for more precise mouse movement, but it
1143  * makes things overly sensitive in keyboard mode, so we do some interesting
1144  * contortions to make it less touchy. Older devices run through the same
1145  * routine with shorter timeout and a smaller threshold.
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 	/* Look for the initial press of a button */
1221 	keycode = rc_g_keycode_from_table(ictx->rdev, scancode);
1222 	ictx->rc_toggle = 0x0;
1223 	ictx->rc_scancode = scancode;
1224 
1225 	/* Look for the release of a button */
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 	 * On some receivers, mce keys decode to 0x8000f04xx and 0x8000f84xx
1247 	 * (the toggle bit flipping between alternating key presses), while
1248 	 * on other receivers, we see 0x8000f74xx and 0x8000ff4xx. To keep
1249 	 * the table trim, we always or in the bits to look up 0x8000ff4xx,
1250 	 * but we can't or them into all codes, as some keys are decoded in
1251 	 * a different way w/o the same use of the toggle bit...
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 	/* not used in mce mode, but make sure we know its false */
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 	/* newer iMON device PAD or mouse button */
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 	/* 0xffdc iMON PAD or mouse button input */
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 	/* some ffdc devices decode mouse buttons differently... */
1312 	} else if (ictx->product == 0xffdc && (buf[0] == 0x68)) {
1313 		right_shift = 2;
1314 	/* ch+/- buttons, which we use for an emulated scroll wheel */
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 	 * The imon directional pad functions more like a touchpad. Bytes 3 & 4
1367 	 * contain a position coordinate (x,y), with each component ranging
1368 	 * from -14 to 14. We want to down-sample this to only 4 discrete values
1369 	 * for up/down/left/right arrow keys. Also, when you get too close to
1370 	 * diagonals, it has a tendency to jump back and forth, so lets try to
1371 	 * ignore when they get too close.
1372 	 */
1373 	if (ictx->product != 0xffdc) {
1374 		/* first, pad to 8 bytes so it conforms with everything else */
1375 		buf[5] = buf[6] = buf[7] = 0;
1376 		timeout = 500;	/* in msecs */
1377 		/* (2*threshold) x (2*threshold) square */
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 			 * Hack alert: instead of using keycodes, we have
1401 			 * to use hard-coded scancodes here...
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; /* KEY_DOWN */
1408 				else
1409 					scancode = 0x01008000; /* KEY_UP */
1410 			} else {
1411 				buf[2] = 0;
1412 				buf[3] = (rel_x > 0) ? 0x7F : 0x80;
1413 				if (rel_x > 0)
1414 					scancode = 0x0100007f; /* KEY_RIGHT */
1415 				else
1416 					scancode = 0x01000080; /* KEY_LEFT */
1417 			}
1418 		}
1419 
1420 	/*
1421 	 * Handle on-board decoded pad events for e.g. older VFD/iMON-Pad
1422 	 * device (15c2:ffdc). The remote generates various codes from
1423 	 * 0x68nnnnB7 to 0x6AnnnnB7, the left mouse button generates
1424 	 * 0x688301b7 and the right one 0x688481b7. All other keys generate
1425 	 * 0x2nnnnnnn. Position coordinate is encoded in buf[1] and buf[2] with
1426 	 * reversed endianness. Extract direction from buffer, rotate endianness,
1427 	 * adjust sign and feed the values into stabilize(). The resulting codes
1428 	 * will be 0x01008000, 0x01007F00, which match the newer devices.
1429 	 */
1430 	} else {
1431 		timeout = 10;	/* in msecs */
1432 		/* (2*threshold) x (2*threshold) square */
1433 		threshold = pad_thresh ? pad_thresh : 15;
1434 
1435 		/* buf[1] is x */
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 		/* buf[2] is y */
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 			 * Hack alert: instead of using keycodes, we have
1464 			 * to use hard-coded scancodes here...
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; /* KEY_DOWN */
1471 				else
1472 					scancode = 0x01008000; /* KEY_UP */
1473 			} else {
1474 				buf[2] = 0;
1475 				buf[3] = (rel_x > 0) ? 0x7F : 0x80;
1476 				if (rel_x > 0)
1477 					scancode = 0x0100007f; /* KEY_RIGHT */
1478 				else
1479 					scancode = 0x01000080; /* KEY_LEFT */
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  * figure out if these is a press or a release. We don't actually
1493  * care about repeats, as those will be auto-generated within the IR
1494  * subsystem for repeating scancodes.
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 	/* key release of 0x02XXXXXX key */
1505 	if (ictx->kc == KEY_RESERVED && buf[0] == 0x02 && buf[3] == 0x00)
1506 		ictx->kc = ictx->last_keycode;
1507 
1508 	/* mouse button release on (some) 0xffdc devices */
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 	/* mouse button release on (some other) 0xffdc devices */
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 	/* mce-specific button handling, no keyup events */
1519 	else if (ktype == IMON_KEY_MCE) {
1520 		ictx->rc_toggle = buf[2];
1521 		press_type = 1;
1522 
1523 	/* incoherent or irrelevant data */
1524 	} else if (ictx->kc == KEY_RESERVED)
1525 		press_type = -EINVAL;
1526 
1527 	/* key release of 0xXXXXXXb7 key */
1528 	else if (ictx->release_code)
1529 		press_type = 0;
1530 
1531 	/* this is a button press */
1532 	else
1533 		press_type = 1;
1534 
1535 	spin_unlock_irqrestore(&ictx->kc_lock, flags);
1536 
1537 	return press_type;
1538 }
1539 
1540 /*
1541  * Process the incoming packet
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 	/* filter out junk data on the older 0xffdc imon devices */
1559 	if ((buf[0] == 0xff) && (buf[1] == 0xff) && (buf[2] == 0xff))
1560 		return;
1561 
1562 	/* Figure out what key was pressed */
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 	/* keyboard/mouse mode toggle button */
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 	/* send touchscreen events through input subsystem if touchpad data */
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 	/* look for mouse events with pad in mouse mode */
1607 	} else if (ictx->pad_mouse) {
1608 		if (imon_mouse_event(ictx, buf, len))
1609 			return;
1610 	}
1611 
1612 	/* Now for some special handling to convert pad input to arrow keys */
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 	/* Only panel type events left to process now */
1653 	spin_lock_irqsave(&ictx->kc_lock, flags);
1654 
1655 	t = ktime_get();
1656 	/* KEY_MUTE repeats from knob need to be suppressed */
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 	/* panel keys don't generate a release */
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 
1682 not_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 	/* iMON 2.4G associate frame */
1690 	if (buf[0] == 0x00 &&
1691 	    buf[2] == 0xFF &&				/* REFID */
1692 	    buf[3] == 0xFF &&
1693 	    buf[4] == 0xFF &&
1694 	    buf[5] == 0xFF &&				/* iMON 2.4G */
1695 	   ((buf[6] == 0x4E && buf[7] == 0xDF) ||	/* LT */
1696 	    (buf[6] == 0x5E && buf[7] == 0xDF))) {	/* DT */
1697 		dev_warn(dev, "%s: remote associated refid=%02X\n",
1698 			 __func__, buf[1]);
1699 		ictx->rf_isassociating = false;
1700 	}
1701 }
1702 
1703 /*
1704  * Callback function for USB core API: receive data
1705  */
1706 static 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 	 * if we get a callback before we're done configuring the hardware, we
1720 	 * can't yet process the data, as there's nowhere to send it, but we
1721 	 * still need to submit a new rx URB to avoid wedging the hardware
1722 	 */
1723 	if (!ictx->dev_present_intf0)
1724 		goto out;
1725 
1726 	switch (urb->status) {
1727 	case -ENOENT:		/* usbcore unlink successful! */
1728 		return;
1729 
1730 	case -ESHUTDOWN:	/* transport endpoint was shut down */
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 
1743 out:
1744 	usb_submit_urb(ictx->rx_urb_intf0, GFP_ATOMIC);
1745 }
1746 
1747 static 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 	 * if we get a callback before we're done configuring the hardware, we
1761 	 * can't yet process the data, as there's nowhere to send it, but we
1762 	 * still need to submit a new rx URB to avoid wedging the hardware
1763 	 */
1764 	if (!ictx->dev_present_intf1)
1765 		goto out;
1766 
1767 	switch (urb->status) {
1768 	case -ENOENT:		/* usbcore unlink successful! */
1769 		return;
1770 
1771 	case -ESHUTDOWN:	/* transport endpoint was shut down */
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 
1784 out:
1785 	usb_submit_urb(ictx->rx_urb_intf1, GFP_ATOMIC);
1786 }
1787 
1788 /*
1789  * The 0x15c2:0xffdc device ID was used for umpteen different imon
1790  * devices, and all of them constantly spew interrupts, even when there
1791  * is no actual data to report. However, byte 6 of this buffer looks like
1792  * its unique across device variants, so we're trying to key off that to
1793  * figure out which display type (if any) and what IR protocol the device
1794  * actually supports. These devices have their IR protocol hard-coded into
1795  * their firmware, they can't be changed on the fly like the newer hardware.
1796  */
1797 static 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 	/* iMON Knob, no display, iMON IR + vol knob */
1805 	case 0x21:
1806 		dev_info(ictx->dev, "0xffdc iMON Knob, iMON IR");
1807 		ictx->display_supported = false;
1808 		break;
1809 	/* iMON 2.4G LT (usb stick), no display, iMON RF */
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 	/* iMON VFD, no IR (does have vol knob tho) */
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 	/* iMON VFD, iMON IR */
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 	/* iMON VFD, MCE IR */
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 	/* iMON LCD, MCE IR */
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 	/* no display, iMON IR */
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 		 * We don't know which one it is, allow user to set the
1851 		 * RC6 one from userspace if IMON wasn't correct.
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 
1863 static void imon_set_display_type(struct imon_context *ictx)
1864 {
1865 	u8 configured_display_type = IMON_DISPLAY_TYPE_VFD;
1866 
1867 	/*
1868 	 * Try to auto-detect the type of display if the user hasn't set
1869 	 * it by hand via the display_type modparam. Default is VFD.
1870 	 */
1871 
1872 	if (display_type == IMON_DISPLAY_TYPE_AUTO) {
1873 		switch (ictx->product) {
1874 		case 0xffdc:
1875 			/* set in imon_get_ffdc_type() */
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 
1913 static 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 	/* iMON PAD or MCE */
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 	/* Enable front-panel buttons and/or knobs */
1944 	memcpy(ictx->usb_tx_buf, &fp_packet, sizeof(fp_packet));
1945 	ret = send_packet(ictx);
1946 	/* Not fatal, but warn about it */
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 
1970 out:
1971 	rc_free_device(rdev);
1972 	return NULL;
1973 }
1974 
1975 static 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 	/* panel and/or knob code support */
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 
2020 out:
2021 	input_free_device(idev);
2022 	return NULL;
2023 }
2024 
2025 static 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 
2065 touch_register_failed:
2066 	input_free_device(touch);
2067 
2068 touch_alloc_failed:
2069 	return NULL;
2070 }
2071 
2072 static 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 	 * Scan the endpoint list and set:
2087 	 *	first input endpoint = IR endpoint
2088 	 *	first output endpoint = display endpoint
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 		 * tx is used to send characters to lcd/vfd, associate RF
2114 		 * remotes, set IR protocol, and maybe more...
2115 		 */
2116 		ictx->tx_endpoint = tx_endpoint;
2117 	} else {
2118 		ictx->rx_endpoint_intf1 = rx_endpoint;
2119 	}
2120 
2121 	/*
2122 	 * If we didn't find a display endpoint, this is probably one of the
2123 	 * newer iMON devices that use control urb instead of interrupt
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 	 * Some iMON receivers have no display. Unfortunately, it seems
2134 	 * that SoundGraph recycles device IDs between devices both with
2135 	 * and without... :\
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 	 * iMON Touch devices have a VGA touchscreen, but no "display", as
2144 	 * that refers to e.g. /dev/lcd0 (a character device LCD or VFD).
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 	/* Input endpoint is mandatory */
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 
2164 static 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 	/* save drive info for later accessing the panel/knob key table */
2202 	ictx->dev_descr = (struct imon_usb_dev_descr *)id->driver_info;
2203 	/* default send_packet delay is 5ms but some devices need more */
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 
2243 rdev_setup_failed:
2244 	input_unregister_device(ictx->idev);
2245 idev_setup_failed:
2246 	usb_kill_urb(ictx->rx_urb_intf0);
2247 urb_submit_failed:
2248 find_endpoint_failed:
2249 	usb_put_dev(ictx->usbdev_intf0);
2250 	mutex_unlock(&ictx->lock);
2251 	usb_free_urb(tx_urb);
2252 tx_urb_alloc_failed:
2253 	usb_free_urb(rx_urb);
2254 rx_urb_alloc_failed:
2255 	kfree(ictx);
2256 exit:
2257 	dev_err(dev, "unable to initialize intf0, err %d\n", ret);
2258 
2259 	return NULL;
2260 }
2261 
2262 static 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 
2313 urb_submit_failed:
2314 	if (ictx->touch)
2315 		input_unregister_device(ictx->touch);
2316 touch_setup_failed:
2317 find_endpoint_failed:
2318 	usb_put_dev(ictx->usbdev_intf1);
2319 	mutex_unlock(&ictx->lock);
2320 	usb_free_urb(rx_urb);
2321 rx_urb_alloc_failed:
2322 	dev_err(ictx->dev, "unable to initialize intf1, err %d\n", ret);
2323 
2324 	return NULL;
2325 }
2326 
2327 static 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 	/* set up sysfs entry for built-in clock */
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 		/* Not a fatal error, so ignore */
2346 		dev_info(ictx->dev, "could not get a minor number for display\n");
2347 
2348 }
2349 
2350 /*
2351  * Callback function for USB core API: Probe
2352  */
2353 static 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 	/* prevent races probing devices w/multiple interfaces */
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 		/* this is the secondary interface on the device */
2396 
2397 		/* fail early if first intf failed to register */
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 
2440 fail:
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  * Callback function for USB core API: disconnect
2450  */
2451 static void imon_disconnect(struct usb_interface *interface)
2452 {
2453 	struct imon_context *ictx;
2454 	struct device *dev;
2455 	int ifnum;
2456 
2457 	/* prevent races with multi-interface device probing and display_open */
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 	 * sysfs_remove_group is safe to call even if sysfs_create_group
2466 	 * hasn't been called
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 	/* Abort ongoing write */
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 
2510 static 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 
2523 static 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 
2553 module_usb_driver(imon_driver);
2554