Commit | Line | Data |
---|---|---|
05f091ab | 1 | /* |
1da177e4 LT |
2 | * USB ATI Remote support |
3 | * | |
c34516e5 | 4 | * Copyright (c) 2011 Anssi Hannula <anssi.hannula@iki.fi> |
1da177e4 LT |
5 | * Version 2.2.0 Copyright (c) 2004 Torrey Hoffman <thoffman@arnor.net> |
6 | * Version 2.1.1 Copyright (c) 2002 Vladimir Dergachev | |
7 | * | |
8 | * This 2.2.0 version is a rewrite / cleanup of the 2.1.1 driver, including | |
05f091ab | 9 | * porting to the 2.6 kernel interfaces, along with other modification |
1da177e4 LT |
10 | * to better match the style of the existing usb/input drivers. However, the |
11 | * protocol and hardware handling is essentially unchanged from 2.1.1. | |
05f091ab DT |
12 | * |
13 | * The 2.1.1 driver was derived from the usbati_remote and usbkbd drivers by | |
1da177e4 LT |
14 | * Vojtech Pavlik. |
15 | * | |
16 | * Changes: | |
17 | * | |
18 | * Feb 2004: Torrey Hoffman <thoffman@arnor.net> | |
19 | * Version 2.2.0 | |
20 | * Jun 2004: Torrey Hoffman <thoffman@arnor.net> | |
21 | * Version 2.2.1 | |
22 | * Added key repeat support contributed by: | |
23 | * Vincent Vanackere <vanackere@lif.univ-mrs.fr> | |
24 | * Added support for the "Lola" remote contributed by: | |
25 | * Seth Cohn <sethcohn@yahoo.com> | |
26 | * | |
05f091ab | 27 | * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * |
1da177e4 LT |
28 | * |
29 | * This program is free software; you can redistribute it and/or modify | |
30 | * it under the terms of the GNU General Public License as published by | |
05f091ab | 31 | * the Free Software Foundation; either version 2 of the License, or |
1da177e4 | 32 | * (at your option) any later version. |
05f091ab | 33 | * |
1da177e4 LT |
34 | * This program is distributed in the hope that it will be useful, |
35 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
36 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
37 | * GNU General Public License for more details. | |
05f091ab | 38 | * |
1da177e4 LT |
39 | * You should have received a copy of the GNU General Public License |
40 | * along with this program; if not, write to the Free Software | |
41 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
05f091ab DT |
42 | * |
43 | * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * | |
1da177e4 LT |
44 | * |
45 | * Hardware & software notes | |
46 | * | |
05f091ab DT |
47 | * These remote controls are distributed by ATI as part of their |
48 | * "All-In-Wonder" video card packages. The receiver self-identifies as a | |
1da177e4 LT |
49 | * "USB Receiver" with manufacturer "X10 Wireless Technology Inc". |
50 | * | |
05f091ab | 51 | * The "Lola" remote is available from X10. See: |
1da177e4 LT |
52 | * http://www.x10.com/products/lola_sg1.htm |
53 | * The Lola is similar to the ATI remote but has no mouse support, and slightly | |
54 | * different keys. | |
55 | * | |
05f091ab | 56 | * It is possible to use multiple receivers and remotes on multiple computers |
1da177e4 | 57 | * simultaneously by configuring them to use specific channels. |
05f091ab DT |
58 | * |
59 | * The RF protocol used by the remote supports 16 distinct channels, 1 to 16. | |
60 | * Actually, it may even support more, at least in some revisions of the | |
1da177e4 LT |
61 | * hardware. |
62 | * | |
63 | * Each remote can be configured to transmit on one channel as follows: | |
05f091ab DT |
64 | * - Press and hold the "hand icon" button. |
65 | * - When the red LED starts to blink, let go of the "hand icon" button. | |
66 | * - When it stops blinking, input the channel code as two digits, from 01 | |
1da177e4 | 67 | * to 16, and press the hand icon again. |
05f091ab | 68 | * |
1da177e4 LT |
69 | * The timing can be a little tricky. Try loading the module with debug=1 |
70 | * to have the kernel print out messages about the remote control number | |
71 | * and mask. Note: debugging prints remote numbers as zero-based hexadecimal. | |
72 | * | |
73 | * The driver has a "channel_mask" parameter. This bitmask specifies which | |
05f091ab | 74 | * channels will be ignored by the module. To mask out channels, just add |
1da177e4 LT |
75 | * all the 2^channel_number values together. |
76 | * | |
77 | * For instance, set channel_mask = 2^4 = 16 (binary 10000) to make ati_remote | |
05f091ab | 78 | * ignore signals coming from remote controls transmitting on channel 4, but |
1da177e4 LT |
79 | * accept all other channels. |
80 | * | |
05f091ab | 81 | * Or, set channel_mask = 65533, (0xFFFD), and all channels except 1 will be |
1da177e4 LT |
82 | * ignored. |
83 | * | |
05f091ab | 84 | * The default is 0 (respond to all channels). Bit 0 and bits 17-32 of this |
1da177e4 LT |
85 | * parameter are unused. |
86 | * | |
87 | */ | |
88 | ||
1da177e4 LT |
89 | #include <linux/kernel.h> |
90 | #include <linux/errno.h> | |
91 | #include <linux/init.h> | |
92 | #include <linux/slab.h> | |
93 | #include <linux/module.h> | |
c34516e5 | 94 | #include <linux/mutex.h> |
ae0dadcf | 95 | #include <linux/usb/input.h> |
1da177e4 | 96 | #include <linux/wait.h> |
f0b80fbf | 97 | #include <linux/jiffies.h> |
c34516e5 | 98 | #include <media/rc-core.h> |
1da177e4 LT |
99 | |
100 | /* | |
101 | * Module and Version Information, Module Parameters | |
102 | */ | |
05f091ab | 103 | |
51320886 JW |
104 | #define ATI_REMOTE_VENDOR_ID 0x0bc7 |
105 | #define LOLA_REMOTE_PRODUCT_ID 0x0002 | |
106 | #define LOLA2_REMOTE_PRODUCT_ID 0x0003 | |
107 | #define ATI_REMOTE_PRODUCT_ID 0x0004 | |
108 | #define NVIDIA_REMOTE_PRODUCT_ID 0x0005 | |
109 | #define MEDION_REMOTE_PRODUCT_ID 0x0006 | |
999d6bc9 | 110 | #define FIREFLY_REMOTE_PRODUCT_ID 0x0008 |
1da177e4 | 111 | |
9688efda | 112 | #define DRIVER_VERSION "2.2.1" |
1da177e4 LT |
113 | #define DRIVER_AUTHOR "Torrey Hoffman <thoffman@arnor.net>" |
114 | #define DRIVER_DESC "ATI/X10 RF USB Remote Control" | |
115 | ||
116 | #define NAME_BUFSIZE 80 /* size of product name, path buffers */ | |
117 | #define DATA_BUFSIZE 63 /* size of URB data buffers */ | |
1da177e4 | 118 | |
c6698697 EH |
119 | /* |
120 | * Duplicate event filtering time. | |
121 | * Sequential, identical KIND_FILTERED inputs with less than | |
122 | * FILTER_TIME milliseconds between them are considered as repeat | |
123 | * events. The hardware generates 5 events for the first keypress | |
124 | * and we have to take this into account for an accurate repeat | |
125 | * behaviour. | |
126 | */ | |
127 | #define FILTER_TIME 60 /* msec */ | |
0de95509 | 128 | #define REPEAT_DELAY 500 /* msec */ |
c6698697 | 129 | |
65cde54b | 130 | static unsigned long channel_mask; |
c605b679 | 131 | module_param(channel_mask, ulong, 0644); |
1da177e4 LT |
132 | MODULE_PARM_DESC(channel_mask, "Bitmask of remote control channels to ignore"); |
133 | ||
65cde54b | 134 | static int debug; |
c605b679 | 135 | module_param(debug, int, 0644); |
1da177e4 LT |
136 | MODULE_PARM_DESC(debug, "Enable extra debug messages and information"); |
137 | ||
c6698697 EH |
138 | static int repeat_filter = FILTER_TIME; |
139 | module_param(repeat_filter, int, 0644); | |
140 | MODULE_PARM_DESC(repeat_filter, "Repeat filter time, default = 60 msec"); | |
141 | ||
0de95509 KP |
142 | static int repeat_delay = REPEAT_DELAY; |
143 | module_param(repeat_delay, int, 0644); | |
144 | MODULE_PARM_DESC(repeat_delay, "Delay before sending repeats, default = 500 msec"); | |
145 | ||
c34516e5 AH |
146 | static bool mouse = true; |
147 | module_param(mouse, bool, 0444); | |
148 | MODULE_PARM_DESC(mouse, "Enable mouse device, default = yes"); | |
149 | ||
1da177e4 LT |
150 | #define dbginfo(dev, format, arg...) do { if (debug) dev_info(dev , format , ## arg); } while (0) |
151 | #undef err | |
152 | #define err(format, arg...) printk(KERN_ERR format , ## arg) | |
05f091ab | 153 | |
1da177e4 | 154 | static struct usb_device_id ati_remote_table[] = { |
175fcecf AH |
155 | { USB_DEVICE(ATI_REMOTE_VENDOR_ID, LOLA_REMOTE_PRODUCT_ID), .driver_info = (unsigned long)RC_MAP_ATI_X10 }, |
156 | { USB_DEVICE(ATI_REMOTE_VENDOR_ID, LOLA2_REMOTE_PRODUCT_ID), .driver_info = (unsigned long)RC_MAP_ATI_X10 }, | |
157 | { USB_DEVICE(ATI_REMOTE_VENDOR_ID, ATI_REMOTE_PRODUCT_ID), .driver_info = (unsigned long)RC_MAP_ATI_X10 }, | |
158 | { USB_DEVICE(ATI_REMOTE_VENDOR_ID, NVIDIA_REMOTE_PRODUCT_ID), .driver_info = (unsigned long)RC_MAP_ATI_X10 }, | |
159 | { USB_DEVICE(ATI_REMOTE_VENDOR_ID, MEDION_REMOTE_PRODUCT_ID), .driver_info = (unsigned long)RC_MAP_MEDION_X10 }, | |
999d6bc9 | 160 | { USB_DEVICE(ATI_REMOTE_VENDOR_ID, FIREFLY_REMOTE_PRODUCT_ID), .driver_info = (unsigned long)RC_MAP_SNAPSTREAM_FIREFLY }, |
1da177e4 LT |
161 | {} /* Terminating entry */ |
162 | }; | |
163 | ||
164 | MODULE_DEVICE_TABLE(usb, ati_remote_table); | |
165 | ||
166 | /* Get hi and low bytes of a 16-bits int */ | |
167 | #define HI(a) ((unsigned char)((a) >> 8)) | |
168 | #define LO(a) ((unsigned char)((a) & 0xff)) | |
169 | ||
170 | #define SEND_FLAG_IN_PROGRESS 1 | |
171 | #define SEND_FLAG_COMPLETE 2 | |
172 | ||
173 | /* Device initialization strings */ | |
174 | static char init1[] = { 0x01, 0x00, 0x20, 0x14 }; | |
175 | static char init2[] = { 0x01, 0x00, 0x20, 0x14, 0x20, 0x20, 0x20 }; | |
176 | ||
1da177e4 | 177 | struct ati_remote { |
c5b7c7c3 | 178 | struct input_dev *idev; |
c34516e5 | 179 | struct rc_dev *rdev; |
1da177e4 LT |
180 | struct usb_device *udev; |
181 | struct usb_interface *interface; | |
05f091ab | 182 | |
1da177e4 LT |
183 | struct urb *irq_urb; |
184 | struct urb *out_urb; | |
185 | struct usb_endpoint_descriptor *endpoint_in; | |
186 | struct usb_endpoint_descriptor *endpoint_out; | |
187 | unsigned char *inbuf; | |
188 | unsigned char *outbuf; | |
189 | dma_addr_t inbuf_dma; | |
190 | dma_addr_t outbuf_dma; | |
191 | ||
1da177e4 LT |
192 | unsigned char old_data[2]; /* Detect duplicate events */ |
193 | unsigned long old_jiffies; | |
194 | unsigned long acc_jiffies; /* handle acceleration */ | |
0de95509 KP |
195 | unsigned long first_jiffies; |
196 | ||
1da177e4 | 197 | unsigned int repeat_count; |
05f091ab | 198 | |
c34516e5 AH |
199 | char rc_name[NAME_BUFSIZE]; |
200 | char rc_phys[NAME_BUFSIZE]; | |
201 | char mouse_name[NAME_BUFSIZE]; | |
202 | char mouse_phys[NAME_BUFSIZE]; | |
1da177e4 LT |
203 | |
204 | wait_queue_head_t wait; | |
205 | int send_flags; | |
c34516e5 AH |
206 | |
207 | int users; /* 0-2, users are rc and input */ | |
208 | struct mutex open_mutex; | |
1da177e4 LT |
209 | }; |
210 | ||
211 | /* "Kinds" of messages sent from the hardware to the driver. */ | |
212 | #define KIND_END 0 | |
213 | #define KIND_LITERAL 1 /* Simply pass to input system */ | |
214 | #define KIND_FILTERED 2 /* Add artificial key-up events, drop keyrepeats */ | |
215 | #define KIND_LU 3 /* Directional keypad diagonals - left up, */ | |
216 | #define KIND_RU 4 /* right up, */ | |
217 | #define KIND_LD 5 /* left down, */ | |
218 | #define KIND_RD 6 /* right down */ | |
219 | #define KIND_ACCEL 7 /* Directional keypad - left, right, up, down.*/ | |
220 | ||
221 | /* Translation table from hardware messages to input events. */ | |
4c4c9432 | 222 | static const struct { |
1da177e4 LT |
223 | short kind; |
224 | unsigned char data1, data2; | |
225 | int type; | |
226 | unsigned int code; | |
227 | int value; | |
c5b7c7c3 | 228 | } ati_remote_tbl[] = { |
1da177e4 LT |
229 | /* Directional control pad axes */ |
230 | {KIND_ACCEL, 0x35, 0x70, EV_REL, REL_X, -1}, /* left */ | |
231 | {KIND_ACCEL, 0x36, 0x71, EV_REL, REL_X, 1}, /* right */ | |
232 | {KIND_ACCEL, 0x37, 0x72, EV_REL, REL_Y, -1}, /* up */ | |
233 | {KIND_ACCEL, 0x38, 0x73, EV_REL, REL_Y, 1}, /* down */ | |
05f091ab | 234 | /* Directional control pad diagonals */ |
1da177e4 LT |
235 | {KIND_LU, 0x39, 0x74, EV_REL, 0, 0}, /* left up */ |
236 | {KIND_RU, 0x3a, 0x75, EV_REL, 0, 0}, /* right up */ | |
237 | {KIND_LD, 0x3c, 0x77, EV_REL, 0, 0}, /* left down */ | |
238 | {KIND_RD, 0x3b, 0x76, EV_REL, 0, 0}, /* right down */ | |
239 | ||
240 | /* "Mouse button" buttons */ | |
241 | {KIND_LITERAL, 0x3d, 0x78, EV_KEY, BTN_LEFT, 1}, /* left btn down */ | |
242 | {KIND_LITERAL, 0x3e, 0x79, EV_KEY, BTN_LEFT, 0}, /* left btn up */ | |
243 | {KIND_LITERAL, 0x41, 0x7c, EV_KEY, BTN_RIGHT, 1},/* right btn down */ | |
244 | {KIND_LITERAL, 0x42, 0x7d, EV_KEY, BTN_RIGHT, 0},/* right btn up */ | |
245 | ||
05f091ab | 246 | /* Artificial "doubleclick" events are generated by the hardware. |
1da177e4 LT |
247 | * They are mapped to the "side" and "extra" mouse buttons here. */ |
248 | {KIND_FILTERED, 0x3f, 0x7a, EV_KEY, BTN_SIDE, 1}, /* left dblclick */ | |
249 | {KIND_FILTERED, 0x43, 0x7e, EV_KEY, BTN_EXTRA, 1},/* right dblclick */ | |
250 | ||
c34516e5 | 251 | /* Non-mouse events are handled by rc-core */ |
1da177e4 LT |
252 | {KIND_END, 0x00, 0x00, EV_MAX + 1, 0, 0} |
253 | }; | |
254 | ||
255 | /* Local function prototypes */ | |
1da177e4 | 256 | static int ati_remote_sendpacket (struct ati_remote *ati_remote, u16 cmd, unsigned char *data); |
7d12e780 DH |
257 | static void ati_remote_irq_out (struct urb *urb); |
258 | static void ati_remote_irq_in (struct urb *urb); | |
259 | static void ati_remote_input_report (struct urb *urb); | |
1da177e4 LT |
260 | static int ati_remote_initialize (struct ati_remote *ati_remote); |
261 | static int ati_remote_probe (struct usb_interface *interface, const struct usb_device_id *id); | |
262 | static void ati_remote_disconnect (struct usb_interface *interface); | |
263 | ||
264 | /* usb specific object to register with the usb subsystem */ | |
265 | static struct usb_driver ati_remote_driver = { | |
1da177e4 LT |
266 | .name = "ati_remote", |
267 | .probe = ati_remote_probe, | |
268 | .disconnect = ati_remote_disconnect, | |
269 | .id_table = ati_remote_table, | |
270 | }; | |
271 | ||
272 | /* | |
273 | * ati_remote_dump_input | |
274 | */ | |
1817b169 GKH |
275 | static void ati_remote_dump(struct device *dev, unsigned char *data, |
276 | unsigned int len) | |
1da177e4 | 277 | { |
0224e040 AH |
278 | if (len == 1) { |
279 | if (data[0] != (unsigned char)0xff && data[0] != 0x00) | |
280 | dev_warn(dev, "Weird byte 0x%02x\n", data[0]); | |
281 | } else if (len == 4) | |
1817b169 | 282 | dev_warn(dev, "Weird key %02x %02x %02x %02x\n", |
1da177e4 LT |
283 | data[0], data[1], data[2], data[3]); |
284 | else | |
1817b169 | 285 | dev_warn(dev, "Weird data, len=%d %02x %02x %02x %02x %02x %02x ...\n", |
1da177e4 LT |
286 | len, data[0], data[1], data[2], data[3], data[4], data[5]); |
287 | } | |
288 | ||
289 | /* | |
290 | * ati_remote_open | |
291 | */ | |
c34516e5 | 292 | static int ati_remote_open(struct ati_remote *ati_remote) |
1da177e4 | 293 | { |
c34516e5 AH |
294 | int err = 0; |
295 | ||
296 | mutex_lock(&ati_remote->open_mutex); | |
297 | ||
298 | if (ati_remote->users++ != 0) | |
299 | goto out; /* one was already active */ | |
1da177e4 LT |
300 | |
301 | /* On first open, submit the read urb which was set up previously. */ | |
302 | ati_remote->irq_urb->dev = ati_remote->udev; | |
303 | if (usb_submit_urb(ati_remote->irq_urb, GFP_KERNEL)) { | |
05f091ab | 304 | dev_err(&ati_remote->interface->dev, |
ea3e6c59 | 305 | "%s: usb_submit_urb failed!\n", __func__); |
c34516e5 | 306 | err = -EIO; |
1da177e4 LT |
307 | } |
308 | ||
c34516e5 AH |
309 | out: mutex_unlock(&ati_remote->open_mutex); |
310 | return err; | |
1da177e4 LT |
311 | } |
312 | ||
313 | /* | |
314 | * ati_remote_close | |
315 | */ | |
c34516e5 AH |
316 | static void ati_remote_close(struct ati_remote *ati_remote) |
317 | { | |
318 | mutex_lock(&ati_remote->open_mutex); | |
319 | if (--ati_remote->users == 0) | |
320 | usb_kill_urb(ati_remote->irq_urb); | |
321 | mutex_unlock(&ati_remote->open_mutex); | |
322 | } | |
323 | ||
324 | static int ati_remote_input_open(struct input_dev *inputdev) | |
1da177e4 | 325 | { |
7791bdae | 326 | struct ati_remote *ati_remote = input_get_drvdata(inputdev); |
c34516e5 AH |
327 | return ati_remote_open(ati_remote); |
328 | } | |
05f091ab | 329 | |
c34516e5 AH |
330 | static void ati_remote_input_close(struct input_dev *inputdev) |
331 | { | |
332 | struct ati_remote *ati_remote = input_get_drvdata(inputdev); | |
333 | ati_remote_close(ati_remote); | |
334 | } | |
335 | ||
336 | static int ati_remote_rc_open(struct rc_dev *rdev) | |
337 | { | |
338 | struct ati_remote *ati_remote = rdev->priv; | |
339 | return ati_remote_open(ati_remote); | |
340 | } | |
341 | ||
342 | static void ati_remote_rc_close(struct rc_dev *rdev) | |
343 | { | |
344 | struct ati_remote *ati_remote = rdev->priv; | |
345 | ati_remote_close(ati_remote); | |
1da177e4 LT |
346 | } |
347 | ||
348 | /* | |
349 | * ati_remote_irq_out | |
350 | */ | |
7d12e780 | 351 | static void ati_remote_irq_out(struct urb *urb) |
1da177e4 LT |
352 | { |
353 | struct ati_remote *ati_remote = urb->context; | |
05f091ab | 354 | |
1da177e4 LT |
355 | if (urb->status) { |
356 | dev_dbg(&ati_remote->interface->dev, "%s: status %d\n", | |
ea3e6c59 | 357 | __func__, urb->status); |
1da177e4 LT |
358 | return; |
359 | } | |
05f091ab | 360 | |
1da177e4 LT |
361 | ati_remote->send_flags |= SEND_FLAG_COMPLETE; |
362 | wmb(); | |
363 | wake_up(&ati_remote->wait); | |
364 | } | |
365 | ||
366 | /* | |
367 | * ati_remote_sendpacket | |
05f091ab | 368 | * |
1da177e4 LT |
369 | * Used to send device initialization strings |
370 | */ | |
371 | static int ati_remote_sendpacket(struct ati_remote *ati_remote, u16 cmd, unsigned char *data) | |
372 | { | |
373 | int retval = 0; | |
05f091ab | 374 | |
1da177e4 LT |
375 | /* Set up out_urb */ |
376 | memcpy(ati_remote->out_urb->transfer_buffer + 1, data, LO(cmd)); | |
05f091ab | 377 | ((char *) ati_remote->out_urb->transfer_buffer)[0] = HI(cmd); |
1da177e4 LT |
378 | |
379 | ati_remote->out_urb->transfer_buffer_length = LO(cmd) + 1; | |
380 | ati_remote->out_urb->dev = ati_remote->udev; | |
381 | ati_remote->send_flags = SEND_FLAG_IN_PROGRESS; | |
382 | ||
383 | retval = usb_submit_urb(ati_remote->out_urb, GFP_ATOMIC); | |
384 | if (retval) { | |
05f091ab | 385 | dev_dbg(&ati_remote->interface->dev, |
1da177e4 LT |
386 | "sendpacket: usb_submit_urb failed: %d\n", retval); |
387 | return retval; | |
388 | } | |
389 | ||
390 | wait_event_timeout(ati_remote->wait, | |
391 | ((ati_remote->out_urb->status != -EINPROGRESS) || | |
05f091ab | 392 | (ati_remote->send_flags & SEND_FLAG_COMPLETE)), |
1da177e4 LT |
393 | HZ); |
394 | usb_kill_urb(ati_remote->out_urb); | |
05f091ab | 395 | |
1da177e4 LT |
396 | return retval; |
397 | } | |
398 | ||
399 | /* | |
400 | * ati_remote_event_lookup | |
401 | */ | |
402 | static int ati_remote_event_lookup(int rem, unsigned char d1, unsigned char d2) | |
403 | { | |
404 | int i; | |
405 | ||
406 | for (i = 0; ati_remote_tbl[i].kind != KIND_END; i++) { | |
05f091ab DT |
407 | /* |
408 | * Decide if the table entry matches the remote input. | |
1da177e4 | 409 | */ |
c34516e5 AH |
410 | if (ati_remote_tbl[i].data1 == d1 && |
411 | ati_remote_tbl[i].data2 == d2) | |
1da177e4 | 412 | return i; |
05f091ab | 413 | |
1da177e4 LT |
414 | } |
415 | return -1; | |
416 | } | |
417 | ||
2ffc1cca DT |
418 | /* |
419 | * ati_remote_compute_accel | |
420 | * | |
421 | * Implements acceleration curve for directional control pad | |
422 | * If elapsed time since last event is > 1/4 second, user "stopped", | |
423 | * so reset acceleration. Otherwise, user is probably holding the control | |
424 | * pad down, so we increase acceleration, ramping up over two seconds to | |
425 | * a maximum speed. | |
426 | */ | |
427 | static int ati_remote_compute_accel(struct ati_remote *ati_remote) | |
428 | { | |
429 | static const char accel[] = { 1, 2, 4, 6, 9, 13, 20 }; | |
430 | unsigned long now = jiffies; | |
431 | int acc; | |
432 | ||
433 | if (time_after(now, ati_remote->old_jiffies + msecs_to_jiffies(250))) { | |
434 | acc = 1; | |
435 | ati_remote->acc_jiffies = now; | |
436 | } | |
437 | else if (time_before(now, ati_remote->acc_jiffies + msecs_to_jiffies(125))) | |
438 | acc = accel[0]; | |
439 | else if (time_before(now, ati_remote->acc_jiffies + msecs_to_jiffies(250))) | |
440 | acc = accel[1]; | |
441 | else if (time_before(now, ati_remote->acc_jiffies + msecs_to_jiffies(500))) | |
442 | acc = accel[2]; | |
443 | else if (time_before(now, ati_remote->acc_jiffies + msecs_to_jiffies(1000))) | |
444 | acc = accel[3]; | |
445 | else if (time_before(now, ati_remote->acc_jiffies + msecs_to_jiffies(1500))) | |
446 | acc = accel[4]; | |
447 | else if (time_before(now, ati_remote->acc_jiffies + msecs_to_jiffies(2000))) | |
448 | acc = accel[5]; | |
449 | else | |
450 | acc = accel[6]; | |
451 | ||
452 | return acc; | |
453 | } | |
454 | ||
1da177e4 LT |
455 | /* |
456 | * ati_remote_report_input | |
457 | */ | |
7d12e780 | 458 | static void ati_remote_input_report(struct urb *urb) |
1da177e4 LT |
459 | { |
460 | struct ati_remote *ati_remote = urb->context; | |
461 | unsigned char *data= ati_remote->inbuf; | |
c5b7c7c3 | 462 | struct input_dev *dev = ati_remote->idev; |
c34516e5 AH |
463 | int index = -1; |
464 | int acc; | |
1da177e4 | 465 | int remote_num; |
c34516e5 | 466 | unsigned char scancode[2]; |
05f091ab | 467 | |
1da177e4 | 468 | /* Deal with strange looking inputs */ |
05f091ab | 469 | if ( (urb->actual_length != 4) || (data[0] != 0x14) || |
1da177e4 | 470 | ((data[3] & 0x0f) != 0x00) ) { |
1817b169 | 471 | ati_remote_dump(&urb->dev->dev, data, urb->actual_length); |
1da177e4 LT |
472 | return; |
473 | } | |
474 | ||
475 | /* Mask unwanted remote channels. */ | |
476 | /* note: remote_num is 0-based, channel 1 on remote == 0 here */ | |
477 | remote_num = (data[3] >> 4) & 0x0f; | |
9688efda | 478 | if (channel_mask & (1 << (remote_num + 1))) { |
1da177e4 LT |
479 | dbginfo(&ati_remote->interface->dev, |
480 | "Masked input from channel 0x%02x: data %02x,%02x, mask= 0x%02lx\n", | |
481 | remote_num, data[1], data[2], channel_mask); | |
482 | return; | |
483 | } | |
484 | ||
c34516e5 AH |
485 | scancode[0] = (((data[1] - ((remote_num + 1) << 4)) & 0xf0) | (data[1] & 0x0f)); |
486 | ||
999d6bc9 AH |
487 | /* |
488 | * Some devices (e.g. SnapStream Firefly) use 8080 as toggle code, | |
489 | * so we have to clear them. The first bit is a bit tricky as the | |
490 | * "non-toggled" state depends on remote_num, so we xor it with the | |
491 | * second bit which is only used for toggle. | |
492 | */ | |
493 | scancode[0] ^= (data[2] & 0x80); | |
494 | ||
495 | scancode[1] = data[2] & ~0x80; | |
c34516e5 AH |
496 | |
497 | /* Look up event code index in mouse translation table. */ | |
498 | index = ati_remote_event_lookup(remote_num, scancode[0], scancode[1]); | |
499 | ||
500 | if (index >= 0) { | |
501 | dbginfo(&ati_remote->interface->dev, | |
502 | "channel 0x%02x; mouse data %02x,%02x; index %d; keycode %d\n", | |
503 | remote_num, data[1], data[2], index, ati_remote_tbl[index].code); | |
504 | if (!dev) | |
505 | return; /* no mouse device */ | |
506 | } else | |
507 | dbginfo(&ati_remote->interface->dev, | |
508 | "channel 0x%02x; key data %02x,%02x, scancode %02x,%02x\n", | |
509 | remote_num, data[1], data[2], scancode[0], scancode[1]); | |
05f091ab | 510 | |
c34516e5 AH |
511 | |
512 | if (index >= 0 && ati_remote_tbl[index].kind == KIND_LITERAL) { | |
1da177e4 LT |
513 | input_event(dev, ati_remote_tbl[index].type, |
514 | ati_remote_tbl[index].code, | |
515 | ati_remote_tbl[index].value); | |
516 | input_sync(dev); | |
05f091ab | 517 | |
1da177e4 LT |
518 | ati_remote->old_jiffies = jiffies; |
519 | return; | |
520 | } | |
05f091ab | 521 | |
c34516e5 | 522 | if (index < 0 || ati_remote_tbl[index].kind == KIND_FILTERED) { |
0de95509 KP |
523 | unsigned long now = jiffies; |
524 | ||
1da177e4 | 525 | /* Filter duplicate events which happen "too close" together. */ |
c6698697 EH |
526 | if (ati_remote->old_data[0] == data[1] && |
527 | ati_remote->old_data[1] == data[2] && | |
0de95509 KP |
528 | time_before(now, ati_remote->old_jiffies + |
529 | msecs_to_jiffies(repeat_filter))) { | |
1da177e4 | 530 | ati_remote->repeat_count++; |
05f091ab | 531 | } else { |
1da177e4 | 532 | ati_remote->repeat_count = 0; |
0de95509 | 533 | ati_remote->first_jiffies = now; |
1da177e4 | 534 | } |
05f091ab | 535 | |
1da177e4 LT |
536 | ati_remote->old_data[0] = data[1]; |
537 | ati_remote->old_data[1] = data[2]; | |
0de95509 | 538 | ati_remote->old_jiffies = now; |
1da177e4 | 539 | |
0de95509 KP |
540 | /* Ensure we skip at least the 4 first duplicate events (generated |
541 | * by a single keypress), and continue skipping until repeat_delay | |
542 | * msecs have passed | |
543 | */ | |
c6698697 | 544 | if (ati_remote->repeat_count > 0 && |
0de95509 KP |
545 | (ati_remote->repeat_count < 5 || |
546 | time_before(now, ati_remote->first_jiffies + | |
547 | msecs_to_jiffies(repeat_delay)))) | |
1da177e4 | 548 | return; |
05f091ab | 549 | |
c34516e5 AH |
550 | if (index < 0) { |
551 | /* Not a mouse event, hand it to rc-core. */ | |
552 | u32 rc_code = (scancode[0] << 8) | scancode[1]; | |
553 | ||
554 | /* | |
555 | * We don't use the rc-core repeat handling yet as | |
556 | * it would cause ghost repeats which would be a | |
557 | * regression for this driver. | |
558 | */ | |
999d6bc9 AH |
559 | rc_keydown_notimeout(ati_remote->rdev, rc_code, |
560 | data[2]); | |
c34516e5 AH |
561 | rc_keyup(ati_remote->rdev); |
562 | return; | |
563 | } | |
1da177e4 | 564 | |
1da177e4 LT |
565 | input_event(dev, ati_remote_tbl[index].type, |
566 | ati_remote_tbl[index].code, 1); | |
c3c38fbd | 567 | input_sync(dev); |
1da177e4 LT |
568 | input_event(dev, ati_remote_tbl[index].type, |
569 | ati_remote_tbl[index].code, 0); | |
570 | input_sync(dev); | |
571 | ||
2ffc1cca | 572 | } else { |
05f091ab | 573 | |
2ffc1cca DT |
574 | /* |
575 | * Other event kinds are from the directional control pad, and have an | |
576 | * acceleration factor applied to them. Without this acceleration, the | |
577 | * control pad is mostly unusable. | |
578 | */ | |
579 | acc = ati_remote_compute_accel(ati_remote); | |
1da177e4 | 580 | |
2ffc1cca DT |
581 | switch (ati_remote_tbl[index].kind) { |
582 | case KIND_ACCEL: | |
583 | input_event(dev, ati_remote_tbl[index].type, | |
584 | ati_remote_tbl[index].code, | |
585 | ati_remote_tbl[index].value * acc); | |
586 | break; | |
587 | case KIND_LU: | |
588 | input_report_rel(dev, REL_X, -acc); | |
589 | input_report_rel(dev, REL_Y, -acc); | |
590 | break; | |
591 | case KIND_RU: | |
592 | input_report_rel(dev, REL_X, acc); | |
593 | input_report_rel(dev, REL_Y, -acc); | |
594 | break; | |
595 | case KIND_LD: | |
596 | input_report_rel(dev, REL_X, -acc); | |
597 | input_report_rel(dev, REL_Y, acc); | |
598 | break; | |
599 | case KIND_RD: | |
600 | input_report_rel(dev, REL_X, acc); | |
601 | input_report_rel(dev, REL_Y, acc); | |
602 | break; | |
603 | default: | |
604 | dev_dbg(&ati_remote->interface->dev, "ati_remote kind=%d\n", | |
605 | ati_remote_tbl[index].kind); | |
606 | } | |
607 | input_sync(dev); | |
608 | ||
609 | ati_remote->old_jiffies = jiffies; | |
610 | ati_remote->old_data[0] = data[1]; | |
611 | ati_remote->old_data[1] = data[2]; | |
612 | } | |
1da177e4 LT |
613 | } |
614 | ||
615 | /* | |
616 | * ati_remote_irq_in | |
617 | */ | |
7d12e780 | 618 | static void ati_remote_irq_in(struct urb *urb) |
1da177e4 LT |
619 | { |
620 | struct ati_remote *ati_remote = urb->context; | |
621 | int retval; | |
622 | ||
623 | switch (urb->status) { | |
624 | case 0: /* success */ | |
7d12e780 | 625 | ati_remote_input_report(urb); |
1da177e4 LT |
626 | break; |
627 | case -ECONNRESET: /* unlink */ | |
628 | case -ENOENT: | |
629 | case -ESHUTDOWN: | |
630 | dev_dbg(&ati_remote->interface->dev, "%s: urb error status, unlink? \n", | |
ea3e6c59 | 631 | __func__); |
05f091ab | 632 | return; |
1da177e4 | 633 | default: /* error */ |
05f091ab | 634 | dev_dbg(&ati_remote->interface->dev, "%s: Nonzero urb status %d\n", |
ea3e6c59 | 635 | __func__, urb->status); |
1da177e4 | 636 | } |
05f091ab | 637 | |
54e6ecb2 | 638 | retval = usb_submit_urb(urb, GFP_ATOMIC); |
1da177e4 LT |
639 | if (retval) |
640 | dev_err(&ati_remote->interface->dev, "%s: usb_submit_urb()=%d\n", | |
ea3e6c59 | 641 | __func__, retval); |
1da177e4 LT |
642 | } |
643 | ||
644 | /* | |
c5b7c7c3 | 645 | * ati_remote_alloc_buffers |
1da177e4 | 646 | */ |
c5b7c7c3 DT |
647 | static int ati_remote_alloc_buffers(struct usb_device *udev, |
648 | struct ati_remote *ati_remote) | |
1da177e4 | 649 | { |
997ea58e DM |
650 | ati_remote->inbuf = usb_alloc_coherent(udev, DATA_BUFSIZE, GFP_ATOMIC, |
651 | &ati_remote->inbuf_dma); | |
c5b7c7c3 DT |
652 | if (!ati_remote->inbuf) |
653 | return -1; | |
1da177e4 | 654 | |
997ea58e | 655 | ati_remote->outbuf = usb_alloc_coherent(udev, DATA_BUFSIZE, GFP_ATOMIC, |
9688efda | 656 | &ati_remote->outbuf_dma); |
c5b7c7c3 DT |
657 | if (!ati_remote->outbuf) |
658 | return -1; | |
1da177e4 | 659 | |
c5b7c7c3 DT |
660 | ati_remote->irq_urb = usb_alloc_urb(0, GFP_KERNEL); |
661 | if (!ati_remote->irq_urb) | |
662 | return -1; | |
1da177e4 | 663 | |
c5b7c7c3 DT |
664 | ati_remote->out_urb = usb_alloc_urb(0, GFP_KERNEL); |
665 | if (!ati_remote->out_urb) | |
666 | return -1; | |
05f091ab | 667 | |
c5b7c7c3 DT |
668 | return 0; |
669 | } | |
05f091ab | 670 | |
c5b7c7c3 DT |
671 | /* |
672 | * ati_remote_free_buffers | |
673 | */ | |
674 | static void ati_remote_free_buffers(struct ati_remote *ati_remote) | |
675 | { | |
459f836a MK |
676 | usb_free_urb(ati_remote->irq_urb); |
677 | usb_free_urb(ati_remote->out_urb); | |
1da177e4 | 678 | |
997ea58e | 679 | usb_free_coherent(ati_remote->udev, DATA_BUFSIZE, |
9dce447a | 680 | ati_remote->inbuf, ati_remote->inbuf_dma); |
c5b7c7c3 | 681 | |
997ea58e | 682 | usb_free_coherent(ati_remote->udev, DATA_BUFSIZE, |
9dce447a | 683 | ati_remote->outbuf, ati_remote->outbuf_dma); |
1da177e4 LT |
684 | } |
685 | ||
686 | static void ati_remote_input_init(struct ati_remote *ati_remote) | |
687 | { | |
c5b7c7c3 | 688 | struct input_dev *idev = ati_remote->idev; |
1da177e4 LT |
689 | int i; |
690 | ||
7b19ada2 JS |
691 | idev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REL); |
692 | idev->keybit[BIT_WORD(BTN_MOUSE)] = BIT_MASK(BTN_LEFT) | | |
693 | BIT_MASK(BTN_RIGHT) | BIT_MASK(BTN_SIDE) | BIT_MASK(BTN_EXTRA); | |
694 | idev->relbit[0] = BIT_MASK(REL_X) | BIT_MASK(REL_Y); | |
1da177e4 LT |
695 | for (i = 0; ati_remote_tbl[i].kind != KIND_END; i++) |
696 | if (ati_remote_tbl[i].type == EV_KEY) | |
697 | set_bit(ati_remote_tbl[i].code, idev->keybit); | |
05f091ab | 698 | |
7791bdae DT |
699 | input_set_drvdata(idev, ati_remote); |
700 | ||
c34516e5 AH |
701 | idev->open = ati_remote_input_open; |
702 | idev->close = ati_remote_input_close; | |
05f091ab | 703 | |
c34516e5 AH |
704 | idev->name = ati_remote->mouse_name; |
705 | idev->phys = ati_remote->mouse_phys; | |
05f091ab | 706 | |
16a334c0 | 707 | usb_to_input_id(ati_remote->udev, &idev->id); |
44fd0b60 | 708 | idev->dev.parent = &ati_remote->interface->dev; |
1da177e4 LT |
709 | } |
710 | ||
c34516e5 AH |
711 | static void ati_remote_rc_init(struct ati_remote *ati_remote) |
712 | { | |
713 | struct rc_dev *rdev = ati_remote->rdev; | |
714 | ||
715 | rdev->priv = ati_remote; | |
716 | rdev->driver_type = RC_DRIVER_SCANCODE; | |
717 | rdev->allowed_protos = RC_TYPE_OTHER; | |
718 | rdev->driver_name = "ati_remote"; | |
719 | ||
720 | rdev->open = ati_remote_rc_open; | |
721 | rdev->close = ati_remote_rc_close; | |
722 | ||
723 | rdev->input_name = ati_remote->rc_name; | |
724 | rdev->input_phys = ati_remote->rc_phys; | |
725 | ||
726 | usb_to_input_id(ati_remote->udev, &rdev->input_id); | |
44fd0b60 | 727 | rdev->dev.parent = &ati_remote->interface->dev; |
c34516e5 AH |
728 | } |
729 | ||
1da177e4 LT |
730 | static int ati_remote_initialize(struct ati_remote *ati_remote) |
731 | { | |
732 | struct usb_device *udev = ati_remote->udev; | |
733 | int pipe, maxp; | |
05f091ab | 734 | |
1da177e4 LT |
735 | init_waitqueue_head(&ati_remote->wait); |
736 | ||
737 | /* Set up irq_urb */ | |
738 | pipe = usb_rcvintpipe(udev, ati_remote->endpoint_in->bEndpointAddress); | |
739 | maxp = usb_maxpacket(udev, pipe, usb_pipeout(pipe)); | |
740 | maxp = (maxp > DATA_BUFSIZE) ? DATA_BUFSIZE : maxp; | |
05f091ab DT |
741 | |
742 | usb_fill_int_urb(ati_remote->irq_urb, udev, pipe, ati_remote->inbuf, | |
743 | maxp, ati_remote_irq_in, ati_remote, | |
1da177e4 LT |
744 | ati_remote->endpoint_in->bInterval); |
745 | ati_remote->irq_urb->transfer_dma = ati_remote->inbuf_dma; | |
746 | ati_remote->irq_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | |
05f091ab | 747 | |
1da177e4 LT |
748 | /* Set up out_urb */ |
749 | pipe = usb_sndintpipe(udev, ati_remote->endpoint_out->bEndpointAddress); | |
750 | maxp = usb_maxpacket(udev, pipe, usb_pipeout(pipe)); | |
751 | maxp = (maxp > DATA_BUFSIZE) ? DATA_BUFSIZE : maxp; | |
752 | ||
05f091ab DT |
753 | usb_fill_int_urb(ati_remote->out_urb, udev, pipe, ati_remote->outbuf, |
754 | maxp, ati_remote_irq_out, ati_remote, | |
1da177e4 LT |
755 | ati_remote->endpoint_out->bInterval); |
756 | ati_remote->out_urb->transfer_dma = ati_remote->outbuf_dma; | |
757 | ati_remote->out_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | |
758 | ||
759 | /* send initialization strings */ | |
760 | if ((ati_remote_sendpacket(ati_remote, 0x8004, init1)) || | |
761 | (ati_remote_sendpacket(ati_remote, 0x8007, init2))) { | |
05f091ab | 762 | dev_err(&ati_remote->interface->dev, |
1da177e4 | 763 | "Initializing ati_remote hardware failed.\n"); |
c5b7c7c3 | 764 | return -EIO; |
1da177e4 | 765 | } |
05f091ab | 766 | |
1da177e4 LT |
767 | return 0; |
768 | } | |
769 | ||
770 | /* | |
771 | * ati_remote_probe | |
772 | */ | |
773 | static int ati_remote_probe(struct usb_interface *interface, const struct usb_device_id *id) | |
774 | { | |
775 | struct usb_device *udev = interface_to_usbdev(interface); | |
c5b7c7c3 DT |
776 | struct usb_host_interface *iface_host = interface->cur_altsetting; |
777 | struct usb_endpoint_descriptor *endpoint_in, *endpoint_out; | |
778 | struct ati_remote *ati_remote; | |
779 | struct input_dev *input_dev; | |
c34516e5 | 780 | struct rc_dev *rc_dev; |
c5b7c7c3 | 781 | int err = -ENOMEM; |
1da177e4 | 782 | |
1da177e4 | 783 | if (iface_host->desc.bNumEndpoints != 2) { |
ea3e6c59 | 784 | err("%s: Unexpected desc.bNumEndpoints\n", __func__); |
c5b7c7c3 | 785 | return -ENODEV; |
1da177e4 LT |
786 | } |
787 | ||
c5b7c7c3 DT |
788 | endpoint_in = &iface_host->endpoint[0].desc; |
789 | endpoint_out = &iface_host->endpoint[1].desc; | |
1da177e4 | 790 | |
96642a2c | 791 | if (!usb_endpoint_is_int_in(endpoint_in)) { |
ea3e6c59 | 792 | err("%s: Unexpected endpoint_in\n", __func__); |
c5b7c7c3 | 793 | return -ENODEV; |
1da177e4 | 794 | } |
c5b7c7c3 | 795 | if (le16_to_cpu(endpoint_in->wMaxPacketSize) == 0) { |
ea3e6c59 | 796 | err("%s: endpoint_in message size==0? \n", __func__); |
c5b7c7c3 | 797 | return -ENODEV; |
1da177e4 LT |
798 | } |
799 | ||
c5b7c7c3 | 800 | ati_remote = kzalloc(sizeof (struct ati_remote), GFP_KERNEL); |
c34516e5 AH |
801 | rc_dev = rc_allocate_device(); |
802 | if (!ati_remote || !rc_dev) | |
c5b7c7c3 | 803 | goto fail1; |
1da177e4 | 804 | |
c5b7c7c3 DT |
805 | /* Allocate URB buffers, URBs */ |
806 | if (ati_remote_alloc_buffers(udev, ati_remote)) | |
807 | goto fail2; | |
1da177e4 | 808 | |
c5b7c7c3 DT |
809 | ati_remote->endpoint_in = endpoint_in; |
810 | ati_remote->endpoint_out = endpoint_out; | |
811 | ati_remote->udev = udev; | |
c34516e5 | 812 | ati_remote->rdev = rc_dev; |
c5b7c7c3 | 813 | ati_remote->interface = interface; |
1da177e4 | 814 | |
c34516e5 AH |
815 | usb_make_path(udev, ati_remote->rc_phys, sizeof(ati_remote->rc_phys)); |
816 | strlcpy(ati_remote->mouse_phys, ati_remote->rc_phys, | |
817 | sizeof(ati_remote->mouse_phys)); | |
818 | ||
819 | strlcat(ati_remote->rc_phys, "/input0", sizeof(ati_remote->rc_phys)); | |
820 | strlcat(ati_remote->mouse_phys, "/input1", sizeof(ati_remote->mouse_phys)); | |
1da177e4 | 821 | |
1da177e4 | 822 | if (udev->manufacturer) |
c34516e5 AH |
823 | strlcpy(ati_remote->rc_name, udev->manufacturer, |
824 | sizeof(ati_remote->rc_name)); | |
1da177e4 LT |
825 | |
826 | if (udev->product) | |
c34516e5 AH |
827 | snprintf(ati_remote->rc_name, sizeof(ati_remote->rc_name), |
828 | "%s %s", ati_remote->rc_name, udev->product); | |
1da177e4 | 829 | |
c34516e5 AH |
830 | if (!strlen(ati_remote->rc_name)) |
831 | snprintf(ati_remote->rc_name, sizeof(ati_remote->rc_name), | |
c5b7c7c3 | 832 | DRIVER_DESC "(%04x,%04x)", |
05f091ab | 833 | le16_to_cpu(ati_remote->udev->descriptor.idVendor), |
1da177e4 LT |
834 | le16_to_cpu(ati_remote->udev->descriptor.idProduct)); |
835 | ||
c34516e5 AH |
836 | snprintf(ati_remote->mouse_name, sizeof(ati_remote->mouse_name), |
837 | "%s mouse", ati_remote->rc_name); | |
838 | ||
175fcecf AH |
839 | if (id->driver_info) |
840 | rc_dev->map_name = (const char *)id->driver_info; | |
841 | else | |
842 | rc_dev->map_name = RC_MAP_ATI_X10; | |
843 | ||
c34516e5 AH |
844 | ati_remote_rc_init(ati_remote); |
845 | mutex_init(&ati_remote->open_mutex); | |
c5b7c7c3 | 846 | |
1da177e4 | 847 | /* Device Hardware Initialization - fills in ati_remote->idev from udev. */ |
c5b7c7c3 DT |
848 | err = ati_remote_initialize(ati_remote); |
849 | if (err) | |
850 | goto fail3; | |
1da177e4 | 851 | |
c34516e5 AH |
852 | /* Set up and register rc device */ |
853 | err = rc_register_device(ati_remote->rdev); | |
5014186d DT |
854 | if (err) |
855 | goto fail3; | |
1da177e4 | 856 | |
c34516e5 AH |
857 | /* use our delay for rc_dev */ |
858 | ati_remote->rdev->input_dev->rep[REP_DELAY] = repeat_delay; | |
859 | ||
860 | /* Set up and register mouse input device */ | |
861 | if (mouse) { | |
862 | input_dev = input_allocate_device(); | |
863 | if (!input_dev) | |
864 | goto fail4; | |
865 | ||
866 | ati_remote->idev = input_dev; | |
867 | ati_remote_input_init(ati_remote); | |
868 | err = input_register_device(input_dev); | |
869 | ||
870 | if (err) | |
871 | goto fail5; | |
872 | } | |
873 | ||
1da177e4 | 874 | usb_set_intfdata(interface, ati_remote); |
c5b7c7c3 | 875 | return 0; |
05f091ab | 876 | |
c34516e5 AH |
877 | fail5: input_free_device(input_dev); |
878 | fail4: rc_unregister_device(rc_dev); | |
879 | rc_dev = NULL; | |
5014186d | 880 | fail3: usb_kill_urb(ati_remote->irq_urb); |
c5b7c7c3 | 881 | usb_kill_urb(ati_remote->out_urb); |
5014186d | 882 | fail2: ati_remote_free_buffers(ati_remote); |
c34516e5 | 883 | fail1: rc_free_device(rc_dev); |
c5b7c7c3 DT |
884 | kfree(ati_remote); |
885 | return err; | |
1da177e4 LT |
886 | } |
887 | ||
888 | /* | |
889 | * ati_remote_disconnect | |
890 | */ | |
891 | static void ati_remote_disconnect(struct usb_interface *interface) | |
892 | { | |
893 | struct ati_remote *ati_remote; | |
894 | ||
1da177e4 LT |
895 | ati_remote = usb_get_intfdata(interface); |
896 | usb_set_intfdata(interface, NULL); | |
897 | if (!ati_remote) { | |
1817b169 | 898 | dev_warn(&interface->dev, "%s - null device?\n", __func__); |
1da177e4 LT |
899 | return; |
900 | } | |
05f091ab | 901 | |
c5b7c7c3 DT |
902 | usb_kill_urb(ati_remote->irq_urb); |
903 | usb_kill_urb(ati_remote->out_urb); | |
c34516e5 AH |
904 | if (ati_remote->idev) |
905 | input_unregister_device(ati_remote->idev); | |
906 | rc_unregister_device(ati_remote->rdev); | |
c5b7c7c3 DT |
907 | ati_remote_free_buffers(ati_remote); |
908 | kfree(ati_remote); | |
1da177e4 LT |
909 | } |
910 | ||
911 | /* | |
912 | * ati_remote_init | |
913 | */ | |
914 | static int __init ati_remote_init(void) | |
915 | { | |
916 | int result; | |
05f091ab | 917 | |
1da177e4 LT |
918 | result = usb_register(&ati_remote_driver); |
919 | if (result) | |
899ef6e7 GKH |
920 | printk(KERN_ERR KBUILD_MODNAME |
921 | ": usb_register error #%d\n", result); | |
1da177e4 | 922 | else |
899ef6e7 GKH |
923 | printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":" |
924 | DRIVER_DESC "\n"); | |
1da177e4 LT |
925 | |
926 | return result; | |
927 | } | |
928 | ||
929 | /* | |
930 | * ati_remote_exit | |
931 | */ | |
932 | static void __exit ati_remote_exit(void) | |
933 | { | |
934 | usb_deregister(&ati_remote_driver); | |
935 | } | |
936 | ||
05f091ab DT |
937 | /* |
938 | * module specification | |
1da177e4 LT |
939 | */ |
940 | ||
941 | module_init(ati_remote_init); | |
942 | module_exit(ati_remote_exit); | |
943 | ||
944 | MODULE_AUTHOR(DRIVER_AUTHOR); | |
945 | MODULE_DESCRIPTION(DRIVER_DESC); | |
946 | MODULE_LICENSE("GPL"); |