Loading...
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * keyspan_remote: USB driver for the Keyspan DMR
4 *
5 * Copyright (C) 2005 Zymeta Corporation - Michael Downey (downey@zymeta.com)
6 *
7 * This driver has been put together with the support of Innosys, Inc.
8 * and Keyspan, Inc the manufacturers of the Keyspan USB DMR product.
9 */
10
11#include <linux/kernel.h>
12#include <linux/errno.h>
13#include <linux/slab.h>
14#include <linux/module.h>
15#include <linux/usb/input.h>
16
17/* Parameters that can be passed to the driver. */
18static int debug;
19module_param(debug, int, 0444);
20MODULE_PARM_DESC(debug, "Enable extra debug messages and information");
21
22/* Vendor and product ids */
23#define USB_KEYSPAN_VENDOR_ID 0x06CD
24#define USB_KEYSPAN_PRODUCT_UIA11 0x0202
25
26/* Defines for converting the data from the remote. */
27#define ZERO 0x18
28#define ZERO_MASK 0x1F /* 5 bits for a 0 */
29#define ONE 0x3C
30#define ONE_MASK 0x3F /* 6 bits for a 1 */
31#define SYNC 0x3F80
32#define SYNC_MASK 0x3FFF /* 14 bits for a SYNC sequence */
33#define STOP 0x00
34#define STOP_MASK 0x1F /* 5 bits for the STOP sequence */
35#define GAP 0xFF
36
37#define RECV_SIZE 8 /* The UIA-11 type have a 8 byte limit. */
38
39/*
40 * Table that maps the 31 possible keycodes to input keys.
41 * Currently there are 15 and 17 button models so RESERVED codes
42 * are blank areas in the mapping.
43 */
44static const unsigned short keyspan_key_table[] = {
45 KEY_RESERVED, /* 0 is just a place holder. */
46 KEY_RESERVED,
47 KEY_STOP,
48 KEY_PLAYCD,
49 KEY_RESERVED,
50 KEY_PREVIOUSSONG,
51 KEY_REWIND,
52 KEY_FORWARD,
53 KEY_NEXTSONG,
54 KEY_RESERVED,
55 KEY_RESERVED,
56 KEY_RESERVED,
57 KEY_PAUSE,
58 KEY_VOLUMEUP,
59 KEY_RESERVED,
60 KEY_RESERVED,
61 KEY_RESERVED,
62 KEY_VOLUMEDOWN,
63 KEY_RESERVED,
64 KEY_UP,
65 KEY_RESERVED,
66 KEY_MUTE,
67 KEY_LEFT,
68 KEY_ENTER,
69 KEY_RIGHT,
70 KEY_RESERVED,
71 KEY_RESERVED,
72 KEY_DOWN,
73 KEY_RESERVED,
74 KEY_KPASTERISK,
75 KEY_RESERVED,
76 KEY_MENU
77};
78
79/* table of devices that work with this driver */
80static const struct usb_device_id keyspan_table[] = {
81 { USB_DEVICE(USB_KEYSPAN_VENDOR_ID, USB_KEYSPAN_PRODUCT_UIA11) },
82 { } /* Terminating entry */
83};
84
85/* Structure to store all the real stuff that a remote sends to us. */
86struct keyspan_message {
87 u16 system;
88 u8 button;
89 u8 toggle;
90};
91
92/* Structure used for all the bit testing magic needed to be done. */
93struct bit_tester {
94 u32 tester;
95 int len;
96 int pos;
97 int bits_left;
98 u8 buffer[32];
99};
100
101/* Structure to hold all of our driver specific stuff */
102struct usb_keyspan {
103 char name[128];
104 char phys[64];
105 unsigned short keymap[ARRAY_SIZE(keyspan_key_table)];
106 struct usb_device *udev;
107 struct input_dev *input;
108 struct usb_interface *interface;
109 struct usb_endpoint_descriptor *in_endpoint;
110 struct urb* irq_urb;
111 int open;
112 dma_addr_t in_dma;
113 unsigned char *in_buffer;
114
115 /* variables used to parse messages from remote. */
116 struct bit_tester data;
117 int stage;
118 int toggle;
119};
120
121static struct usb_driver keyspan_driver;
122
123/*
124 * Debug routine that prints out what we've received from the remote.
125 */
126static void keyspan_print(struct usb_keyspan* dev) /*unsigned char* data)*/
127{
128 char codes[4 * RECV_SIZE];
129 int i;
130
131 for (i = 0; i < RECV_SIZE; i++)
132 snprintf(codes + i * 3, 4, "%02x ", dev->in_buffer[i]);
133
134 dev_info(&dev->udev->dev, "%s\n", codes);
135}
136
137/*
138 * Routine that manages the bit_tester structure. It makes sure that there are
139 * at least bits_needed bits loaded into the tester.
140 */
141static int keyspan_load_tester(struct usb_keyspan* dev, int bits_needed)
142{
143 if (dev->data.bits_left >= bits_needed)
144 return 0;
145
146 /*
147 * Somehow we've missed the last message. The message will be repeated
148 * though so it's not too big a deal
149 */
150 if (dev->data.pos >= dev->data.len) {
151 dev_dbg(&dev->interface->dev,
152 "%s - Error ran out of data. pos: %d, len: %d\n",
153 __func__, dev->data.pos, dev->data.len);
154 return -1;
155 }
156
157 /* Load as much as we can into the tester. */
158 while ((dev->data.bits_left + 7 < (sizeof(dev->data.tester) * 8)) &&
159 (dev->data.pos < dev->data.len)) {
160 dev->data.tester += (dev->data.buffer[dev->data.pos++] << dev->data.bits_left);
161 dev->data.bits_left += 8;
162 }
163
164 return 0;
165}
166
167static void keyspan_report_button(struct usb_keyspan *remote, int button, int press)
168{
169 struct input_dev *input = remote->input;
170
171 input_event(input, EV_MSC, MSC_SCAN, button);
172 input_report_key(input, remote->keymap[button], press);
173 input_sync(input);
174}
175
176/*
177 * Routine that handles all the logic needed to parse out the message from the remote.
178 */
179static void keyspan_check_data(struct usb_keyspan *remote)
180{
181 int i;
182 int found = 0;
183 struct keyspan_message message;
184
185 switch(remote->stage) {
186 case 0:
187 /*
188 * In stage 0 we want to find the start of a message. The remote sends a 0xFF as filler.
189 * So the first byte that isn't a FF should be the start of a new message.
190 */
191 for (i = 0; i < RECV_SIZE && remote->in_buffer[i] == GAP; ++i);
192
193 if (i < RECV_SIZE) {
194 memcpy(remote->data.buffer, remote->in_buffer, RECV_SIZE);
195 remote->data.len = RECV_SIZE;
196 remote->data.pos = 0;
197 remote->data.tester = 0;
198 remote->data.bits_left = 0;
199 remote->stage = 1;
200 }
201 break;
202
203 case 1:
204 /*
205 * Stage 1 we should have 16 bytes and should be able to detect a
206 * SYNC. The SYNC is 14 bits, 7 0's and then 7 1's.
207 */
208 memcpy(remote->data.buffer + remote->data.len, remote->in_buffer, RECV_SIZE);
209 remote->data.len += RECV_SIZE;
210
211 found = 0;
212 while ((remote->data.bits_left >= 14 || remote->data.pos < remote->data.len) && !found) {
213 for (i = 0; i < 8; ++i) {
214 if (keyspan_load_tester(remote, 14) != 0) {
215 remote->stage = 0;
216 return;
217 }
218
219 if ((remote->data.tester & SYNC_MASK) == SYNC) {
220 remote->data.tester = remote->data.tester >> 14;
221 remote->data.bits_left -= 14;
222 found = 1;
223 break;
224 } else {
225 remote->data.tester = remote->data.tester >> 1;
226 --remote->data.bits_left;
227 }
228 }
229 }
230
231 if (!found) {
232 remote->stage = 0;
233 remote->data.len = 0;
234 } else {
235 remote->stage = 2;
236 }
237 break;
238
239 case 2:
240 /*
241 * Stage 2 we should have 24 bytes which will be enough for a full
242 * message. We need to parse out the system code, button code,
243 * toggle code, and stop.
244 */
245 memcpy(remote->data.buffer + remote->data.len, remote->in_buffer, RECV_SIZE);
246 remote->data.len += RECV_SIZE;
247
248 message.system = 0;
249 for (i = 0; i < 9; i++) {
250 keyspan_load_tester(remote, 6);
251
252 if ((remote->data.tester & ZERO_MASK) == ZERO) {
253 message.system = message.system << 1;
254 remote->data.tester = remote->data.tester >> 5;
255 remote->data.bits_left -= 5;
256 } else if ((remote->data.tester & ONE_MASK) == ONE) {
257 message.system = (message.system << 1) + 1;
258 remote->data.tester = remote->data.tester >> 6;
259 remote->data.bits_left -= 6;
260 } else {
261 dev_err(&remote->interface->dev,
262 "%s - Unknown sequence found in system data.\n",
263 __func__);
264 remote->stage = 0;
265 return;
266 }
267 }
268
269 message.button = 0;
270 for (i = 0; i < 5; i++) {
271 keyspan_load_tester(remote, 6);
272
273 if ((remote->data.tester & ZERO_MASK) == ZERO) {
274 message.button = message.button << 1;
275 remote->data.tester = remote->data.tester >> 5;
276 remote->data.bits_left -= 5;
277 } else if ((remote->data.tester & ONE_MASK) == ONE) {
278 message.button = (message.button << 1) + 1;
279 remote->data.tester = remote->data.tester >> 6;
280 remote->data.bits_left -= 6;
281 } else {
282 dev_err(&remote->interface->dev,
283 "%s - Unknown sequence found in button data.\n",
284 __func__);
285 remote->stage = 0;
286 return;
287 }
288 }
289
290 keyspan_load_tester(remote, 6);
291 if ((remote->data.tester & ZERO_MASK) == ZERO) {
292 message.toggle = 0;
293 remote->data.tester = remote->data.tester >> 5;
294 remote->data.bits_left -= 5;
295 } else if ((remote->data.tester & ONE_MASK) == ONE) {
296 message.toggle = 1;
297 remote->data.tester = remote->data.tester >> 6;
298 remote->data.bits_left -= 6;
299 } else {
300 dev_err(&remote->interface->dev,
301 "%s - Error in message, invalid toggle.\n",
302 __func__);
303 remote->stage = 0;
304 return;
305 }
306
307 keyspan_load_tester(remote, 5);
308 if ((remote->data.tester & STOP_MASK) == STOP) {
309 remote->data.tester = remote->data.tester >> 5;
310 remote->data.bits_left -= 5;
311 } else {
312 dev_err(&remote->interface->dev,
313 "Bad message received, no stop bit found.\n");
314 }
315
316 dev_dbg(&remote->interface->dev,
317 "%s found valid message: system: %d, button: %d, toggle: %d\n",
318 __func__, message.system, message.button, message.toggle);
319
320 if (message.toggle != remote->toggle) {
321 keyspan_report_button(remote, message.button, 1);
322 keyspan_report_button(remote, message.button, 0);
323 remote->toggle = message.toggle;
324 }
325
326 remote->stage = 0;
327 break;
328 }
329}
330
331/*
332 * Routine for sending all the initialization messages to the remote.
333 */
334static int keyspan_setup(struct usb_device* dev)
335{
336 int retval = 0;
337
338 retval = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
339 0x11, 0x40, 0x5601, 0x0, NULL, 0,
340 USB_CTRL_SET_TIMEOUT);
341 if (retval) {
342 dev_dbg(&dev->dev, "%s - failed to set bit rate due to error: %d\n",
343 __func__, retval);
344 return(retval);
345 }
346
347 retval = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
348 0x44, 0x40, 0x0, 0x0, NULL, 0,
349 USB_CTRL_SET_TIMEOUT);
350 if (retval) {
351 dev_dbg(&dev->dev, "%s - failed to set resume sensitivity due to error: %d\n",
352 __func__, retval);
353 return(retval);
354 }
355
356 retval = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
357 0x22, 0x40, 0x0, 0x0, NULL, 0,
358 USB_CTRL_SET_TIMEOUT);
359 if (retval) {
360 dev_dbg(&dev->dev, "%s - failed to turn receive on due to error: %d\n",
361 __func__, retval);
362 return(retval);
363 }
364
365 dev_dbg(&dev->dev, "%s - Setup complete.\n", __func__);
366 return(retval);
367}
368
369/*
370 * Routine used to handle a new message that has come in.
371 */
372static void keyspan_irq_recv(struct urb *urb)
373{
374 struct usb_keyspan *dev = urb->context;
375 int retval;
376
377 /* Check our status in case we need to bail out early. */
378 switch (urb->status) {
379 case 0:
380 break;
381
382 /* Device went away so don't keep trying to read from it. */
383 case -ECONNRESET:
384 case -ENOENT:
385 case -ESHUTDOWN:
386 return;
387
388 default:
389 goto resubmit;
390 }
391
392 if (debug)
393 keyspan_print(dev);
394
395 keyspan_check_data(dev);
396
397resubmit:
398 retval = usb_submit_urb(urb, GFP_ATOMIC);
399 if (retval)
400 dev_err(&dev->interface->dev,
401 "%s - usb_submit_urb failed with result: %d\n",
402 __func__, retval);
403}
404
405static int keyspan_open(struct input_dev *dev)
406{
407 struct usb_keyspan *remote = input_get_drvdata(dev);
408
409 remote->irq_urb->dev = remote->udev;
410 if (usb_submit_urb(remote->irq_urb, GFP_KERNEL))
411 return -EIO;
412
413 return 0;
414}
415
416static void keyspan_close(struct input_dev *dev)
417{
418 struct usb_keyspan *remote = input_get_drvdata(dev);
419
420 usb_kill_urb(remote->irq_urb);
421}
422
423static struct usb_endpoint_descriptor *keyspan_get_in_endpoint(struct usb_host_interface *iface)
424{
425
426 struct usb_endpoint_descriptor *endpoint;
427 int i;
428
429 for (i = 0; i < iface->desc.bNumEndpoints; ++i) {
430 endpoint = &iface->endpoint[i].desc;
431
432 if (usb_endpoint_is_int_in(endpoint)) {
433 /* we found our interrupt in endpoint */
434 return endpoint;
435 }
436 }
437
438 return NULL;
439}
440
441/*
442 * Routine that sets up the driver to handle a specific USB device detected on the bus.
443 */
444static int keyspan_probe(struct usb_interface *interface, const struct usb_device_id *id)
445{
446 struct usb_device *udev = interface_to_usbdev(interface);
447 struct usb_endpoint_descriptor *endpoint;
448 struct usb_keyspan *remote;
449 struct input_dev *input_dev;
450 int i, error;
451
452 endpoint = keyspan_get_in_endpoint(interface->cur_altsetting);
453 if (!endpoint)
454 return -ENODEV;
455
456 remote = kzalloc(sizeof(*remote), GFP_KERNEL);
457 input_dev = input_allocate_device();
458 if (!remote || !input_dev) {
459 error = -ENOMEM;
460 goto fail1;
461 }
462
463 remote->udev = udev;
464 remote->input = input_dev;
465 remote->interface = interface;
466 remote->in_endpoint = endpoint;
467 remote->toggle = -1; /* Set to -1 so we will always not match the toggle from the first remote message. */
468
469 remote->in_buffer = usb_alloc_coherent(udev, RECV_SIZE, GFP_KERNEL, &remote->in_dma);
470 if (!remote->in_buffer) {
471 error = -ENOMEM;
472 goto fail1;
473 }
474
475 remote->irq_urb = usb_alloc_urb(0, GFP_KERNEL);
476 if (!remote->irq_urb) {
477 error = -ENOMEM;
478 goto fail2;
479 }
480
481 error = keyspan_setup(udev);
482 if (error) {
483 error = -ENODEV;
484 goto fail3;
485 }
486
487 if (udev->manufacturer)
488 strscpy(remote->name, udev->manufacturer, sizeof(remote->name));
489
490 if (udev->product) {
491 if (udev->manufacturer)
492 strlcat(remote->name, " ", sizeof(remote->name));
493 strlcat(remote->name, udev->product, sizeof(remote->name));
494 }
495
496 if (!strlen(remote->name))
497 snprintf(remote->name, sizeof(remote->name),
498 "USB Keyspan Remote %04x:%04x",
499 le16_to_cpu(udev->descriptor.idVendor),
500 le16_to_cpu(udev->descriptor.idProduct));
501
502 usb_make_path(udev, remote->phys, sizeof(remote->phys));
503 strlcat(remote->phys, "/input0", sizeof(remote->phys));
504 memcpy(remote->keymap, keyspan_key_table, sizeof(remote->keymap));
505
506 input_dev->name = remote->name;
507 input_dev->phys = remote->phys;
508 usb_to_input_id(udev, &input_dev->id);
509 input_dev->dev.parent = &interface->dev;
510 input_dev->keycode = remote->keymap;
511 input_dev->keycodesize = sizeof(unsigned short);
512 input_dev->keycodemax = ARRAY_SIZE(remote->keymap);
513
514 input_set_capability(input_dev, EV_MSC, MSC_SCAN);
515 __set_bit(EV_KEY, input_dev->evbit);
516 for (i = 0; i < ARRAY_SIZE(keyspan_key_table); i++)
517 __set_bit(keyspan_key_table[i], input_dev->keybit);
518 __clear_bit(KEY_RESERVED, input_dev->keybit);
519
520 input_set_drvdata(input_dev, remote);
521
522 input_dev->open = keyspan_open;
523 input_dev->close = keyspan_close;
524
525 /*
526 * Initialize the URB to access the device.
527 * The urb gets sent to the device in keyspan_open()
528 */
529 usb_fill_int_urb(remote->irq_urb,
530 remote->udev,
531 usb_rcvintpipe(remote->udev, endpoint->bEndpointAddress),
532 remote->in_buffer, RECV_SIZE, keyspan_irq_recv, remote,
533 endpoint->bInterval);
534 remote->irq_urb->transfer_dma = remote->in_dma;
535 remote->irq_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
536
537 /* we can register the device now, as it is ready */
538 error = input_register_device(remote->input);
539 if (error)
540 goto fail3;
541
542 /* save our data pointer in this interface device */
543 usb_set_intfdata(interface, remote);
544
545 return 0;
546
547 fail3: usb_free_urb(remote->irq_urb);
548 fail2: usb_free_coherent(udev, RECV_SIZE, remote->in_buffer, remote->in_dma);
549 fail1: kfree(remote);
550 input_free_device(input_dev);
551
552 return error;
553}
554
555/*
556 * Routine called when a device is disconnected from the USB.
557 */
558static void keyspan_disconnect(struct usb_interface *interface)
559{
560 struct usb_keyspan *remote;
561
562 remote = usb_get_intfdata(interface);
563 usb_set_intfdata(interface, NULL);
564
565 if (remote) { /* We have a valid driver structure so clean up everything we allocated. */
566 input_unregister_device(remote->input);
567 usb_kill_urb(remote->irq_urb);
568 usb_free_urb(remote->irq_urb);
569 usb_free_coherent(remote->udev, RECV_SIZE, remote->in_buffer, remote->in_dma);
570 kfree(remote);
571 }
572}
573
574/*
575 * Standard driver set up sections
576 */
577static struct usb_driver keyspan_driver =
578{
579 .name = "keyspan_remote",
580 .probe = keyspan_probe,
581 .disconnect = keyspan_disconnect,
582 .id_table = keyspan_table
583};
584
585module_usb_driver(keyspan_driver);
586
587MODULE_DEVICE_TABLE(usb, keyspan_table);
588MODULE_AUTHOR("Michael Downey <downey@zymeta.com>");
589MODULE_DESCRIPTION("Driver for the USB Keyspan remote control.");
590MODULE_LICENSE("GPL");
1/*
2 * keyspan_remote: USB driver for the Keyspan DMR
3 *
4 * Copyright (C) 2005 Zymeta Corporation - Michael Downey (downey@zymeta.com)
5 *
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License as
8 * published by the Free Software Foundation, version 2.
9 *
10 * This driver has been put together with the support of Innosys, Inc.
11 * and Keyspan, Inc the manufacturers of the Keyspan USB DMR product.
12 */
13
14#include <linux/kernel.h>
15#include <linux/errno.h>
16#include <linux/slab.h>
17#include <linux/module.h>
18#include <linux/usb/input.h>
19
20#define DRIVER_VERSION "v0.1"
21#define DRIVER_AUTHOR "Michael Downey <downey@zymeta.com>"
22#define DRIVER_DESC "Driver for the USB Keyspan remote control."
23#define DRIVER_LICENSE "GPL"
24
25/* Parameters that can be passed to the driver. */
26static int debug;
27module_param(debug, int, 0444);
28MODULE_PARM_DESC(debug, "Enable extra debug messages and information");
29
30/* Vendor and product ids */
31#define USB_KEYSPAN_VENDOR_ID 0x06CD
32#define USB_KEYSPAN_PRODUCT_UIA11 0x0202
33
34/* Defines for converting the data from the remote. */
35#define ZERO 0x18
36#define ZERO_MASK 0x1F /* 5 bits for a 0 */
37#define ONE 0x3C
38#define ONE_MASK 0x3F /* 6 bits for a 1 */
39#define SYNC 0x3F80
40#define SYNC_MASK 0x3FFF /* 14 bits for a SYNC sequence */
41#define STOP 0x00
42#define STOP_MASK 0x1F /* 5 bits for the STOP sequence */
43#define GAP 0xFF
44
45#define RECV_SIZE 8 /* The UIA-11 type have a 8 byte limit. */
46
47/*
48 * Table that maps the 31 possible keycodes to input keys.
49 * Currently there are 15 and 17 button models so RESERVED codes
50 * are blank areas in the mapping.
51 */
52static const unsigned short keyspan_key_table[] = {
53 KEY_RESERVED, /* 0 is just a place holder. */
54 KEY_RESERVED,
55 KEY_STOP,
56 KEY_PLAYCD,
57 KEY_RESERVED,
58 KEY_PREVIOUSSONG,
59 KEY_REWIND,
60 KEY_FORWARD,
61 KEY_NEXTSONG,
62 KEY_RESERVED,
63 KEY_RESERVED,
64 KEY_RESERVED,
65 KEY_PAUSE,
66 KEY_VOLUMEUP,
67 KEY_RESERVED,
68 KEY_RESERVED,
69 KEY_RESERVED,
70 KEY_VOLUMEDOWN,
71 KEY_RESERVED,
72 KEY_UP,
73 KEY_RESERVED,
74 KEY_MUTE,
75 KEY_LEFT,
76 KEY_ENTER,
77 KEY_RIGHT,
78 KEY_RESERVED,
79 KEY_RESERVED,
80 KEY_DOWN,
81 KEY_RESERVED,
82 KEY_KPASTERISK,
83 KEY_RESERVED,
84 KEY_MENU
85};
86
87/* table of devices that work with this driver */
88static struct usb_device_id keyspan_table[] = {
89 { USB_DEVICE(USB_KEYSPAN_VENDOR_ID, USB_KEYSPAN_PRODUCT_UIA11) },
90 { } /* Terminating entry */
91};
92
93/* Structure to store all the real stuff that a remote sends to us. */
94struct keyspan_message {
95 u16 system;
96 u8 button;
97 u8 toggle;
98};
99
100/* Structure used for all the bit testing magic needed to be done. */
101struct bit_tester {
102 u32 tester;
103 int len;
104 int pos;
105 int bits_left;
106 u8 buffer[32];
107};
108
109/* Structure to hold all of our driver specific stuff */
110struct usb_keyspan {
111 char name[128];
112 char phys[64];
113 unsigned short keymap[ARRAY_SIZE(keyspan_key_table)];
114 struct usb_device *udev;
115 struct input_dev *input;
116 struct usb_interface *interface;
117 struct usb_endpoint_descriptor *in_endpoint;
118 struct urb* irq_urb;
119 int open;
120 dma_addr_t in_dma;
121 unsigned char *in_buffer;
122
123 /* variables used to parse messages from remote. */
124 struct bit_tester data;
125 int stage;
126 int toggle;
127};
128
129static struct usb_driver keyspan_driver;
130
131/*
132 * Debug routine that prints out what we've received from the remote.
133 */
134static void keyspan_print(struct usb_keyspan* dev) /*unsigned char* data)*/
135{
136 char codes[4 * RECV_SIZE];
137 int i;
138
139 for (i = 0; i < RECV_SIZE; i++)
140 snprintf(codes + i * 3, 4, "%02x ", dev->in_buffer[i]);
141
142 dev_info(&dev->udev->dev, "%s\n", codes);
143}
144
145/*
146 * Routine that manages the bit_tester structure. It makes sure that there are
147 * at least bits_needed bits loaded into the tester.
148 */
149static int keyspan_load_tester(struct usb_keyspan* dev, int bits_needed)
150{
151 if (dev->data.bits_left >= bits_needed)
152 return 0;
153
154 /*
155 * Somehow we've missed the last message. The message will be repeated
156 * though so it's not too big a deal
157 */
158 if (dev->data.pos >= dev->data.len) {
159 dev_dbg(&dev->interface->dev,
160 "%s - Error ran out of data. pos: %d, len: %d\n",
161 __func__, dev->data.pos, dev->data.len);
162 return -1;
163 }
164
165 /* Load as much as we can into the tester. */
166 while ((dev->data.bits_left + 7 < (sizeof(dev->data.tester) * 8)) &&
167 (dev->data.pos < dev->data.len)) {
168 dev->data.tester += (dev->data.buffer[dev->data.pos++] << dev->data.bits_left);
169 dev->data.bits_left += 8;
170 }
171
172 return 0;
173}
174
175static void keyspan_report_button(struct usb_keyspan *remote, int button, int press)
176{
177 struct input_dev *input = remote->input;
178
179 input_event(input, EV_MSC, MSC_SCAN, button);
180 input_report_key(input, remote->keymap[button], press);
181 input_sync(input);
182}
183
184/*
185 * Routine that handles all the logic needed to parse out the message from the remote.
186 */
187static void keyspan_check_data(struct usb_keyspan *remote)
188{
189 int i;
190 int found = 0;
191 struct keyspan_message message;
192
193 switch(remote->stage) {
194 case 0:
195 /*
196 * In stage 0 we want to find the start of a message. The remote sends a 0xFF as filler.
197 * So the first byte that isn't a FF should be the start of a new message.
198 */
199 for (i = 0; i < RECV_SIZE && remote->in_buffer[i] == GAP; ++i);
200
201 if (i < RECV_SIZE) {
202 memcpy(remote->data.buffer, remote->in_buffer, RECV_SIZE);
203 remote->data.len = RECV_SIZE;
204 remote->data.pos = 0;
205 remote->data.tester = 0;
206 remote->data.bits_left = 0;
207 remote->stage = 1;
208 }
209 break;
210
211 case 1:
212 /*
213 * Stage 1 we should have 16 bytes and should be able to detect a
214 * SYNC. The SYNC is 14 bits, 7 0's and then 7 1's.
215 */
216 memcpy(remote->data.buffer + remote->data.len, remote->in_buffer, RECV_SIZE);
217 remote->data.len += RECV_SIZE;
218
219 found = 0;
220 while ((remote->data.bits_left >= 14 || remote->data.pos < remote->data.len) && !found) {
221 for (i = 0; i < 8; ++i) {
222 if (keyspan_load_tester(remote, 14) != 0) {
223 remote->stage = 0;
224 return;
225 }
226
227 if ((remote->data.tester & SYNC_MASK) == SYNC) {
228 remote->data.tester = remote->data.tester >> 14;
229 remote->data.bits_left -= 14;
230 found = 1;
231 break;
232 } else {
233 remote->data.tester = remote->data.tester >> 1;
234 --remote->data.bits_left;
235 }
236 }
237 }
238
239 if (!found) {
240 remote->stage = 0;
241 remote->data.len = 0;
242 } else {
243 remote->stage = 2;
244 }
245 break;
246
247 case 2:
248 /*
249 * Stage 2 we should have 24 bytes which will be enough for a full
250 * message. We need to parse out the system code, button code,
251 * toggle code, and stop.
252 */
253 memcpy(remote->data.buffer + remote->data.len, remote->in_buffer, RECV_SIZE);
254 remote->data.len += RECV_SIZE;
255
256 message.system = 0;
257 for (i = 0; i < 9; i++) {
258 keyspan_load_tester(remote, 6);
259
260 if ((remote->data.tester & ZERO_MASK) == ZERO) {
261 message.system = message.system << 1;
262 remote->data.tester = remote->data.tester >> 5;
263 remote->data.bits_left -= 5;
264 } else if ((remote->data.tester & ONE_MASK) == ONE) {
265 message.system = (message.system << 1) + 1;
266 remote->data.tester = remote->data.tester >> 6;
267 remote->data.bits_left -= 6;
268 } else {
269 dev_err(&remote->interface->dev,
270 "%s - Unknown sequence found in system data.\n",
271 __func__);
272 remote->stage = 0;
273 return;
274 }
275 }
276
277 message.button = 0;
278 for (i = 0; i < 5; i++) {
279 keyspan_load_tester(remote, 6);
280
281 if ((remote->data.tester & ZERO_MASK) == ZERO) {
282 message.button = message.button << 1;
283 remote->data.tester = remote->data.tester >> 5;
284 remote->data.bits_left -= 5;
285 } else if ((remote->data.tester & ONE_MASK) == ONE) {
286 message.button = (message.button << 1) + 1;
287 remote->data.tester = remote->data.tester >> 6;
288 remote->data.bits_left -= 6;
289 } else {
290 dev_err(&remote->interface->dev,
291 "%s - Unknown sequence found in button data.\n",
292 __func__);
293 remote->stage = 0;
294 return;
295 }
296 }
297
298 keyspan_load_tester(remote, 6);
299 if ((remote->data.tester & ZERO_MASK) == ZERO) {
300 message.toggle = 0;
301 remote->data.tester = remote->data.tester >> 5;
302 remote->data.bits_left -= 5;
303 } else if ((remote->data.tester & ONE_MASK) == ONE) {
304 message.toggle = 1;
305 remote->data.tester = remote->data.tester >> 6;
306 remote->data.bits_left -= 6;
307 } else {
308 dev_err(&remote->interface->dev,
309 "%s - Error in message, invalid toggle.\n",
310 __func__);
311 remote->stage = 0;
312 return;
313 }
314
315 keyspan_load_tester(remote, 5);
316 if ((remote->data.tester & STOP_MASK) == STOP) {
317 remote->data.tester = remote->data.tester >> 5;
318 remote->data.bits_left -= 5;
319 } else {
320 dev_err(&remote->interface->dev,
321 "Bad message received, no stop bit found.\n");
322 }
323
324 dev_dbg(&remote->interface->dev,
325 "%s found valid message: system: %d, button: %d, toggle: %d\n",
326 __func__, message.system, message.button, message.toggle);
327
328 if (message.toggle != remote->toggle) {
329 keyspan_report_button(remote, message.button, 1);
330 keyspan_report_button(remote, message.button, 0);
331 remote->toggle = message.toggle;
332 }
333
334 remote->stage = 0;
335 break;
336 }
337}
338
339/*
340 * Routine for sending all the initialization messages to the remote.
341 */
342static int keyspan_setup(struct usb_device* dev)
343{
344 int retval = 0;
345
346 retval = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
347 0x11, 0x40, 0x5601, 0x0, NULL, 0, 0);
348 if (retval) {
349 dev_dbg(&dev->dev, "%s - failed to set bit rate due to error: %d\n",
350 __func__, retval);
351 return(retval);
352 }
353
354 retval = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
355 0x44, 0x40, 0x0, 0x0, NULL, 0, 0);
356 if (retval) {
357 dev_dbg(&dev->dev, "%s - failed to set resume sensitivity due to error: %d\n",
358 __func__, retval);
359 return(retval);
360 }
361
362 retval = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
363 0x22, 0x40, 0x0, 0x0, NULL, 0, 0);
364 if (retval) {
365 dev_dbg(&dev->dev, "%s - failed to turn receive on due to error: %d\n",
366 __func__, retval);
367 return(retval);
368 }
369
370 dev_dbg(&dev->dev, "%s - Setup complete.\n", __func__);
371 return(retval);
372}
373
374/*
375 * Routine used to handle a new message that has come in.
376 */
377static void keyspan_irq_recv(struct urb *urb)
378{
379 struct usb_keyspan *dev = urb->context;
380 int retval;
381
382 /* Check our status in case we need to bail out early. */
383 switch (urb->status) {
384 case 0:
385 break;
386
387 /* Device went away so don't keep trying to read from it. */
388 case -ECONNRESET:
389 case -ENOENT:
390 case -ESHUTDOWN:
391 return;
392
393 default:
394 goto resubmit;
395 break;
396 }
397
398 if (debug)
399 keyspan_print(dev);
400
401 keyspan_check_data(dev);
402
403resubmit:
404 retval = usb_submit_urb(urb, GFP_ATOMIC);
405 if (retval)
406 dev_err(&dev->interface->dev,
407 "%s - usb_submit_urb failed with result: %d\n",
408 __func__, retval);
409}
410
411static int keyspan_open(struct input_dev *dev)
412{
413 struct usb_keyspan *remote = input_get_drvdata(dev);
414
415 remote->irq_urb->dev = remote->udev;
416 if (usb_submit_urb(remote->irq_urb, GFP_KERNEL))
417 return -EIO;
418
419 return 0;
420}
421
422static void keyspan_close(struct input_dev *dev)
423{
424 struct usb_keyspan *remote = input_get_drvdata(dev);
425
426 usb_kill_urb(remote->irq_urb);
427}
428
429static struct usb_endpoint_descriptor *keyspan_get_in_endpoint(struct usb_host_interface *iface)
430{
431
432 struct usb_endpoint_descriptor *endpoint;
433 int i;
434
435 for (i = 0; i < iface->desc.bNumEndpoints; ++i) {
436 endpoint = &iface->endpoint[i].desc;
437
438 if (usb_endpoint_is_int_in(endpoint)) {
439 /* we found our interrupt in endpoint */
440 return endpoint;
441 }
442 }
443
444 return NULL;
445}
446
447/*
448 * Routine that sets up the driver to handle a specific USB device detected on the bus.
449 */
450static int keyspan_probe(struct usb_interface *interface, const struct usb_device_id *id)
451{
452 struct usb_device *udev = interface_to_usbdev(interface);
453 struct usb_endpoint_descriptor *endpoint;
454 struct usb_keyspan *remote;
455 struct input_dev *input_dev;
456 int i, error;
457
458 endpoint = keyspan_get_in_endpoint(interface->cur_altsetting);
459 if (!endpoint)
460 return -ENODEV;
461
462 remote = kzalloc(sizeof(*remote), GFP_KERNEL);
463 input_dev = input_allocate_device();
464 if (!remote || !input_dev) {
465 error = -ENOMEM;
466 goto fail1;
467 }
468
469 remote->udev = udev;
470 remote->input = input_dev;
471 remote->interface = interface;
472 remote->in_endpoint = endpoint;
473 remote->toggle = -1; /* Set to -1 so we will always not match the toggle from the first remote message. */
474
475 remote->in_buffer = usb_alloc_coherent(udev, RECV_SIZE, GFP_ATOMIC, &remote->in_dma);
476 if (!remote->in_buffer) {
477 error = -ENOMEM;
478 goto fail1;
479 }
480
481 remote->irq_urb = usb_alloc_urb(0, GFP_KERNEL);
482 if (!remote->irq_urb) {
483 error = -ENOMEM;
484 goto fail2;
485 }
486
487 error = keyspan_setup(udev);
488 if (error) {
489 error = -ENODEV;
490 goto fail3;
491 }
492
493 if (udev->manufacturer)
494 strlcpy(remote->name, udev->manufacturer, sizeof(remote->name));
495
496 if (udev->product) {
497 if (udev->manufacturer)
498 strlcat(remote->name, " ", sizeof(remote->name));
499 strlcat(remote->name, udev->product, sizeof(remote->name));
500 }
501
502 if (!strlen(remote->name))
503 snprintf(remote->name, sizeof(remote->name),
504 "USB Keyspan Remote %04x:%04x",
505 le16_to_cpu(udev->descriptor.idVendor),
506 le16_to_cpu(udev->descriptor.idProduct));
507
508 usb_make_path(udev, remote->phys, sizeof(remote->phys));
509 strlcat(remote->phys, "/input0", sizeof(remote->phys));
510 memcpy(remote->keymap, keyspan_key_table, sizeof(remote->keymap));
511
512 input_dev->name = remote->name;
513 input_dev->phys = remote->phys;
514 usb_to_input_id(udev, &input_dev->id);
515 input_dev->dev.parent = &interface->dev;
516 input_dev->keycode = remote->keymap;
517 input_dev->keycodesize = sizeof(unsigned short);
518 input_dev->keycodemax = ARRAY_SIZE(remote->keymap);
519
520 input_set_capability(input_dev, EV_MSC, MSC_SCAN);
521 __set_bit(EV_KEY, input_dev->evbit);
522 for (i = 0; i < ARRAY_SIZE(keyspan_key_table); i++)
523 __set_bit(keyspan_key_table[i], input_dev->keybit);
524 __clear_bit(KEY_RESERVED, input_dev->keybit);
525
526 input_set_drvdata(input_dev, remote);
527
528 input_dev->open = keyspan_open;
529 input_dev->close = keyspan_close;
530
531 /*
532 * Initialize the URB to access the device.
533 * The urb gets sent to the device in keyspan_open()
534 */
535 usb_fill_int_urb(remote->irq_urb,
536 remote->udev,
537 usb_rcvintpipe(remote->udev, endpoint->bEndpointAddress),
538 remote->in_buffer, RECV_SIZE, keyspan_irq_recv, remote,
539 endpoint->bInterval);
540 remote->irq_urb->transfer_dma = remote->in_dma;
541 remote->irq_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
542
543 /* we can register the device now, as it is ready */
544 error = input_register_device(remote->input);
545 if (error)
546 goto fail3;
547
548 /* save our data pointer in this interface device */
549 usb_set_intfdata(interface, remote);
550
551 return 0;
552
553 fail3: usb_free_urb(remote->irq_urb);
554 fail2: usb_free_coherent(udev, RECV_SIZE, remote->in_buffer, remote->in_dma);
555 fail1: kfree(remote);
556 input_free_device(input_dev);
557
558 return error;
559}
560
561/*
562 * Routine called when a device is disconnected from the USB.
563 */
564static void keyspan_disconnect(struct usb_interface *interface)
565{
566 struct usb_keyspan *remote;
567
568 remote = usb_get_intfdata(interface);
569 usb_set_intfdata(interface, NULL);
570
571 if (remote) { /* We have a valid driver structure so clean up everything we allocated. */
572 input_unregister_device(remote->input);
573 usb_kill_urb(remote->irq_urb);
574 usb_free_urb(remote->irq_urb);
575 usb_free_coherent(remote->udev, RECV_SIZE, remote->in_buffer, remote->in_dma);
576 kfree(remote);
577 }
578}
579
580/*
581 * Standard driver set up sections
582 */
583static struct usb_driver keyspan_driver =
584{
585 .name = "keyspan_remote",
586 .probe = keyspan_probe,
587 .disconnect = keyspan_disconnect,
588 .id_table = keyspan_table
589};
590
591module_usb_driver(keyspan_driver);
592
593MODULE_DEVICE_TABLE(usb, keyspan_table);
594MODULE_AUTHOR(DRIVER_AUTHOR);
595MODULE_DESCRIPTION(DRIVER_DESC);
596MODULE_LICENSE(DRIVER_LICENSE);