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