Loading...
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);
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/* Parameters that can be passed to the driver. */
21static int debug;
22module_param(debug, int, 0444);
23MODULE_PARM_DESC(debug, "Enable extra debug messages and information");
24
25/* Vendor and product ids */
26#define USB_KEYSPAN_VENDOR_ID 0x06CD
27#define USB_KEYSPAN_PRODUCT_UIA11 0x0202
28
29/* Defines for converting the data from the remote. */
30#define ZERO 0x18
31#define ZERO_MASK 0x1F /* 5 bits for a 0 */
32#define ONE 0x3C
33#define ONE_MASK 0x3F /* 6 bits for a 1 */
34#define SYNC 0x3F80
35#define SYNC_MASK 0x3FFF /* 14 bits for a SYNC sequence */
36#define STOP 0x00
37#define STOP_MASK 0x1F /* 5 bits for the STOP sequence */
38#define GAP 0xFF
39
40#define RECV_SIZE 8 /* The UIA-11 type have a 8 byte limit. */
41
42/*
43 * Table that maps the 31 possible keycodes to input keys.
44 * Currently there are 15 and 17 button models so RESERVED codes
45 * are blank areas in the mapping.
46 */
47static const unsigned short keyspan_key_table[] = {
48 KEY_RESERVED, /* 0 is just a place holder. */
49 KEY_RESERVED,
50 KEY_STOP,
51 KEY_PLAYCD,
52 KEY_RESERVED,
53 KEY_PREVIOUSSONG,
54 KEY_REWIND,
55 KEY_FORWARD,
56 KEY_NEXTSONG,
57 KEY_RESERVED,
58 KEY_RESERVED,
59 KEY_RESERVED,
60 KEY_PAUSE,
61 KEY_VOLUMEUP,
62 KEY_RESERVED,
63 KEY_RESERVED,
64 KEY_RESERVED,
65 KEY_VOLUMEDOWN,
66 KEY_RESERVED,
67 KEY_UP,
68 KEY_RESERVED,
69 KEY_MUTE,
70 KEY_LEFT,
71 KEY_ENTER,
72 KEY_RIGHT,
73 KEY_RESERVED,
74 KEY_RESERVED,
75 KEY_DOWN,
76 KEY_RESERVED,
77 KEY_KPASTERISK,
78 KEY_RESERVED,
79 KEY_MENU
80};
81
82/* table of devices that work with this driver */
83static const struct usb_device_id keyspan_table[] = {
84 { USB_DEVICE(USB_KEYSPAN_VENDOR_ID, USB_KEYSPAN_PRODUCT_UIA11) },
85 { } /* Terminating entry */
86};
87
88/* Structure to store all the real stuff that a remote sends to us. */
89struct keyspan_message {
90 u16 system;
91 u8 button;
92 u8 toggle;
93};
94
95/* Structure used for all the bit testing magic needed to be done. */
96struct bit_tester {
97 u32 tester;
98 int len;
99 int pos;
100 int bits_left;
101 u8 buffer[32];
102};
103
104/* Structure to hold all of our driver specific stuff */
105struct usb_keyspan {
106 char name[128];
107 char phys[64];
108 unsigned short keymap[ARRAY_SIZE(keyspan_key_table)];
109 struct usb_device *udev;
110 struct input_dev *input;
111 struct usb_interface *interface;
112 struct usb_endpoint_descriptor *in_endpoint;
113 struct urb* irq_urb;
114 int open;
115 dma_addr_t in_dma;
116 unsigned char *in_buffer;
117
118 /* variables used to parse messages from remote. */
119 struct bit_tester data;
120 int stage;
121 int toggle;
122};
123
124static struct usb_driver keyspan_driver;
125
126/*
127 * Debug routine that prints out what we've received from the remote.
128 */
129static void keyspan_print(struct usb_keyspan* dev) /*unsigned char* data)*/
130{
131 char codes[4 * RECV_SIZE];
132 int i;
133
134 for (i = 0; i < RECV_SIZE; i++)
135 snprintf(codes + i * 3, 4, "%02x ", dev->in_buffer[i]);
136
137 dev_info(&dev->udev->dev, "%s\n", codes);
138}
139
140/*
141 * Routine that manages the bit_tester structure. It makes sure that there are
142 * at least bits_needed bits loaded into the tester.
143 */
144static int keyspan_load_tester(struct usb_keyspan* dev, int bits_needed)
145{
146 if (dev->data.bits_left >= bits_needed)
147 return 0;
148
149 /*
150 * Somehow we've missed the last message. The message will be repeated
151 * though so it's not too big a deal
152 */
153 if (dev->data.pos >= dev->data.len) {
154 dev_dbg(&dev->interface->dev,
155 "%s - Error ran out of data. pos: %d, len: %d\n",
156 __func__, dev->data.pos, dev->data.len);
157 return -1;
158 }
159
160 /* Load as much as we can into the tester. */
161 while ((dev->data.bits_left + 7 < (sizeof(dev->data.tester) * 8)) &&
162 (dev->data.pos < dev->data.len)) {
163 dev->data.tester += (dev->data.buffer[dev->data.pos++] << dev->data.bits_left);
164 dev->data.bits_left += 8;
165 }
166
167 return 0;
168}
169
170static void keyspan_report_button(struct usb_keyspan *remote, int button, int press)
171{
172 struct input_dev *input = remote->input;
173
174 input_event(input, EV_MSC, MSC_SCAN, button);
175 input_report_key(input, remote->keymap[button], press);
176 input_sync(input);
177}
178
179/*
180 * Routine that handles all the logic needed to parse out the message from the remote.
181 */
182static void keyspan_check_data(struct usb_keyspan *remote)
183{
184 int i;
185 int found = 0;
186 struct keyspan_message message;
187
188 switch(remote->stage) {
189 case 0:
190 /*
191 * In stage 0 we want to find the start of a message. The remote sends a 0xFF as filler.
192 * So the first byte that isn't a FF should be the start of a new message.
193 */
194 for (i = 0; i < RECV_SIZE && remote->in_buffer[i] == GAP; ++i);
195
196 if (i < RECV_SIZE) {
197 memcpy(remote->data.buffer, remote->in_buffer, RECV_SIZE);
198 remote->data.len = RECV_SIZE;
199 remote->data.pos = 0;
200 remote->data.tester = 0;
201 remote->data.bits_left = 0;
202 remote->stage = 1;
203 }
204 break;
205
206 case 1:
207 /*
208 * Stage 1 we should have 16 bytes and should be able to detect a
209 * SYNC. The SYNC is 14 bits, 7 0's and then 7 1's.
210 */
211 memcpy(remote->data.buffer + remote->data.len, remote->in_buffer, RECV_SIZE);
212 remote->data.len += RECV_SIZE;
213
214 found = 0;
215 while ((remote->data.bits_left >= 14 || remote->data.pos < remote->data.len) && !found) {
216 for (i = 0; i < 8; ++i) {
217 if (keyspan_load_tester(remote, 14) != 0) {
218 remote->stage = 0;
219 return;
220 }
221
222 if ((remote->data.tester & SYNC_MASK) == SYNC) {
223 remote->data.tester = remote->data.tester >> 14;
224 remote->data.bits_left -= 14;
225 found = 1;
226 break;
227 } else {
228 remote->data.tester = remote->data.tester >> 1;
229 --remote->data.bits_left;
230 }
231 }
232 }
233
234 if (!found) {
235 remote->stage = 0;
236 remote->data.len = 0;
237 } else {
238 remote->stage = 2;
239 }
240 break;
241
242 case 2:
243 /*
244 * Stage 2 we should have 24 bytes which will be enough for a full
245 * message. We need to parse out the system code, button code,
246 * toggle code, and stop.
247 */
248 memcpy(remote->data.buffer + remote->data.len, remote->in_buffer, RECV_SIZE);
249 remote->data.len += RECV_SIZE;
250
251 message.system = 0;
252 for (i = 0; i < 9; i++) {
253 keyspan_load_tester(remote, 6);
254
255 if ((remote->data.tester & ZERO_MASK) == ZERO) {
256 message.system = message.system << 1;
257 remote->data.tester = remote->data.tester >> 5;
258 remote->data.bits_left -= 5;
259 } else if ((remote->data.tester & ONE_MASK) == ONE) {
260 message.system = (message.system << 1) + 1;
261 remote->data.tester = remote->data.tester >> 6;
262 remote->data.bits_left -= 6;
263 } else {
264 dev_err(&remote->interface->dev,
265 "%s - Unknown sequence found in system data.\n",
266 __func__);
267 remote->stage = 0;
268 return;
269 }
270 }
271
272 message.button = 0;
273 for (i = 0; i < 5; i++) {
274 keyspan_load_tester(remote, 6);
275
276 if ((remote->data.tester & ZERO_MASK) == ZERO) {
277 message.button = message.button << 1;
278 remote->data.tester = remote->data.tester >> 5;
279 remote->data.bits_left -= 5;
280 } else if ((remote->data.tester & ONE_MASK) == ONE) {
281 message.button = (message.button << 1) + 1;
282 remote->data.tester = remote->data.tester >> 6;
283 remote->data.bits_left -= 6;
284 } else {
285 dev_err(&remote->interface->dev,
286 "%s - Unknown sequence found in button data.\n",
287 __func__);
288 remote->stage = 0;
289 return;
290 }
291 }
292
293 keyspan_load_tester(remote, 6);
294 if ((remote->data.tester & ZERO_MASK) == ZERO) {
295 message.toggle = 0;
296 remote->data.tester = remote->data.tester >> 5;
297 remote->data.bits_left -= 5;
298 } else if ((remote->data.tester & ONE_MASK) == ONE) {
299 message.toggle = 1;
300 remote->data.tester = remote->data.tester >> 6;
301 remote->data.bits_left -= 6;
302 } else {
303 dev_err(&remote->interface->dev,
304 "%s - Error in message, invalid toggle.\n",
305 __func__);
306 remote->stage = 0;
307 return;
308 }
309
310 keyspan_load_tester(remote, 5);
311 if ((remote->data.tester & STOP_MASK) == STOP) {
312 remote->data.tester = remote->data.tester >> 5;
313 remote->data.bits_left -= 5;
314 } else {
315 dev_err(&remote->interface->dev,
316 "Bad message received, no stop bit found.\n");
317 }
318
319 dev_dbg(&remote->interface->dev,
320 "%s found valid message: system: %d, button: %d, toggle: %d\n",
321 __func__, message.system, message.button, message.toggle);
322
323 if (message.toggle != remote->toggle) {
324 keyspan_report_button(remote, message.button, 1);
325 keyspan_report_button(remote, message.button, 0);
326 remote->toggle = message.toggle;
327 }
328
329 remote->stage = 0;
330 break;
331 }
332}
333
334/*
335 * Routine for sending all the initialization messages to the remote.
336 */
337static int keyspan_setup(struct usb_device* dev)
338{
339 int retval = 0;
340
341 retval = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
342 0x11, 0x40, 0x5601, 0x0, NULL, 0, 0);
343 if (retval) {
344 dev_dbg(&dev->dev, "%s - failed to set bit rate due to error: %d\n",
345 __func__, retval);
346 return(retval);
347 }
348
349 retval = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
350 0x44, 0x40, 0x0, 0x0, NULL, 0, 0);
351 if (retval) {
352 dev_dbg(&dev->dev, "%s - failed to set resume sensitivity due to error: %d\n",
353 __func__, retval);
354 return(retval);
355 }
356
357 retval = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
358 0x22, 0x40, 0x0, 0x0, NULL, 0, 0);
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_ATOMIC, &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 strlcpy(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");