1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * ati_remote2 - ATI/Philips USB RF remote driver
4 *
5 * Copyright (C) 2005-2008 Ville Syrjala <syrjala@sci.fi>
6 * Copyright (C) 2007-2008 Peter Stokes <linux@dadeos.co.uk>
7 */
8
9 #include <linux/usb/input.h>
10 #include <linux/slab.h>
11 #include <linux/module.h>
12
13 #define DRIVER_DESC "ATI/Philips USB RF remote driver"
14
15 MODULE_DESCRIPTION(DRIVER_DESC);
16 MODULE_AUTHOR("Ville Syrjala <syrjala@sci.fi>");
17 MODULE_LICENSE("GPL");
18
19 /*
20 * ATI Remote Wonder II Channel Configuration
21 *
22 * The remote control can be assigned one of sixteen "channels" in order to facilitate
23 * the use of multiple remote controls within range of each other.
24 * A remote's "channel" may be altered by pressing and holding the "PC" button for
25 * approximately 3 seconds, after which the button will slowly flash the count of the
26 * currently configured "channel", using the numeric keypad enter a number between 1 and
27 * 16 and then press the "PC" button again, the button will slowly flash the count of the
28 * newly configured "channel".
29 */
30
31 enum {
32 ATI_REMOTE2_MAX_CHANNEL_MASK = 0xFFFF,
33 ATI_REMOTE2_MAX_MODE_MASK = 0x1F,
34 };
35
ati_remote2_set_mask(const char * val,const struct kernel_param * kp,unsigned int max)36 static int ati_remote2_set_mask(const char *val,
37 const struct kernel_param *kp,
38 unsigned int max)
39 {
40 unsigned int mask;
41 int ret;
42
43 if (!val)
44 return -EINVAL;
45
46 ret = kstrtouint(val, 0, &mask);
47 if (ret)
48 return ret;
49
50 if (mask & ~max)
51 return -EINVAL;
52
53 *(unsigned int *)kp->arg = mask;
54
55 return 0;
56 }
57
ati_remote2_set_channel_mask(const char * val,const struct kernel_param * kp)58 static int ati_remote2_set_channel_mask(const char *val,
59 const struct kernel_param *kp)
60 {
61 pr_debug("%s()\n", __func__);
62
63 return ati_remote2_set_mask(val, kp, ATI_REMOTE2_MAX_CHANNEL_MASK);
64 }
65
ati_remote2_get_channel_mask(char * buffer,const struct kernel_param * kp)66 static int ati_remote2_get_channel_mask(char *buffer,
67 const struct kernel_param *kp)
68 {
69 pr_debug("%s()\n", __func__);
70
71 return sprintf(buffer, "0x%04x\n", *(unsigned int *)kp->arg);
72 }
73
ati_remote2_set_mode_mask(const char * val,const struct kernel_param * kp)74 static int ati_remote2_set_mode_mask(const char *val,
75 const struct kernel_param *kp)
76 {
77 pr_debug("%s()\n", __func__);
78
79 return ati_remote2_set_mask(val, kp, ATI_REMOTE2_MAX_MODE_MASK);
80 }
81
ati_remote2_get_mode_mask(char * buffer,const struct kernel_param * kp)82 static int ati_remote2_get_mode_mask(char *buffer,
83 const struct kernel_param *kp)
84 {
85 pr_debug("%s()\n", __func__);
86
87 return sprintf(buffer, "0x%02x\n", *(unsigned int *)kp->arg);
88 }
89
90 static unsigned int channel_mask = ATI_REMOTE2_MAX_CHANNEL_MASK;
91 #define param_check_channel_mask(name, p) __param_check(name, p, unsigned int)
92 static const struct kernel_param_ops param_ops_channel_mask = {
93 .set = ati_remote2_set_channel_mask,
94 .get = ati_remote2_get_channel_mask,
95 };
96 module_param(channel_mask, channel_mask, 0644);
97 MODULE_PARM_DESC(channel_mask, "Bitmask of channels to accept <15:Channel16>...<1:Channel2><0:Channel1>");
98
99 static unsigned int mode_mask = ATI_REMOTE2_MAX_MODE_MASK;
100 #define param_check_mode_mask(name, p) __param_check(name, p, unsigned int)
101 static const struct kernel_param_ops param_ops_mode_mask = {
102 .set = ati_remote2_set_mode_mask,
103 .get = ati_remote2_get_mode_mask,
104 };
105 module_param(mode_mask, mode_mask, 0644);
106 MODULE_PARM_DESC(mode_mask, "Bitmask of modes to accept <4:PC><3:AUX4><2:AUX3><1:AUX2><0:AUX1>");
107
108 static const struct usb_device_id ati_remote2_id_table[] = {
109 { USB_DEVICE(0x0471, 0x0602) }, /* ATI Remote Wonder II */
110 { }
111 };
112 MODULE_DEVICE_TABLE(usb, ati_remote2_id_table);
113
114 static DEFINE_MUTEX(ati_remote2_mutex);
115
116 enum {
117 ATI_REMOTE2_OPENED = 0x1,
118 ATI_REMOTE2_SUSPENDED = 0x2,
119 };
120
121 enum {
122 ATI_REMOTE2_AUX1,
123 ATI_REMOTE2_AUX2,
124 ATI_REMOTE2_AUX3,
125 ATI_REMOTE2_AUX4,
126 ATI_REMOTE2_PC,
127 ATI_REMOTE2_MODES,
128 };
129
130 static const struct {
131 u8 hw_code;
132 u16 keycode;
133 } ati_remote2_key_table[] = {
134 { 0x00, KEY_0 },
135 { 0x01, KEY_1 },
136 { 0x02, KEY_2 },
137 { 0x03, KEY_3 },
138 { 0x04, KEY_4 },
139 { 0x05, KEY_5 },
140 { 0x06, KEY_6 },
141 { 0x07, KEY_7 },
142 { 0x08, KEY_8 },
143 { 0x09, KEY_9 },
144 { 0x0c, KEY_POWER },
145 { 0x0d, KEY_MUTE },
146 { 0x10, KEY_VOLUMEUP },
147 { 0x11, KEY_VOLUMEDOWN },
148 { 0x20, KEY_CHANNELUP },
149 { 0x21, KEY_CHANNELDOWN },
150 { 0x28, KEY_FORWARD },
151 { 0x29, KEY_REWIND },
152 { 0x2c, KEY_PLAY },
153 { 0x30, KEY_PAUSE },
154 { 0x31, KEY_STOP },
155 { 0x37, KEY_RECORD },
156 { 0x38, KEY_DVD },
157 { 0x39, KEY_TV },
158 { 0x3f, KEY_PROG1 }, /* AUX1-AUX4 and PC */
159 { 0x54, KEY_MENU },
160 { 0x58, KEY_UP },
161 { 0x59, KEY_DOWN },
162 { 0x5a, KEY_LEFT },
163 { 0x5b, KEY_RIGHT },
164 { 0x5c, KEY_OK },
165 { 0x78, KEY_A },
166 { 0x79, KEY_B },
167 { 0x7a, KEY_C },
168 { 0x7b, KEY_D },
169 { 0x7c, KEY_E },
170 { 0x7d, KEY_F },
171 { 0x82, KEY_ENTER },
172 { 0x8e, KEY_VENDOR },
173 { 0x96, KEY_COFFEE },
174 { 0xa9, BTN_LEFT },
175 { 0xaa, BTN_RIGHT },
176 { 0xbe, KEY_QUESTION },
177 { 0xd0, KEY_EDIT },
178 { 0xd5, KEY_FRONT },
179 { 0xf9, KEY_INFO },
180 };
181
182 struct ati_remote2 {
183 struct input_dev *idev;
184 struct usb_device *udev;
185
186 struct usb_interface *intf[2];
187 struct usb_endpoint_descriptor *ep[2];
188 struct urb *urb[2];
189 void *buf[2];
190 dma_addr_t buf_dma[2];
191
192 unsigned long jiffies;
193 int mode;
194
195 char name[64];
196 char phys[64];
197
198 /* Each mode (AUX1-AUX4 and PC) can have an independent keymap. */
199 u16 keycode[ATI_REMOTE2_MODES][ARRAY_SIZE(ati_remote2_key_table)];
200
201 unsigned int flags;
202
203 unsigned int channel_mask;
204 unsigned int mode_mask;
205 };
206
207 static int ati_remote2_probe(struct usb_interface *interface, const struct usb_device_id *id);
208 static void ati_remote2_disconnect(struct usb_interface *interface);
209 static int ati_remote2_suspend(struct usb_interface *interface, pm_message_t message);
210 static int ati_remote2_resume(struct usb_interface *interface);
211 static int ati_remote2_reset_resume(struct usb_interface *interface);
212 static int ati_remote2_pre_reset(struct usb_interface *interface);
213 static int ati_remote2_post_reset(struct usb_interface *interface);
214
215 static struct usb_driver ati_remote2_driver = {
216 .name = "ati_remote2",
217 .probe = ati_remote2_probe,
218 .disconnect = ati_remote2_disconnect,
219 .id_table = ati_remote2_id_table,
220 .suspend = ati_remote2_suspend,
221 .resume = ati_remote2_resume,
222 .reset_resume = ati_remote2_reset_resume,
223 .pre_reset = ati_remote2_pre_reset,
224 .post_reset = ati_remote2_post_reset,
225 .supports_autosuspend = 1,
226 };
227
ati_remote2_submit_urbs(struct ati_remote2 * ar2)228 static int ati_remote2_submit_urbs(struct ati_remote2 *ar2)
229 {
230 int r;
231
232 r = usb_submit_urb(ar2->urb[0], GFP_KERNEL);
233 if (r) {
234 dev_err(&ar2->intf[0]->dev,
235 "%s(): usb_submit_urb() = %d\n", __func__, r);
236 return r;
237 }
238 r = usb_submit_urb(ar2->urb[1], GFP_KERNEL);
239 if (r) {
240 usb_kill_urb(ar2->urb[0]);
241 dev_err(&ar2->intf[1]->dev,
242 "%s(): usb_submit_urb() = %d\n", __func__, r);
243 return r;
244 }
245
246 return 0;
247 }
248
ati_remote2_kill_urbs(struct ati_remote2 * ar2)249 static void ati_remote2_kill_urbs(struct ati_remote2 *ar2)
250 {
251 usb_kill_urb(ar2->urb[1]);
252 usb_kill_urb(ar2->urb[0]);
253 }
254
ati_remote2_open(struct input_dev * idev)255 static int ati_remote2_open(struct input_dev *idev)
256 {
257 struct ati_remote2 *ar2 = input_get_drvdata(idev);
258 int r;
259
260 dev_dbg(&ar2->intf[0]->dev, "%s()\n", __func__);
261
262 r = usb_autopm_get_interface(ar2->intf[0]);
263 if (r) {
264 dev_err(&ar2->intf[0]->dev,
265 "%s(): usb_autopm_get_interface() = %d\n", __func__, r);
266 goto fail1;
267 }
268
269 mutex_lock(&ati_remote2_mutex);
270
271 if (!(ar2->flags & ATI_REMOTE2_SUSPENDED)) {
272 r = ati_remote2_submit_urbs(ar2);
273 if (r)
274 goto fail2;
275 }
276
277 ar2->flags |= ATI_REMOTE2_OPENED;
278
279 mutex_unlock(&ati_remote2_mutex);
280
281 usb_autopm_put_interface(ar2->intf[0]);
282
283 return 0;
284
285 fail2:
286 mutex_unlock(&ati_remote2_mutex);
287 usb_autopm_put_interface(ar2->intf[0]);
288 fail1:
289 return r;
290 }
291
ati_remote2_close(struct input_dev * idev)292 static void ati_remote2_close(struct input_dev *idev)
293 {
294 struct ati_remote2 *ar2 = input_get_drvdata(idev);
295
296 dev_dbg(&ar2->intf[0]->dev, "%s()\n", __func__);
297
298 mutex_lock(&ati_remote2_mutex);
299
300 if (!(ar2->flags & ATI_REMOTE2_SUSPENDED))
301 ati_remote2_kill_urbs(ar2);
302
303 ar2->flags &= ~ATI_REMOTE2_OPENED;
304
305 mutex_unlock(&ati_remote2_mutex);
306 }
307
ati_remote2_input_mouse(struct ati_remote2 * ar2)308 static void ati_remote2_input_mouse(struct ati_remote2 *ar2)
309 {
310 struct input_dev *idev = ar2->idev;
311 u8 *data = ar2->buf[0];
312 int channel, mode;
313
314 channel = data[0] >> 4;
315
316 if (!((1 << channel) & ar2->channel_mask))
317 return;
318
319 mode = data[0] & 0x0F;
320
321 if (mode > ATI_REMOTE2_PC) {
322 dev_err(&ar2->intf[0]->dev,
323 "Unknown mode byte (%02x %02x %02x %02x)\n",
324 data[3], data[2], data[1], data[0]);
325 return;
326 }
327
328 if (!((1 << mode) & ar2->mode_mask))
329 return;
330
331 input_event(idev, EV_REL, REL_X, (s8) data[1]);
332 input_event(idev, EV_REL, REL_Y, (s8) data[2]);
333 input_sync(idev);
334 }
335
ati_remote2_lookup(unsigned int hw_code)336 static int ati_remote2_lookup(unsigned int hw_code)
337 {
338 int i;
339
340 for (i = 0; i < ARRAY_SIZE(ati_remote2_key_table); i++)
341 if (ati_remote2_key_table[i].hw_code == hw_code)
342 return i;
343
344 return -1;
345 }
346
ati_remote2_input_key(struct ati_remote2 * ar2)347 static void ati_remote2_input_key(struct ati_remote2 *ar2)
348 {
349 struct input_dev *idev = ar2->idev;
350 u8 *data = ar2->buf[1];
351 int channel, mode, hw_code, index;
352
353 channel = data[0] >> 4;
354
355 if (!((1 << channel) & ar2->channel_mask))
356 return;
357
358 mode = data[0] & 0x0F;
359
360 if (mode > ATI_REMOTE2_PC) {
361 dev_err(&ar2->intf[1]->dev,
362 "Unknown mode byte (%02x %02x %02x %02x)\n",
363 data[3], data[2], data[1], data[0]);
364 return;
365 }
366
367 hw_code = data[2];
368 if (hw_code == 0x3f) {
369 /*
370 * For some incomprehensible reason the mouse pad generates
371 * events which look identical to the events from the last
372 * pressed mode key. Naturally we don't want to generate key
373 * events for the mouse pad so we filter out any subsequent
374 * events from the same mode key.
375 */
376 if (ar2->mode == mode)
377 return;
378
379 if (data[1] == 0)
380 ar2->mode = mode;
381 }
382
383 if (!((1 << mode) & ar2->mode_mask))
384 return;
385
386 index = ati_remote2_lookup(hw_code);
387 if (index < 0) {
388 dev_err(&ar2->intf[1]->dev,
389 "Unknown code byte (%02x %02x %02x %02x)\n",
390 data[3], data[2], data[1], data[0]);
391 return;
392 }
393
394 switch (data[1]) {
395 case 0: /* release */
396 break;
397 case 1: /* press */
398 ar2->jiffies = jiffies + msecs_to_jiffies(idev->rep[REP_DELAY]);
399 break;
400 case 2: /* repeat */
401
402 /* No repeat for mouse buttons. */
403 if (ar2->keycode[mode][index] == BTN_LEFT ||
404 ar2->keycode[mode][index] == BTN_RIGHT)
405 return;
406
407 if (!time_after_eq(jiffies, ar2->jiffies))
408 return;
409
410 ar2->jiffies = jiffies + msecs_to_jiffies(idev->rep[REP_PERIOD]);
411 break;
412 default:
413 dev_err(&ar2->intf[1]->dev,
414 "Unknown state byte (%02x %02x %02x %02x)\n",
415 data[3], data[2], data[1], data[0]);
416 return;
417 }
418
419 input_event(idev, EV_KEY, ar2->keycode[mode][index], data[1]);
420 input_sync(idev);
421 }
422
ati_remote2_complete_mouse(struct urb * urb)423 static void ati_remote2_complete_mouse(struct urb *urb)
424 {
425 struct ati_remote2 *ar2 = urb->context;
426 int r;
427
428 switch (urb->status) {
429 case 0:
430 usb_mark_last_busy(ar2->udev);
431 ati_remote2_input_mouse(ar2);
432 break;
433 case -ENOENT:
434 case -EILSEQ:
435 case -ECONNRESET:
436 case -ESHUTDOWN:
437 dev_dbg(&ar2->intf[0]->dev,
438 "%s(): urb status = %d\n", __func__, urb->status);
439 return;
440 default:
441 usb_mark_last_busy(ar2->udev);
442 dev_err(&ar2->intf[0]->dev,
443 "%s(): urb status = %d\n", __func__, urb->status);
444 }
445
446 r = usb_submit_urb(urb, GFP_ATOMIC);
447 if (r)
448 dev_err(&ar2->intf[0]->dev,
449 "%s(): usb_submit_urb() = %d\n", __func__, r);
450 }
451
ati_remote2_complete_key(struct urb * urb)452 static void ati_remote2_complete_key(struct urb *urb)
453 {
454 struct ati_remote2 *ar2 = urb->context;
455 int r;
456
457 switch (urb->status) {
458 case 0:
459 usb_mark_last_busy(ar2->udev);
460 ati_remote2_input_key(ar2);
461 break;
462 case -ENOENT:
463 case -EILSEQ:
464 case -ECONNRESET:
465 case -ESHUTDOWN:
466 dev_dbg(&ar2->intf[1]->dev,
467 "%s(): urb status = %d\n", __func__, urb->status);
468 return;
469 default:
470 usb_mark_last_busy(ar2->udev);
471 dev_err(&ar2->intf[1]->dev,
472 "%s(): urb status = %d\n", __func__, urb->status);
473 }
474
475 r = usb_submit_urb(urb, GFP_ATOMIC);
476 if (r)
477 dev_err(&ar2->intf[1]->dev,
478 "%s(): usb_submit_urb() = %d\n", __func__, r);
479 }
480
ati_remote2_getkeycode(struct input_dev * idev,struct input_keymap_entry * ke)481 static int ati_remote2_getkeycode(struct input_dev *idev,
482 struct input_keymap_entry *ke)
483 {
484 struct ati_remote2 *ar2 = input_get_drvdata(idev);
485 unsigned int mode;
486 int offset;
487 unsigned int index;
488 unsigned int scancode;
489
490 if (ke->flags & INPUT_KEYMAP_BY_INDEX) {
491 index = ke->index;
492 if (index >= ATI_REMOTE2_MODES *
493 ARRAY_SIZE(ati_remote2_key_table))
494 return -EINVAL;
495
496 mode = ke->index / ARRAY_SIZE(ati_remote2_key_table);
497 offset = ke->index % ARRAY_SIZE(ati_remote2_key_table);
498 scancode = (mode << 8) + ati_remote2_key_table[offset].hw_code;
499 } else {
500 if (input_scancode_to_scalar(ke, &scancode))
501 return -EINVAL;
502
503 mode = scancode >> 8;
504 if (mode > ATI_REMOTE2_PC)
505 return -EINVAL;
506
507 offset = ati_remote2_lookup(scancode & 0xff);
508 if (offset < 0)
509 return -EINVAL;
510
511 index = mode * ARRAY_SIZE(ati_remote2_key_table) + offset;
512 }
513
514 ke->keycode = ar2->keycode[mode][offset];
515 ke->len = sizeof(scancode);
516 memcpy(&ke->scancode, &scancode, sizeof(scancode));
517 ke->index = index;
518
519 return 0;
520 }
521
ati_remote2_setkeycode(struct input_dev * idev,const struct input_keymap_entry * ke,unsigned int * old_keycode)522 static int ati_remote2_setkeycode(struct input_dev *idev,
523 const struct input_keymap_entry *ke,
524 unsigned int *old_keycode)
525 {
526 struct ati_remote2 *ar2 = input_get_drvdata(idev);
527 unsigned int mode;
528 int offset;
529 unsigned int index;
530 unsigned int scancode;
531
532 if (ke->flags & INPUT_KEYMAP_BY_INDEX) {
533 if (ke->index >= ATI_REMOTE2_MODES *
534 ARRAY_SIZE(ati_remote2_key_table))
535 return -EINVAL;
536
537 mode = ke->index / ARRAY_SIZE(ati_remote2_key_table);
538 offset = ke->index % ARRAY_SIZE(ati_remote2_key_table);
539 } else {
540 if (input_scancode_to_scalar(ke, &scancode))
541 return -EINVAL;
542
543 mode = scancode >> 8;
544 if (mode > ATI_REMOTE2_PC)
545 return -EINVAL;
546
547 offset = ati_remote2_lookup(scancode & 0xff);
548 if (offset < 0)
549 return -EINVAL;
550 }
551
552 *old_keycode = ar2->keycode[mode][offset];
553 ar2->keycode[mode][offset] = ke->keycode;
554 __set_bit(ke->keycode, idev->keybit);
555
556 for (mode = 0; mode < ATI_REMOTE2_MODES; mode++) {
557 for (index = 0; index < ARRAY_SIZE(ati_remote2_key_table); index++) {
558 if (ar2->keycode[mode][index] == *old_keycode)
559 return 0;
560 }
561 }
562
563 __clear_bit(*old_keycode, idev->keybit);
564
565 return 0;
566 }
567
ati_remote2_input_init(struct ati_remote2 * ar2)568 static int ati_remote2_input_init(struct ati_remote2 *ar2)
569 {
570 struct input_dev *idev;
571 int index, mode, retval;
572
573 idev = input_allocate_device();
574 if (!idev)
575 return -ENOMEM;
576
577 ar2->idev = idev;
578 input_set_drvdata(idev, ar2);
579
580 idev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REP) | BIT_MASK(EV_REL);
581 idev->keybit[BIT_WORD(BTN_MOUSE)] = BIT_MASK(BTN_LEFT) |
582 BIT_MASK(BTN_RIGHT);
583 idev->relbit[0] = BIT_MASK(REL_X) | BIT_MASK(REL_Y);
584
585 for (mode = 0; mode < ATI_REMOTE2_MODES; mode++) {
586 for (index = 0; index < ARRAY_SIZE(ati_remote2_key_table); index++) {
587 ar2->keycode[mode][index] = ati_remote2_key_table[index].keycode;
588 __set_bit(ar2->keycode[mode][index], idev->keybit);
589 }
590 }
591
592 /* AUX1-AUX4 and PC generate the same scancode. */
593 index = ati_remote2_lookup(0x3f);
594 ar2->keycode[ATI_REMOTE2_AUX1][index] = KEY_PROG1;
595 ar2->keycode[ATI_REMOTE2_AUX2][index] = KEY_PROG2;
596 ar2->keycode[ATI_REMOTE2_AUX3][index] = KEY_PROG3;
597 ar2->keycode[ATI_REMOTE2_AUX4][index] = KEY_PROG4;
598 ar2->keycode[ATI_REMOTE2_PC][index] = KEY_PC;
599 __set_bit(KEY_PROG1, idev->keybit);
600 __set_bit(KEY_PROG2, idev->keybit);
601 __set_bit(KEY_PROG3, idev->keybit);
602 __set_bit(KEY_PROG4, idev->keybit);
603 __set_bit(KEY_PC, idev->keybit);
604
605 idev->rep[REP_DELAY] = 250;
606 idev->rep[REP_PERIOD] = 33;
607
608 idev->open = ati_remote2_open;
609 idev->close = ati_remote2_close;
610
611 idev->getkeycode = ati_remote2_getkeycode;
612 idev->setkeycode = ati_remote2_setkeycode;
613
614 idev->name = ar2->name;
615 idev->phys = ar2->phys;
616
617 usb_to_input_id(ar2->udev, &idev->id);
618 idev->dev.parent = &ar2->udev->dev;
619
620 retval = input_register_device(idev);
621 if (retval)
622 input_free_device(idev);
623
624 return retval;
625 }
626
ati_remote2_urb_init(struct ati_remote2 * ar2)627 static int ati_remote2_urb_init(struct ati_remote2 *ar2)
628 {
629 struct usb_device *udev = ar2->udev;
630 int i, pipe, maxp;
631
632 for (i = 0; i < 2; i++) {
633 ar2->buf[i] = usb_alloc_coherent(udev, 4, GFP_KERNEL, &ar2->buf_dma[i]);
634 if (!ar2->buf[i])
635 return -ENOMEM;
636
637 ar2->urb[i] = usb_alloc_urb(0, GFP_KERNEL);
638 if (!ar2->urb[i])
639 return -ENOMEM;
640
641 pipe = usb_rcvintpipe(udev, ar2->ep[i]->bEndpointAddress);
642 maxp = usb_maxpacket(udev, pipe, usb_pipeout(pipe));
643 maxp = maxp > 4 ? 4 : maxp;
644
645 usb_fill_int_urb(ar2->urb[i], udev, pipe, ar2->buf[i], maxp,
646 i ? ati_remote2_complete_key : ati_remote2_complete_mouse,
647 ar2, ar2->ep[i]->bInterval);
648 ar2->urb[i]->transfer_dma = ar2->buf_dma[i];
649 ar2->urb[i]->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
650 }
651
652 return 0;
653 }
654
ati_remote2_urb_cleanup(struct ati_remote2 * ar2)655 static void ati_remote2_urb_cleanup(struct ati_remote2 *ar2)
656 {
657 int i;
658
659 for (i = 0; i < 2; i++) {
660 usb_free_urb(ar2->urb[i]);
661 usb_free_coherent(ar2->udev, 4, ar2->buf[i], ar2->buf_dma[i]);
662 }
663 }
664
ati_remote2_setup(struct ati_remote2 * ar2,unsigned int ch_mask)665 static int ati_remote2_setup(struct ati_remote2 *ar2, unsigned int ch_mask)
666 {
667 int r, i, channel;
668
669 /*
670 * Configure receiver to only accept input from remote "channel"
671 * channel == 0 -> Accept input from any remote channel
672 * channel == 1 -> Only accept input from remote channel 1
673 * channel == 2 -> Only accept input from remote channel 2
674 * ...
675 * channel == 16 -> Only accept input from remote channel 16
676 */
677
678 channel = 0;
679 for (i = 0; i < 16; i++) {
680 if ((1 << i) & ch_mask) {
681 if (!(~(1 << i) & ch_mask))
682 channel = i + 1;
683 break;
684 }
685 }
686
687 r = usb_control_msg(ar2->udev, usb_sndctrlpipe(ar2->udev, 0),
688 0x20,
689 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
690 channel, 0x0, NULL, 0, USB_CTRL_SET_TIMEOUT);
691 if (r) {
692 dev_err(&ar2->udev->dev, "%s - failed to set channel due to error: %d\n",
693 __func__, r);
694 return r;
695 }
696
697 return 0;
698 }
699
ati_remote2_show_channel_mask(struct device * dev,struct device_attribute * attr,char * buf)700 static ssize_t ati_remote2_show_channel_mask(struct device *dev,
701 struct device_attribute *attr,
702 char *buf)
703 {
704 struct usb_device *udev = to_usb_device(dev);
705 struct usb_interface *intf = usb_ifnum_to_if(udev, 0);
706 struct ati_remote2 *ar2 = usb_get_intfdata(intf);
707
708 return sprintf(buf, "0x%04x\n", ar2->channel_mask);
709 }
710
ati_remote2_store_channel_mask(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)711 static ssize_t ati_remote2_store_channel_mask(struct device *dev,
712 struct device_attribute *attr,
713 const char *buf, size_t count)
714 {
715 struct usb_device *udev = to_usb_device(dev);
716 struct usb_interface *intf = usb_ifnum_to_if(udev, 0);
717 struct ati_remote2 *ar2 = usb_get_intfdata(intf);
718 unsigned int mask;
719 int r;
720
721 r = kstrtouint(buf, 0, &mask);
722 if (r)
723 return r;
724
725 if (mask & ~ATI_REMOTE2_MAX_CHANNEL_MASK)
726 return -EINVAL;
727
728 r = usb_autopm_get_interface(ar2->intf[0]);
729 if (r) {
730 dev_err(&ar2->intf[0]->dev,
731 "%s(): usb_autopm_get_interface() = %d\n", __func__, r);
732 return r;
733 }
734
735 mutex_lock(&ati_remote2_mutex);
736
737 if (mask != ar2->channel_mask) {
738 r = ati_remote2_setup(ar2, mask);
739 if (!r)
740 ar2->channel_mask = mask;
741 }
742
743 mutex_unlock(&ati_remote2_mutex);
744
745 usb_autopm_put_interface(ar2->intf[0]);
746
747 return r ? r : count;
748 }
749
ati_remote2_show_mode_mask(struct device * dev,struct device_attribute * attr,char * buf)750 static ssize_t ati_remote2_show_mode_mask(struct device *dev,
751 struct device_attribute *attr,
752 char *buf)
753 {
754 struct usb_device *udev = to_usb_device(dev);
755 struct usb_interface *intf = usb_ifnum_to_if(udev, 0);
756 struct ati_remote2 *ar2 = usb_get_intfdata(intf);
757
758 return sprintf(buf, "0x%02x\n", ar2->mode_mask);
759 }
760
ati_remote2_store_mode_mask(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)761 static ssize_t ati_remote2_store_mode_mask(struct device *dev,
762 struct device_attribute *attr,
763 const char *buf, size_t count)
764 {
765 struct usb_device *udev = to_usb_device(dev);
766 struct usb_interface *intf = usb_ifnum_to_if(udev, 0);
767 struct ati_remote2 *ar2 = usb_get_intfdata(intf);
768 unsigned int mask;
769 int err;
770
771 err = kstrtouint(buf, 0, &mask);
772 if (err)
773 return err;
774
775 if (mask & ~ATI_REMOTE2_MAX_MODE_MASK)
776 return -EINVAL;
777
778 ar2->mode_mask = mask;
779
780 return count;
781 }
782
783 static DEVICE_ATTR(channel_mask, 0644, ati_remote2_show_channel_mask,
784 ati_remote2_store_channel_mask);
785
786 static DEVICE_ATTR(mode_mask, 0644, ati_remote2_show_mode_mask,
787 ati_remote2_store_mode_mask);
788
789 static struct attribute *ati_remote2_attrs[] = {
790 &dev_attr_channel_mask.attr,
791 &dev_attr_mode_mask.attr,
792 NULL,
793 };
794
795 static struct attribute_group ati_remote2_attr_group = {
796 .attrs = ati_remote2_attrs,
797 };
798
ati_remote2_probe(struct usb_interface * interface,const struct usb_device_id * id)799 static int ati_remote2_probe(struct usb_interface *interface, const struct usb_device_id *id)
800 {
801 struct usb_device *udev = interface_to_usbdev(interface);
802 struct usb_host_interface *alt = interface->cur_altsetting;
803 struct ati_remote2 *ar2;
804 int r;
805
806 if (alt->desc.bInterfaceNumber)
807 return -ENODEV;
808
809 ar2 = kzalloc(sizeof (struct ati_remote2), GFP_KERNEL);
810 if (!ar2)
811 return -ENOMEM;
812
813 ar2->udev = udev;
814
815 /* Sanity check, first interface must have an endpoint */
816 if (alt->desc.bNumEndpoints < 1 || !alt->endpoint) {
817 dev_err(&interface->dev,
818 "%s(): interface 0 must have an endpoint\n", __func__);
819 r = -ENODEV;
820 goto fail1;
821 }
822 ar2->intf[0] = interface;
823 ar2->ep[0] = &alt->endpoint[0].desc;
824
825 /* Sanity check, the device must have two interfaces */
826 ar2->intf[1] = usb_ifnum_to_if(udev, 1);
827 if ((udev->actconfig->desc.bNumInterfaces < 2) || !ar2->intf[1]) {
828 dev_err(&interface->dev, "%s(): need 2 interfaces, found %d\n",
829 __func__, udev->actconfig->desc.bNumInterfaces);
830 r = -ENODEV;
831 goto fail1;
832 }
833
834 r = usb_driver_claim_interface(&ati_remote2_driver, ar2->intf[1], ar2);
835 if (r)
836 goto fail1;
837
838 /* Sanity check, second interface must have an endpoint */
839 alt = ar2->intf[1]->cur_altsetting;
840 if (alt->desc.bNumEndpoints < 1 || !alt->endpoint) {
841 dev_err(&interface->dev,
842 "%s(): interface 1 must have an endpoint\n", __func__);
843 r = -ENODEV;
844 goto fail2;
845 }
846 ar2->ep[1] = &alt->endpoint[0].desc;
847
848 r = ati_remote2_urb_init(ar2);
849 if (r)
850 goto fail3;
851
852 ar2->channel_mask = channel_mask;
853 ar2->mode_mask = mode_mask;
854
855 r = ati_remote2_setup(ar2, ar2->channel_mask);
856 if (r)
857 goto fail3;
858
859 usb_make_path(udev, ar2->phys, sizeof(ar2->phys));
860 strlcat(ar2->phys, "/input0", sizeof(ar2->phys));
861
862 strlcat(ar2->name, "ATI Remote Wonder II", sizeof(ar2->name));
863
864 r = sysfs_create_group(&udev->dev.kobj, &ati_remote2_attr_group);
865 if (r)
866 goto fail3;
867
868 r = ati_remote2_input_init(ar2);
869 if (r)
870 goto fail4;
871
872 usb_set_intfdata(interface, ar2);
873
874 interface->needs_remote_wakeup = 1;
875
876 return 0;
877
878 fail4:
879 sysfs_remove_group(&udev->dev.kobj, &ati_remote2_attr_group);
880 fail3:
881 ati_remote2_urb_cleanup(ar2);
882 fail2:
883 usb_driver_release_interface(&ati_remote2_driver, ar2->intf[1]);
884 fail1:
885 kfree(ar2);
886
887 return r;
888 }
889
ati_remote2_disconnect(struct usb_interface * interface)890 static void ati_remote2_disconnect(struct usb_interface *interface)
891 {
892 struct ati_remote2 *ar2;
893 struct usb_host_interface *alt = interface->cur_altsetting;
894
895 if (alt->desc.bInterfaceNumber)
896 return;
897
898 ar2 = usb_get_intfdata(interface);
899 usb_set_intfdata(interface, NULL);
900
901 input_unregister_device(ar2->idev);
902
903 sysfs_remove_group(&ar2->udev->dev.kobj, &ati_remote2_attr_group);
904
905 ati_remote2_urb_cleanup(ar2);
906
907 usb_driver_release_interface(&ati_remote2_driver, ar2->intf[1]);
908
909 kfree(ar2);
910 }
911
ati_remote2_suspend(struct usb_interface * interface,pm_message_t message)912 static int ati_remote2_suspend(struct usb_interface *interface,
913 pm_message_t message)
914 {
915 struct ati_remote2 *ar2;
916 struct usb_host_interface *alt = interface->cur_altsetting;
917
918 if (alt->desc.bInterfaceNumber)
919 return 0;
920
921 ar2 = usb_get_intfdata(interface);
922
923 dev_dbg(&ar2->intf[0]->dev, "%s()\n", __func__);
924
925 mutex_lock(&ati_remote2_mutex);
926
927 if (ar2->flags & ATI_REMOTE2_OPENED)
928 ati_remote2_kill_urbs(ar2);
929
930 ar2->flags |= ATI_REMOTE2_SUSPENDED;
931
932 mutex_unlock(&ati_remote2_mutex);
933
934 return 0;
935 }
936
ati_remote2_resume(struct usb_interface * interface)937 static int ati_remote2_resume(struct usb_interface *interface)
938 {
939 struct ati_remote2 *ar2;
940 struct usb_host_interface *alt = interface->cur_altsetting;
941 int r = 0;
942
943 if (alt->desc.bInterfaceNumber)
944 return 0;
945
946 ar2 = usb_get_intfdata(interface);
947
948 dev_dbg(&ar2->intf[0]->dev, "%s()\n", __func__);
949
950 mutex_lock(&ati_remote2_mutex);
951
952 if (ar2->flags & ATI_REMOTE2_OPENED)
953 r = ati_remote2_submit_urbs(ar2);
954
955 if (!r)
956 ar2->flags &= ~ATI_REMOTE2_SUSPENDED;
957
958 mutex_unlock(&ati_remote2_mutex);
959
960 return r;
961 }
962
ati_remote2_reset_resume(struct usb_interface * interface)963 static int ati_remote2_reset_resume(struct usb_interface *interface)
964 {
965 struct ati_remote2 *ar2;
966 struct usb_host_interface *alt = interface->cur_altsetting;
967 int r = 0;
968
969 if (alt->desc.bInterfaceNumber)
970 return 0;
971
972 ar2 = usb_get_intfdata(interface);
973
974 dev_dbg(&ar2->intf[0]->dev, "%s()\n", __func__);
975
976 mutex_lock(&ati_remote2_mutex);
977
978 r = ati_remote2_setup(ar2, ar2->channel_mask);
979 if (r)
980 goto out;
981
982 if (ar2->flags & ATI_REMOTE2_OPENED)
983 r = ati_remote2_submit_urbs(ar2);
984
985 if (!r)
986 ar2->flags &= ~ATI_REMOTE2_SUSPENDED;
987
988 out:
989 mutex_unlock(&ati_remote2_mutex);
990
991 return r;
992 }
993
ati_remote2_pre_reset(struct usb_interface * interface)994 static int ati_remote2_pre_reset(struct usb_interface *interface)
995 {
996 struct ati_remote2 *ar2;
997 struct usb_host_interface *alt = interface->cur_altsetting;
998
999 if (alt->desc.bInterfaceNumber)
1000 return 0;
1001
1002 ar2 = usb_get_intfdata(interface);
1003
1004 dev_dbg(&ar2->intf[0]->dev, "%s()\n", __func__);
1005
1006 mutex_lock(&ati_remote2_mutex);
1007
1008 if (ar2->flags == ATI_REMOTE2_OPENED)
1009 ati_remote2_kill_urbs(ar2);
1010
1011 return 0;
1012 }
1013
ati_remote2_post_reset(struct usb_interface * interface)1014 static int ati_remote2_post_reset(struct usb_interface *interface)
1015 {
1016 struct ati_remote2 *ar2;
1017 struct usb_host_interface *alt = interface->cur_altsetting;
1018 int r = 0;
1019
1020 if (alt->desc.bInterfaceNumber)
1021 return 0;
1022
1023 ar2 = usb_get_intfdata(interface);
1024
1025 dev_dbg(&ar2->intf[0]->dev, "%s()\n", __func__);
1026
1027 if (ar2->flags == ATI_REMOTE2_OPENED)
1028 r = ati_remote2_submit_urbs(ar2);
1029
1030 mutex_unlock(&ati_remote2_mutex);
1031
1032 return r;
1033 }
1034
1035 module_usb_driver(ati_remote2_driver);
1036