Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /*****************************************************************************/ |
2 | /* | |
3 | * auerswald.c -- Auerswald PBX/System Telephone usb driver. | |
4 | * | |
5 | * Copyright (C) 2001 Wolfgang Mües (wolfgang@iksw-muees.de) | |
6 | * | |
7 | * Very much code of this driver is borrowed from dabusb.c (Deti Fliegl) | |
8 | * and from the USB Skeleton driver (Greg Kroah-Hartman). Thank you. | |
9 | * | |
10 | * This program is free software; you can redistribute it and/or modify | |
11 | * it under the terms of the GNU General Public License as published by | |
12 | * the Free Software Foundation; either version 2 of the License, or | |
13 | * (at your option) any later version. | |
14 | * | |
15 | * This program is distributed in the hope that it will be useful, | |
16 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
17 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
18 | * GNU General Public License for more details. | |
19 | * | |
20 | * You should have received a copy of the GNU General Public License | |
21 | * along with this program; if not, write to the Free Software | |
22 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
23 | */ | |
24 | /*****************************************************************************/ | |
25 | ||
26 | /* Standard Linux module include files */ | |
27 | #include <asm/uaccess.h> | |
28 | #include <asm/byteorder.h> | |
29 | #include <linux/slab.h> | |
30 | #include <linux/module.h> | |
31 | #include <linux/init.h> | |
32 | #include <linux/wait.h> | |
1da177e4 LT |
33 | #include <linux/usb.h> |
34 | ||
35 | /*-------------------------------------------------------------------*/ | |
36 | /* Debug support */ | |
37 | #ifdef DEBUG | |
38 | #define dump( adr, len) \ | |
39 | do { \ | |
40 | unsigned int u; \ | |
41 | printk (KERN_DEBUG); \ | |
42 | for (u = 0; u < len; u++) \ | |
43 | printk (" %02X", adr[u] & 0xFF); \ | |
44 | printk ("\n"); \ | |
45 | } while (0) | |
46 | #else | |
47 | #define dump( adr, len) | |
48 | #endif | |
49 | ||
50 | /*-------------------------------------------------------------------*/ | |
51 | /* Version Information */ | |
52 | #define DRIVER_VERSION "0.9.11" | |
53 | #define DRIVER_AUTHOR "Wolfgang Mües <wolfgang@iksw-muees.de>" | |
54 | #define DRIVER_DESC "Auerswald PBX/System Telephone usb driver" | |
55 | ||
56 | /*-------------------------------------------------------------------*/ | |
57 | /* Private declarations for Auerswald USB driver */ | |
58 | ||
59 | /* Auerswald Vendor ID */ | |
60 | #define ID_AUERSWALD 0x09BF | |
61 | ||
62 | #define AUER_MINOR_BASE 112 /* auerswald driver minor number */ | |
63 | ||
64 | /* we can have up to this number of device plugged in at once */ | |
65 | #define AUER_MAX_DEVICES 16 | |
66 | ||
67 | ||
68 | /* Number of read buffers for each device */ | |
69 | #define AU_RBUFFERS 10 | |
70 | ||
71 | /* Number of chain elements for each control chain */ | |
72 | #define AUCH_ELEMENTS 20 | |
73 | ||
74 | /* Number of retries in communication */ | |
75 | #define AU_RETRIES 10 | |
76 | ||
77 | /*-------------------------------------------------------------------*/ | |
78 | /* vendor specific protocol */ | |
79 | /* Header Byte */ | |
80 | #define AUH_INDIRMASK 0x80 /* mask for direct/indirect bit */ | |
81 | #define AUH_DIRECT 0x00 /* data is for USB device */ | |
82 | #define AUH_INDIRECT 0x80 /* USB device is relay */ | |
83 | ||
84 | #define AUH_SPLITMASK 0x40 /* mask for split bit */ | |
85 | #define AUH_UNSPLIT 0x00 /* data block is full-size */ | |
86 | #define AUH_SPLIT 0x40 /* data block is part of a larger one, | |
87 | split-byte follows */ | |
88 | ||
89 | #define AUH_TYPEMASK 0x3F /* mask for type of data transfer */ | |
90 | #define AUH_TYPESIZE 0x40 /* different types */ | |
91 | #define AUH_DCHANNEL 0x00 /* D channel data */ | |
92 | #define AUH_B1CHANNEL 0x01 /* B1 channel transparent */ | |
93 | #define AUH_B2CHANNEL 0x02 /* B2 channel transparent */ | |
94 | /* 0x03..0x0F reserved for driver internal use */ | |
95 | #define AUH_COMMAND 0x10 /* Command channel */ | |
96 | #define AUH_BPROT 0x11 /* Configuration block protocol */ | |
97 | #define AUH_DPROTANA 0x12 /* D channel protocol analyzer */ | |
98 | #define AUH_TAPI 0x13 /* telephone api data (ATD) */ | |
99 | /* 0x14..0x3F reserved for other protocols */ | |
100 | #define AUH_UNASSIGNED 0xFF /* if char device has no assigned service */ | |
101 | #define AUH_FIRSTUSERCH 0x11 /* first channel which is available for driver users */ | |
102 | ||
103 | #define AUH_SIZE 1 /* Size of Header Byte */ | |
104 | ||
105 | /* Split Byte. Only present if split bit in header byte set.*/ | |
106 | #define AUS_STARTMASK 0x80 /* mask for first block of splitted frame */ | |
107 | #define AUS_FIRST 0x80 /* first block */ | |
108 | #define AUS_FOLLOW 0x00 /* following block */ | |
109 | ||
110 | #define AUS_ENDMASK 0x40 /* mask for last block of splitted frame */ | |
111 | #define AUS_END 0x40 /* last block */ | |
112 | #define AUS_NOEND 0x00 /* not the last block */ | |
113 | ||
114 | #define AUS_LENMASK 0x3F /* mask for block length information */ | |
115 | ||
116 | /* Request types */ | |
117 | #define AUT_RREQ (USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_OTHER) /* Read Request */ | |
118 | #define AUT_WREQ (USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_OTHER) /* Write Request */ | |
119 | ||
120 | /* Vendor Requests */ | |
121 | #define AUV_GETINFO 0x00 /* GetDeviceInfo */ | |
122 | #define AUV_WBLOCK 0x01 /* Write Block */ | |
123 | #define AUV_RBLOCK 0x02 /* Read Block */ | |
124 | #define AUV_CHANNELCTL 0x03 /* Channel Control */ | |
125 | #define AUV_DUMMY 0x04 /* Dummy Out for retry */ | |
126 | ||
127 | /* Device Info Types */ | |
128 | #define AUDI_NUMBCH 0x0000 /* Number of supported B channels */ | |
129 | #define AUDI_OUTFSIZE 0x0001 /* Size of OUT B channel fifos */ | |
130 | #define AUDI_MBCTRANS 0x0002 /* max. Blocklength of control transfer */ | |
131 | ||
132 | /* Interrupt endpoint definitions */ | |
133 | #define AU_IRQENDP 1 /* Endpoint number */ | |
134 | #define AU_IRQCMDID 16 /* Command-block ID */ | |
135 | #define AU_BLOCKRDY 0 /* Command: Block data ready on ctl endpoint */ | |
136 | #define AU_IRQMINSIZE 5 /* Nr. of bytes decoded in this driver */ | |
137 | ||
138 | /* Device String Descriptors */ | |
139 | #define AUSI_VENDOR 1 /* "Auerswald GmbH & Co. KG" */ | |
140 | #define AUSI_DEVICE 2 /* Name of the Device */ | |
141 | #define AUSI_SERIALNR 3 /* Serial Number */ | |
142 | #define AUSI_MSN 4 /* "MSN ..." (first) Multiple Subscriber Number */ | |
143 | ||
144 | #define AUSI_DLEN 100 /* Max. Length of Device Description */ | |
145 | ||
146 | #define AUV_RETRY 0x101 /* First Firmware version which can do control retries */ | |
147 | ||
148 | /*-------------------------------------------------------------------*/ | |
149 | /* External data structures / Interface */ | |
150 | typedef struct | |
151 | { | |
152 | char __user *buf; /* return buffer for string contents */ | |
153 | unsigned int bsize; /* size of return buffer */ | |
154 | } audevinfo_t,*paudevinfo_t; | |
155 | ||
156 | /* IO controls */ | |
157 | #define IOCTL_AU_SLEN _IOR( 'U', 0xF0, int) /* return the max. string descriptor length */ | |
158 | #define IOCTL_AU_DEVINFO _IOWR('U', 0xF1, audevinfo_t) /* get name of a specific device */ | |
159 | #define IOCTL_AU_SERVREQ _IOW( 'U', 0xF2, int) /* request a service channel */ | |
160 | #define IOCTL_AU_BUFLEN _IOR( 'U', 0xF3, int) /* return the max. buffer length for the device */ | |
161 | #define IOCTL_AU_RXAVAIL _IOR( 'U', 0xF4, int) /* return != 0 if Receive Data available */ | |
162 | #define IOCTL_AU_CONNECT _IOR( 'U', 0xF5, int) /* return != 0 if connected to a service channel */ | |
163 | #define IOCTL_AU_TXREADY _IOR( 'U', 0xF6, int) /* return != 0 if Transmitt channel ready to send */ | |
164 | /* 'U' 0xF7..0xFF reseved */ | |
165 | ||
166 | /*-------------------------------------------------------------------*/ | |
167 | /* Internal data structures */ | |
168 | ||
169 | /* ..................................................................*/ | |
170 | /* urb chain element */ | |
171 | struct auerchain; /* forward for circular reference */ | |
172 | typedef struct | |
173 | { | |
174 | struct auerchain *chain; /* pointer to the chain to which this element belongs */ | |
175 | struct urb * urbp; /* pointer to attached urb */ | |
176 | void *context; /* saved URB context */ | |
177 | usb_complete_t complete; /* saved URB completion function */ | |
178 | struct list_head list; /* to include element into a list */ | |
179 | } auerchainelement_t,*pauerchainelement_t; | |
180 | ||
181 | /* urb chain */ | |
182 | typedef struct auerchain | |
183 | { | |
184 | pauerchainelement_t active; /* element which is submitted to urb */ | |
185 | spinlock_t lock; /* protection agains interrupts */ | |
186 | struct list_head waiting_list; /* list of waiting elements */ | |
187 | struct list_head free_list; /* list of available elements */ | |
188 | } auerchain_t,*pauerchain_t; | |
189 | ||
190 | /* urb blocking completion helper struct */ | |
191 | typedef struct | |
192 | { | |
193 | wait_queue_head_t wqh; /* wait for completion */ | |
194 | unsigned int done; /* completion flag */ | |
195 | } auerchain_chs_t,*pauerchain_chs_t; | |
196 | ||
197 | /* ...................................................................*/ | |
198 | /* buffer element */ | |
199 | struct auerbufctl; /* forward */ | |
200 | typedef struct | |
201 | { | |
202 | char *bufp; /* reference to allocated data buffer */ | |
203 | unsigned int len; /* number of characters in data buffer */ | |
204 | unsigned int retries; /* for urb retries */ | |
205 | struct usb_ctrlrequest *dr; /* for setup data in control messages */ | |
206 | struct urb * urbp; /* USB urb */ | |
207 | struct auerbufctl *list; /* pointer to list */ | |
208 | struct list_head buff_list; /* reference to next buffer in list */ | |
209 | } auerbuf_t,*pauerbuf_t; | |
210 | ||
211 | /* buffer list control block */ | |
212 | typedef struct auerbufctl | |
213 | { | |
214 | spinlock_t lock; /* protection in interrupt */ | |
215 | struct list_head free_buff_list;/* free buffers */ | |
216 | struct list_head rec_buff_list; /* buffers with receive data */ | |
217 | } auerbufctl_t,*pauerbufctl_t; | |
218 | ||
219 | /* ...................................................................*/ | |
220 | /* service context */ | |
221 | struct auerscon; /* forward */ | |
222 | typedef void (*auer_dispatch_t)(struct auerscon*, pauerbuf_t); | |
223 | typedef void (*auer_disconn_t) (struct auerscon*); | |
224 | typedef struct auerscon | |
225 | { | |
226 | unsigned int id; /* protocol service id AUH_xxxx */ | |
227 | auer_dispatch_t dispatch; /* dispatch read buffer */ | |
228 | auer_disconn_t disconnect; /* disconnect from device, wake up all char readers */ | |
229 | } auerscon_t,*pauerscon_t; | |
230 | ||
231 | /* ...................................................................*/ | |
232 | /* USB device context */ | |
233 | typedef struct | |
234 | { | |
235 | struct semaphore mutex; /* protection in user context */ | |
236 | char name[20]; /* name of the /dev/usb entry */ | |
237 | unsigned int dtindex; /* index in the device table */ | |
238 | struct usb_device * usbdev; /* USB device handle */ | |
239 | int open_count; /* count the number of open character channels */ | |
240 | char dev_desc[AUSI_DLEN];/* for storing a textual description */ | |
241 | unsigned int maxControlLength; /* max. Length of control paket (without header) */ | |
242 | struct urb * inturbp; /* interrupt urb */ | |
243 | char * intbufp; /* data buffer for interrupt urb */ | |
244 | unsigned int irqsize; /* size of interrupt endpoint 1 */ | |
245 | struct auerchain controlchain; /* for chaining of control messages */ | |
246 | auerbufctl_t bufctl; /* Buffer control for control transfers */ | |
247 | pauerscon_t services[AUH_TYPESIZE];/* context pointers for each service */ | |
248 | unsigned int version; /* Version of the device */ | |
249 | wait_queue_head_t bufferwait; /* wait for a control buffer */ | |
250 | } auerswald_t,*pauerswald_t; | |
251 | ||
252 | /* ................................................................... */ | |
253 | /* character device context */ | |
254 | typedef struct | |
255 | { | |
256 | struct semaphore mutex; /* protection in user context */ | |
257 | pauerswald_t auerdev; /* context pointer of assigned device */ | |
258 | auerbufctl_t bufctl; /* controls the buffer chain */ | |
259 | auerscon_t scontext; /* service context */ | |
260 | wait_queue_head_t readwait; /* for synchronous reading */ | |
261 | struct semaphore readmutex; /* protection against multiple reads */ | |
262 | pauerbuf_t readbuf; /* buffer held for partial reading */ | |
263 | unsigned int readoffset; /* current offset in readbuf */ | |
264 | unsigned int removed; /* is != 0 if device is removed */ | |
265 | } auerchar_t,*pauerchar_t; | |
266 | ||
267 | ||
268 | /*-------------------------------------------------------------------*/ | |
269 | /* Forwards */ | |
7d12e780 | 270 | static void auerswald_ctrlread_complete (struct urb * urb); |
1da177e4 LT |
271 | static void auerswald_removeservice (pauerswald_t cp, pauerscon_t scp); |
272 | static struct usb_driver auerswald_driver; | |
273 | ||
274 | ||
275 | /*-------------------------------------------------------------------*/ | |
276 | /* USB chain helper functions */ | |
277 | /* -------------------------- */ | |
278 | ||
279 | /* completion function for chained urbs */ | |
7d12e780 | 280 | static void auerchain_complete (struct urb * urb) |
1da177e4 LT |
281 | { |
282 | unsigned long flags; | |
283 | int result; | |
284 | ||
285 | /* get pointer to element and to chain */ | |
286 | pauerchainelement_t acep = (pauerchainelement_t) urb->context; | |
287 | pauerchain_t acp = acep->chain; | |
288 | ||
289 | /* restore original entries in urb */ | |
290 | urb->context = acep->context; | |
291 | urb->complete = acep->complete; | |
292 | ||
293 | dbg ("auerchain_complete called"); | |
294 | ||
295 | /* call original completion function | |
296 | NOTE: this function may lead to more urbs submitted into the chain. | |
297 | (no chain lock at calling complete()!) | |
298 | acp->active != NULL is protecting us against recursion.*/ | |
7d12e780 | 299 | urb->complete (urb); |
1da177e4 LT |
300 | |
301 | /* detach element from chain data structure */ | |
302 | spin_lock_irqsave (&acp->lock, flags); | |
303 | if (acp->active != acep) /* paranoia debug check */ | |
304 | dbg ("auerchain_complete: completion on non-active element called!"); | |
305 | else | |
306 | acp->active = NULL; | |
307 | ||
308 | /* add the used chain element to the list of free elements */ | |
309 | list_add_tail (&acep->list, &acp->free_list); | |
310 | acep = NULL; | |
311 | ||
312 | /* is there a new element waiting in the chain? */ | |
313 | if (!acp->active && !list_empty (&acp->waiting_list)) { | |
314 | /* yes: get the entry */ | |
315 | struct list_head *tmp = acp->waiting_list.next; | |
316 | list_del (tmp); | |
317 | acep = list_entry (tmp, auerchainelement_t, list); | |
318 | acp->active = acep; | |
319 | } | |
320 | spin_unlock_irqrestore (&acp->lock, flags); | |
321 | ||
322 | /* submit the new urb */ | |
323 | if (acep) { | |
324 | urb = acep->urbp; | |
325 | dbg ("auerchain_complete: submitting next urb from chain"); | |
326 | urb->status = 0; /* needed! */ | |
327 | result = usb_submit_urb(urb, GFP_ATOMIC); | |
328 | ||
329 | /* check for submit errors */ | |
330 | if (result) { | |
331 | urb->status = result; | |
332 | dbg("auerchain_complete: usb_submit_urb with error code %d", result); | |
333 | /* and do error handling via *this* completion function (recursive) */ | |
7d12e780 | 334 | auerchain_complete( urb); |
1da177e4 LT |
335 | } |
336 | } else { | |
337 | /* simple return without submitting a new urb. | |
338 | The empty chain is detected with acp->active == NULL. */ | |
339 | }; | |
340 | } | |
341 | ||
342 | ||
343 | /* submit function for chained urbs | |
344 | this function may be called from completion context or from user space! | |
345 | early = 1 -> submit in front of chain | |
346 | */ | |
347 | static int auerchain_submit_urb_list (pauerchain_t acp, struct urb * urb, int early) | |
348 | { | |
349 | int result; | |
350 | unsigned long flags; | |
351 | pauerchainelement_t acep = NULL; | |
352 | ||
353 | dbg ("auerchain_submit_urb called"); | |
354 | ||
355 | /* try to get a chain element */ | |
356 | spin_lock_irqsave (&acp->lock, flags); | |
357 | if (!list_empty (&acp->free_list)) { | |
358 | /* yes: get the entry */ | |
359 | struct list_head *tmp = acp->free_list.next; | |
360 | list_del (tmp); | |
361 | acep = list_entry (tmp, auerchainelement_t, list); | |
362 | } | |
363 | spin_unlock_irqrestore (&acp->lock, flags); | |
364 | ||
365 | /* if no chain element available: return with error */ | |
366 | if (!acep) { | |
367 | return -ENOMEM; | |
368 | } | |
369 | ||
370 | /* fill in the new chain element values */ | |
371 | acep->chain = acp; | |
372 | acep->context = urb->context; | |
373 | acep->complete = urb->complete; | |
374 | acep->urbp = urb; | |
375 | INIT_LIST_HEAD (&acep->list); | |
376 | ||
377 | /* modify urb */ | |
378 | urb->context = acep; | |
379 | urb->complete = auerchain_complete; | |
380 | urb->status = -EINPROGRESS; /* usb_submit_urb does this, too */ | |
381 | ||
382 | /* add element to chain - or start it immediately */ | |
383 | spin_lock_irqsave (&acp->lock, flags); | |
384 | if (acp->active) { | |
385 | /* there is traffic in the chain, simple add element to chain */ | |
386 | if (early) { | |
387 | dbg ("adding new urb to head of chain"); | |
388 | list_add (&acep->list, &acp->waiting_list); | |
389 | } else { | |
390 | dbg ("adding new urb to end of chain"); | |
391 | list_add_tail (&acep->list, &acp->waiting_list); | |
392 | } | |
393 | acep = NULL; | |
394 | } else { | |
395 | /* the chain is empty. Prepare restart */ | |
396 | acp->active = acep; | |
397 | } | |
398 | /* Spin has to be removed before usb_submit_urb! */ | |
399 | spin_unlock_irqrestore (&acp->lock, flags); | |
400 | ||
401 | /* Submit urb if immediate restart */ | |
402 | if (acep) { | |
403 | dbg("submitting urb immediate"); | |
404 | urb->status = 0; /* needed! */ | |
405 | result = usb_submit_urb(urb, GFP_ATOMIC); | |
406 | /* check for submit errors */ | |
407 | if (result) { | |
408 | urb->status = result; | |
409 | dbg("auerchain_submit_urb: usb_submit_urb with error code %d", result); | |
410 | /* and do error handling via completion function */ | |
7d12e780 | 411 | auerchain_complete( urb); |
1da177e4 LT |
412 | } |
413 | } | |
414 | ||
415 | return 0; | |
416 | } | |
417 | ||
418 | /* submit function for chained urbs | |
419 | this function may be called from completion context or from user space! | |
420 | */ | |
421 | static int auerchain_submit_urb (pauerchain_t acp, struct urb * urb) | |
422 | { | |
423 | return auerchain_submit_urb_list (acp, urb, 0); | |
424 | } | |
425 | ||
426 | /* cancel an urb which is submitted to the chain | |
427 | the result is 0 if the urb is cancelled, or -EINPROGRESS if | |
b375a049 | 428 | the function is successfully started. |
1da177e4 LT |
429 | */ |
430 | static int auerchain_unlink_urb (pauerchain_t acp, struct urb * urb) | |
431 | { | |
432 | unsigned long flags; | |
433 | struct urb * urbp; | |
434 | pauerchainelement_t acep; | |
435 | struct list_head *tmp; | |
436 | ||
437 | dbg ("auerchain_unlink_urb called"); | |
438 | ||
439 | /* search the chain of waiting elements */ | |
440 | spin_lock_irqsave (&acp->lock, flags); | |
441 | list_for_each (tmp, &acp->waiting_list) { | |
442 | acep = list_entry (tmp, auerchainelement_t, list); | |
443 | if (acep->urbp == urb) { | |
444 | list_del (tmp); | |
445 | urb->context = acep->context; | |
446 | urb->complete = acep->complete; | |
447 | list_add_tail (&acep->list, &acp->free_list); | |
448 | spin_unlock_irqrestore (&acp->lock, flags); | |
449 | dbg ("unlink waiting urb"); | |
450 | urb->status = -ENOENT; | |
7d12e780 | 451 | urb->complete (urb); |
1da177e4 LT |
452 | return 0; |
453 | } | |
454 | } | |
455 | /* not found. */ | |
456 | spin_unlock_irqrestore (&acp->lock, flags); | |
457 | ||
458 | /* get the active urb */ | |
459 | acep = acp->active; | |
460 | if (acep) { | |
461 | urbp = acep->urbp; | |
462 | ||
463 | /* check if we have to cancel the active urb */ | |
464 | if (urbp == urb) { | |
465 | /* note that there is a race condition between the check above | |
466 | and the unlink() call because of no lock. This race is harmless, | |
467 | because the usb module will detect the unlink() after completion. | |
468 | We can't use the acp->lock here because the completion function | |
469 | wants to grab it. | |
470 | */ | |
471 | dbg ("unlink active urb"); | |
472 | return usb_unlink_urb (urbp); | |
473 | } | |
474 | } | |
475 | ||
476 | /* not found anyway | |
477 | ... is some kind of success | |
478 | */ | |
479 | dbg ("urb to unlink not found in chain"); | |
480 | return 0; | |
481 | } | |
482 | ||
483 | /* cancel all urbs which are in the chain. | |
484 | this function must not be called from interrupt or completion handler. | |
485 | */ | |
486 | static void auerchain_unlink_all (pauerchain_t acp) | |
487 | { | |
488 | unsigned long flags; | |
489 | struct urb * urbp; | |
490 | pauerchainelement_t acep; | |
491 | ||
492 | dbg ("auerchain_unlink_all called"); | |
493 | ||
494 | /* clear the chain of waiting elements */ | |
495 | spin_lock_irqsave (&acp->lock, flags); | |
496 | while (!list_empty (&acp->waiting_list)) { | |
497 | /* get the next entry */ | |
498 | struct list_head *tmp = acp->waiting_list.next; | |
499 | list_del (tmp); | |
500 | acep = list_entry (tmp, auerchainelement_t, list); | |
501 | urbp = acep->urbp; | |
502 | urbp->context = acep->context; | |
503 | urbp->complete = acep->complete; | |
504 | list_add_tail (&acep->list, &acp->free_list); | |
505 | spin_unlock_irqrestore (&acp->lock, flags); | |
506 | dbg ("unlink waiting urb"); | |
507 | urbp->status = -ENOENT; | |
7d12e780 | 508 | urbp->complete (urbp); |
1da177e4 LT |
509 | spin_lock_irqsave (&acp->lock, flags); |
510 | } | |
511 | spin_unlock_irqrestore (&acp->lock, flags); | |
512 | ||
513 | /* clear the active urb */ | |
514 | acep = acp->active; | |
515 | if (acep) { | |
516 | urbp = acep->urbp; | |
1da177e4 LT |
517 | dbg ("unlink active urb"); |
518 | usb_kill_urb (urbp); | |
519 | } | |
520 | } | |
521 | ||
522 | ||
523 | /* free the chain. | |
524 | this function must not be called from interrupt or completion handler. | |
525 | */ | |
526 | static void auerchain_free (pauerchain_t acp) | |
527 | { | |
528 | unsigned long flags; | |
529 | pauerchainelement_t acep; | |
530 | ||
531 | dbg ("auerchain_free called"); | |
532 | ||
533 | /* first, cancel all pending urbs */ | |
534 | auerchain_unlink_all (acp); | |
535 | ||
536 | /* free the elements */ | |
537 | spin_lock_irqsave (&acp->lock, flags); | |
538 | while (!list_empty (&acp->free_list)) { | |
539 | /* get the next entry */ | |
540 | struct list_head *tmp = acp->free_list.next; | |
541 | list_del (tmp); | |
542 | spin_unlock_irqrestore (&acp->lock, flags); | |
543 | acep = list_entry (tmp, auerchainelement_t, list); | |
544 | kfree (acep); | |
545 | spin_lock_irqsave (&acp->lock, flags); | |
546 | } | |
547 | spin_unlock_irqrestore (&acp->lock, flags); | |
548 | } | |
549 | ||
550 | ||
551 | /* Init the chain control structure */ | |
552 | static void auerchain_init (pauerchain_t acp) | |
553 | { | |
554 | /* init the chain data structure */ | |
555 | acp->active = NULL; | |
556 | spin_lock_init (&acp->lock); | |
557 | INIT_LIST_HEAD (&acp->waiting_list); | |
558 | INIT_LIST_HEAD (&acp->free_list); | |
559 | } | |
560 | ||
561 | /* setup a chain. | |
562 | It is assumed that there is no concurrency while setting up the chain | |
563 | requirement: auerchain_init() | |
564 | */ | |
565 | static int auerchain_setup (pauerchain_t acp, unsigned int numElements) | |
566 | { | |
567 | pauerchainelement_t acep; | |
568 | ||
569 | dbg ("auerchain_setup called with %d elements", numElements); | |
570 | ||
571 | /* fill the list of free elements */ | |
572 | for (;numElements; numElements--) { | |
80b6ca48 | 573 | acep = kzalloc(sizeof(auerchainelement_t), GFP_KERNEL); |
1da177e4 LT |
574 | if (!acep) |
575 | goto ac_fail; | |
1da177e4 LT |
576 | INIT_LIST_HEAD (&acep->list); |
577 | list_add_tail (&acep->list, &acp->free_list); | |
578 | } | |
579 | return 0; | |
580 | ||
581 | ac_fail:/* free the elements */ | |
582 | while (!list_empty (&acp->free_list)) { | |
583 | /* get the next entry */ | |
584 | struct list_head *tmp = acp->free_list.next; | |
585 | list_del (tmp); | |
586 | acep = list_entry (tmp, auerchainelement_t, list); | |
587 | kfree (acep); | |
588 | } | |
589 | return -ENOMEM; | |
590 | } | |
591 | ||
592 | ||
593 | /* completion handler for synchronous chained URBs */ | |
7d12e780 | 594 | static void auerchain_blocking_completion (struct urb *urb) |
1da177e4 LT |
595 | { |
596 | pauerchain_chs_t pchs = (pauerchain_chs_t)urb->context; | |
597 | pchs->done = 1; | |
598 | wmb(); | |
599 | wake_up (&pchs->wqh); | |
600 | } | |
601 | ||
602 | ||
603 | /* Starts chained urb and waits for completion or timeout */ | |
604 | static int auerchain_start_wait_urb (pauerchain_t acp, struct urb *urb, int timeout, int* actual_length) | |
605 | { | |
606 | auerchain_chs_t chs; | |
607 | int status; | |
608 | ||
609 | dbg ("auerchain_start_wait_urb called"); | |
610 | init_waitqueue_head (&chs.wqh); | |
611 | chs.done = 0; | |
612 | ||
613 | urb->context = &chs; | |
614 | status = auerchain_submit_urb (acp, urb); | |
615 | if (status) | |
616 | /* something went wrong */ | |
617 | return status; | |
618 | ||
619 | timeout = wait_event_timeout(chs.wqh, chs.done, timeout); | |
620 | ||
621 | if (!timeout && !chs.done) { | |
622 | if (urb->status != -EINPROGRESS) { /* No callback?!! */ | |
623 | dbg ("auerchain_start_wait_urb: raced timeout"); | |
624 | status = urb->status; | |
625 | } else { | |
626 | dbg ("auerchain_start_wait_urb: timeout"); | |
627 | auerchain_unlink_urb (acp, urb); /* remove urb safely */ | |
628 | status = -ETIMEDOUT; | |
629 | } | |
630 | } else | |
631 | status = urb->status; | |
632 | ||
ae97fec3 | 633 | if (status >= 0) |
1da177e4 LT |
634 | *actual_length = urb->actual_length; |
635 | ||
636 | return status; | |
637 | } | |
638 | ||
639 | ||
640 | /* auerchain_control_msg - Builds a control urb, sends it off and waits for completion | |
641 | acp: pointer to the auerchain | |
642 | dev: pointer to the usb device to send the message to | |
643 | pipe: endpoint "pipe" to send the message to | |
644 | request: USB message request value | |
645 | requesttype: USB message request type value | |
646 | value: USB message value | |
647 | index: USB message index value | |
648 | data: pointer to the data to send | |
649 | size: length in bytes of the data to send | |
650 | timeout: time to wait for the message to complete before timing out (if 0 the wait is forever) | |
651 | ||
652 | This function sends a simple control message to a specified endpoint | |
653 | and waits for the message to complete, or timeout. | |
654 | ||
655 | If successful, it returns the transferred length, otherwise a negative error number. | |
656 | ||
657 | Don't use this function from within an interrupt context, like a | |
658 | bottom half handler. If you need an asynchronous message, or need to send | |
659 | a message from within interrupt context, use auerchain_submit_urb() | |
660 | */ | |
661 | static int auerchain_control_msg (pauerchain_t acp, struct usb_device *dev, unsigned int pipe, __u8 request, __u8 requesttype, | |
662 | __u16 value, __u16 index, void *data, __u16 size, int timeout) | |
663 | { | |
664 | int ret; | |
665 | struct usb_ctrlrequest *dr; | |
666 | struct urb *urb; | |
a6343afb | 667 | int uninitialized_var(length); |
1da177e4 LT |
668 | |
669 | dbg ("auerchain_control_msg"); | |
670 | dr = kmalloc (sizeof (struct usb_ctrlrequest), GFP_KERNEL); | |
671 | if (!dr) | |
672 | return -ENOMEM; | |
673 | urb = usb_alloc_urb (0, GFP_KERNEL); | |
674 | if (!urb) { | |
675 | kfree (dr); | |
676 | return -ENOMEM; | |
677 | } | |
678 | ||
679 | dr->bRequestType = requesttype; | |
680 | dr->bRequest = request; | |
681 | dr->wValue = cpu_to_le16 (value); | |
682 | dr->wIndex = cpu_to_le16 (index); | |
683 | dr->wLength = cpu_to_le16 (size); | |
684 | ||
685 | usb_fill_control_urb (urb, dev, pipe, (unsigned char*)dr, data, size, /* build urb */ | |
686 | auerchain_blocking_completion, NULL); | |
687 | ret = auerchain_start_wait_urb (acp, urb, timeout, &length); | |
688 | ||
689 | usb_free_urb (urb); | |
690 | kfree (dr); | |
691 | ||
692 | if (ret < 0) | |
693 | return ret; | |
694 | else | |
695 | return length; | |
696 | } | |
697 | ||
698 | ||
699 | /*-------------------------------------------------------------------*/ | |
700 | /* Buffer List helper functions */ | |
701 | ||
702 | /* free a single auerbuf */ | |
703 | static void auerbuf_free (pauerbuf_t bp) | |
704 | { | |
1bc3c9e1 JJ |
705 | kfree(bp->bufp); |
706 | kfree(bp->dr); | |
2891a51c | 707 | usb_free_urb(bp->urbp); |
1bc3c9e1 | 708 | kfree(bp); |
1da177e4 LT |
709 | } |
710 | ||
711 | /* free the buffers from an auerbuf list */ | |
712 | static void auerbuf_free_list (struct list_head *q) | |
713 | { | |
714 | struct list_head *tmp; | |
715 | struct list_head *p; | |
716 | pauerbuf_t bp; | |
717 | ||
718 | dbg ("auerbuf_free_list"); | |
719 | for (p = q->next; p != q;) { | |
720 | bp = list_entry (p, auerbuf_t, buff_list); | |
721 | tmp = p->next; | |
722 | list_del (p); | |
723 | p = tmp; | |
724 | auerbuf_free (bp); | |
725 | } | |
726 | } | |
727 | ||
728 | /* init the members of a list control block */ | |
729 | static void auerbuf_init (pauerbufctl_t bcp) | |
730 | { | |
731 | dbg ("auerbuf_init"); | |
732 | spin_lock_init (&bcp->lock); | |
733 | INIT_LIST_HEAD (&bcp->free_buff_list); | |
734 | INIT_LIST_HEAD (&bcp->rec_buff_list); | |
735 | } | |
736 | ||
737 | /* free all buffers from an auerbuf chain */ | |
738 | static void auerbuf_free_buffers (pauerbufctl_t bcp) | |
739 | { | |
740 | unsigned long flags; | |
741 | dbg ("auerbuf_free_buffers"); | |
742 | ||
743 | spin_lock_irqsave (&bcp->lock, flags); | |
744 | ||
745 | auerbuf_free_list (&bcp->free_buff_list); | |
746 | auerbuf_free_list (&bcp->rec_buff_list); | |
747 | ||
748 | spin_unlock_irqrestore (&bcp->lock, flags); | |
749 | } | |
750 | ||
751 | /* setup a list of buffers */ | |
752 | /* requirement: auerbuf_init() */ | |
753 | static int auerbuf_setup (pauerbufctl_t bcp, unsigned int numElements, unsigned int bufsize) | |
754 | { | |
755 | pauerbuf_t bep = NULL; | |
756 | ||
757 | dbg ("auerbuf_setup called with %d elements of %d bytes", numElements, bufsize); | |
758 | ||
759 | /* fill the list of free elements */ | |
760 | for (;numElements; numElements--) { | |
80b6ca48 | 761 | bep = kzalloc(sizeof(auerbuf_t), GFP_KERNEL); |
1da177e4 LT |
762 | if (!bep) |
763 | goto bl_fail; | |
1da177e4 LT |
764 | bep->list = bcp; |
765 | INIT_LIST_HEAD (&bep->buff_list); | |
0e8eb0f0 | 766 | bep->bufp = kmalloc (bufsize, GFP_KERNEL); |
1da177e4 LT |
767 | if (!bep->bufp) |
768 | goto bl_fail; | |
5cbded58 | 769 | bep->dr = kmalloc(sizeof (struct usb_ctrlrequest), GFP_KERNEL); |
1da177e4 LT |
770 | if (!bep->dr) |
771 | goto bl_fail; | |
772 | bep->urbp = usb_alloc_urb (0, GFP_KERNEL); | |
773 | if (!bep->urbp) | |
774 | goto bl_fail; | |
775 | list_add_tail (&bep->buff_list, &bcp->free_buff_list); | |
776 | } | |
777 | return 0; | |
778 | ||
779 | bl_fail:/* not enough memory. Free allocated elements */ | |
780 | dbg ("auerbuf_setup: no more memory"); | |
5a3fcf5c | 781 | auerbuf_free(bep); |
1da177e4 LT |
782 | auerbuf_free_buffers (bcp); |
783 | return -ENOMEM; | |
784 | } | |
785 | ||
786 | /* insert a used buffer into the free list */ | |
787 | static void auerbuf_releasebuf( pauerbuf_t bp) | |
788 | { | |
789 | unsigned long flags; | |
790 | pauerbufctl_t bcp = bp->list; | |
791 | bp->retries = 0; | |
792 | ||
793 | dbg ("auerbuf_releasebuf called"); | |
794 | spin_lock_irqsave (&bcp->lock, flags); | |
795 | list_add_tail (&bp->buff_list, &bcp->free_buff_list); | |
796 | spin_unlock_irqrestore (&bcp->lock, flags); | |
797 | } | |
798 | ||
799 | ||
800 | /*-------------------------------------------------------------------*/ | |
801 | /* Completion handlers */ | |
802 | ||
803 | /* Values of urb->status or results of usb_submit_urb(): | |
804 | 0 Initial, OK | |
805 | -EINPROGRESS during submission until end | |
806 | -ENOENT if urb is unlinked | |
38e2bfc9 | 807 | -ETIME Device did not respond |
1da177e4 LT |
808 | -ENOMEM Memory Overflow |
809 | -ENODEV Specified USB-device or bus doesn't exist | |
810 | -ENXIO URB already queued | |
811 | -EINVAL a) Invalid transfer type specified (or not supported) | |
812 | b) Invalid interrupt interval (0n256) | |
813 | -EAGAIN a) Specified ISO start frame too early | |
814 | b) (using ISO-ASAP) Too much scheduled for the future wait some time and try again. | |
815 | -EFBIG Too much ISO frames requested (currently uhci900) | |
816 | -EPIPE Specified pipe-handle/Endpoint is already stalled | |
817 | -EMSGSIZE Endpoint message size is zero, do interface/alternate setting | |
818 | -EPROTO a) Bitstuff error | |
819 | b) Unknown USB error | |
820 | -EILSEQ CRC mismatch | |
821 | -ENOSR Buffer error | |
822 | -EREMOTEIO Short packet detected | |
823 | -EXDEV ISO transfer only partially completed look at individual frame status for details | |
824 | -EINVAL ISO madness, if this happens: Log off and go home | |
825 | -EOVERFLOW babble | |
826 | */ | |
827 | ||
828 | /* check if a status code allows a retry */ | |
829 | static int auerswald_status_retry (int status) | |
830 | { | |
831 | switch (status) { | |
832 | case 0: | |
38e2bfc9 | 833 | case -ETIME: |
1da177e4 LT |
834 | case -EOVERFLOW: |
835 | case -EAGAIN: | |
836 | case -EPIPE: | |
837 | case -EPROTO: | |
838 | case -EILSEQ: | |
839 | case -ENOSR: | |
840 | case -EREMOTEIO: | |
841 | return 1; /* do a retry */ | |
842 | } | |
843 | return 0; /* no retry possible */ | |
844 | } | |
845 | ||
846 | /* Completion of asynchronous write block */ | |
7d12e780 | 847 | static void auerchar_ctrlwrite_complete (struct urb * urb) |
1da177e4 LT |
848 | { |
849 | pauerbuf_t bp = (pauerbuf_t) urb->context; | |
850 | pauerswald_t cp = ((pauerswald_t)((char *)(bp->list)-(unsigned long)(&((pauerswald_t)0)->bufctl))); | |
851 | dbg ("auerchar_ctrlwrite_complete called"); | |
852 | ||
853 | /* reuse the buffer */ | |
854 | auerbuf_releasebuf (bp); | |
855 | /* Wake up all processes waiting for a buffer */ | |
856 | wake_up (&cp->bufferwait); | |
857 | } | |
858 | ||
859 | /* Completion handler for dummy retry packet */ | |
7d12e780 | 860 | static void auerswald_ctrlread_wretcomplete (struct urb * urb) |
1da177e4 LT |
861 | { |
862 | pauerbuf_t bp = (pauerbuf_t) urb->context; | |
863 | pauerswald_t cp; | |
864 | int ret; | |
22bea334 GKH |
865 | int status = urb->status; |
866 | ||
1da177e4 | 867 | dbg ("auerswald_ctrlread_wretcomplete called"); |
22bea334 | 868 | dbg ("complete with status: %d", status); |
1da177e4 LT |
869 | cp = ((pauerswald_t)((char *)(bp->list)-(unsigned long)(&((pauerswald_t)0)->bufctl))); |
870 | ||
871 | /* check if it is possible to advance */ | |
22bea334 | 872 | if (!auerswald_status_retry(status) || !cp->usbdev) { |
1da177e4 | 873 | /* reuse the buffer */ |
22bea334 | 874 | err ("control dummy: transmission error %d, can not retry", status); |
1da177e4 LT |
875 | auerbuf_releasebuf (bp); |
876 | /* Wake up all processes waiting for a buffer */ | |
877 | wake_up (&cp->bufferwait); | |
878 | return; | |
879 | } | |
880 | ||
881 | /* fill the control message */ | |
882 | bp->dr->bRequestType = AUT_RREQ; | |
883 | bp->dr->bRequest = AUV_RBLOCK; | |
884 | bp->dr->wLength = bp->dr->wValue; /* temporary stored */ | |
885 | bp->dr->wValue = cpu_to_le16 (1); /* Retry Flag */ | |
886 | /* bp->dr->index = channel id; remains */ | |
887 | usb_fill_control_urb (bp->urbp, cp->usbdev, usb_rcvctrlpipe (cp->usbdev, 0), | |
888 | (unsigned char*)bp->dr, bp->bufp, le16_to_cpu (bp->dr->wLength), | |
889 | auerswald_ctrlread_complete,bp); | |
890 | ||
891 | /* submit the control msg as next paket */ | |
892 | ret = auerchain_submit_urb_list (&cp->controlchain, bp->urbp, 1); | |
893 | if (ret) { | |
894 | dbg ("auerswald_ctrlread_complete: nonzero result of auerchain_submit_urb_list %d", ret); | |
895 | bp->urbp->status = ret; | |
7d12e780 | 896 | auerswald_ctrlread_complete (bp->urbp); |
1da177e4 LT |
897 | } |
898 | } | |
899 | ||
900 | /* completion handler for receiving of control messages */ | |
7d12e780 | 901 | static void auerswald_ctrlread_complete (struct urb * urb) |
1da177e4 LT |
902 | { |
903 | unsigned int serviceid; | |
904 | pauerswald_t cp; | |
905 | pauerscon_t scp; | |
906 | pauerbuf_t bp = (pauerbuf_t) urb->context; | |
22bea334 | 907 | int status = urb->status; |
1da177e4 | 908 | int ret; |
22bea334 | 909 | |
1da177e4 LT |
910 | dbg ("auerswald_ctrlread_complete called"); |
911 | ||
912 | cp = ((pauerswald_t)((char *)(bp->list)-(unsigned long)(&((pauerswald_t)0)->bufctl))); | |
913 | ||
914 | /* check if there is valid data in this urb */ | |
22bea334 GKH |
915 | if (status) { |
916 | dbg ("complete with non-zero status: %d", status); | |
1da177e4 | 917 | /* should we do a retry? */ |
22bea334 | 918 | if (!auerswald_status_retry(status) |
1da177e4 LT |
919 | || !cp->usbdev |
920 | || (cp->version < AUV_RETRY) | |
921 | || (bp->retries >= AU_RETRIES)) { | |
922 | /* reuse the buffer */ | |
22bea334 | 923 | err ("control read: transmission error %d, can not retry", status); |
1da177e4 LT |
924 | auerbuf_releasebuf (bp); |
925 | /* Wake up all processes waiting for a buffer */ | |
926 | wake_up (&cp->bufferwait); | |
927 | return; | |
928 | } | |
929 | bp->retries++; | |
930 | dbg ("Retry count = %d", bp->retries); | |
931 | /* send a long dummy control-write-message to allow device firmware to react */ | |
932 | bp->dr->bRequestType = AUT_WREQ; | |
933 | bp->dr->bRequest = AUV_DUMMY; | |
934 | bp->dr->wValue = bp->dr->wLength; /* temporary storage */ | |
935 | // bp->dr->wIndex channel ID remains | |
936 | bp->dr->wLength = cpu_to_le16 (32); /* >= 8 bytes */ | |
937 | usb_fill_control_urb (bp->urbp, cp->usbdev, usb_sndctrlpipe (cp->usbdev, 0), | |
938 | (unsigned char*)bp->dr, bp->bufp, 32, | |
939 | auerswald_ctrlread_wretcomplete,bp); | |
940 | ||
941 | /* submit the control msg as next paket */ | |
942 | ret = auerchain_submit_urb_list (&cp->controlchain, bp->urbp, 1); | |
943 | if (ret) { | |
944 | dbg ("auerswald_ctrlread_complete: nonzero result of auerchain_submit_urb_list %d", ret); | |
945 | bp->urbp->status = ret; | |
7d12e780 | 946 | auerswald_ctrlread_wretcomplete (bp->urbp); |
1da177e4 LT |
947 | } |
948 | return; | |
949 | } | |
950 | ||
951 | /* get the actual bytecount (incl. headerbyte) */ | |
952 | bp->len = urb->actual_length; | |
953 | serviceid = bp->bufp[0] & AUH_TYPEMASK; | |
954 | dbg ("Paket with serviceid %d and %d bytes received", serviceid, bp->len); | |
955 | ||
956 | /* dispatch the paket */ | |
957 | scp = cp->services[serviceid]; | |
958 | if (scp) { | |
959 | /* look, Ma, a listener! */ | |
960 | scp->dispatch (scp, bp); | |
961 | } | |
962 | ||
963 | /* release the paket */ | |
964 | auerbuf_releasebuf (bp); | |
965 | /* Wake up all processes waiting for a buffer */ | |
966 | wake_up (&cp->bufferwait); | |
967 | } | |
968 | ||
969 | /*-------------------------------------------------------------------*/ | |
970 | /* Handling of Interrupt Endpoint */ | |
971 | /* This interrupt Endpoint is used to inform the host about waiting | |
972 | messages from the USB device. | |
973 | */ | |
974 | /* int completion handler. */ | |
7d12e780 | 975 | static void auerswald_int_complete (struct urb * urb) |
1da177e4 LT |
976 | { |
977 | unsigned long flags; | |
978 | unsigned int channelid; | |
979 | unsigned int bytecount; | |
980 | int ret; | |
22bea334 | 981 | int status = urb->status; |
1da177e4 LT |
982 | pauerbuf_t bp = NULL; |
983 | pauerswald_t cp = (pauerswald_t) urb->context; | |
984 | ||
985 | dbg ("%s called", __FUNCTION__); | |
986 | ||
22bea334 | 987 | switch (status) { |
1da177e4 LT |
988 | case 0: |
989 | /* success */ | |
990 | break; | |
991 | case -ECONNRESET: | |
992 | case -ENOENT: | |
993 | case -ESHUTDOWN: | |
994 | /* this urb is terminated, clean up */ | |
22bea334 | 995 | dbg("%s - urb shutting down with status: %d", __FUNCTION__, status); |
1da177e4 LT |
996 | return; |
997 | default: | |
22bea334 | 998 | dbg("%s - nonzero urb status received: %d", __FUNCTION__, status); |
1da177e4 LT |
999 | goto exit; |
1000 | } | |
1001 | ||
1002 | /* check if all needed data was received */ | |
1003 | if (urb->actual_length < AU_IRQMINSIZE) { | |
1004 | dbg ("invalid data length received: %d bytes", urb->actual_length); | |
1005 | goto exit; | |
1006 | } | |
1007 | ||
1008 | /* check the command code */ | |
1009 | if (cp->intbufp[0] != AU_IRQCMDID) { | |
1010 | dbg ("invalid command received: %d", cp->intbufp[0]); | |
1011 | goto exit; | |
1012 | } | |
1013 | ||
1014 | /* check the command type */ | |
1015 | if (cp->intbufp[1] != AU_BLOCKRDY) { | |
1016 | dbg ("invalid command type received: %d", cp->intbufp[1]); | |
1017 | goto exit; | |
1018 | } | |
1019 | ||
1020 | /* now extract the information */ | |
1021 | channelid = cp->intbufp[2]; | |
1022 | bytecount = (unsigned char)cp->intbufp[3]; | |
1023 | bytecount |= (unsigned char)cp->intbufp[4] << 8; | |
1024 | ||
1025 | /* check the channel id */ | |
1026 | if (channelid >= AUH_TYPESIZE) { | |
1027 | dbg ("invalid channel id received: %d", channelid); | |
1028 | goto exit; | |
1029 | } | |
1030 | ||
1031 | /* check the byte count */ | |
1032 | if (bytecount > (cp->maxControlLength+AUH_SIZE)) { | |
1033 | dbg ("invalid byte count received: %d", bytecount); | |
1034 | goto exit; | |
1035 | } | |
1036 | dbg ("Service Channel = %d", channelid); | |
1037 | dbg ("Byte Count = %d", bytecount); | |
1038 | ||
1039 | /* get a buffer for the next data paket */ | |
1040 | spin_lock_irqsave (&cp->bufctl.lock, flags); | |
1041 | if (!list_empty (&cp->bufctl.free_buff_list)) { | |
1042 | /* yes: get the entry */ | |
1043 | struct list_head *tmp = cp->bufctl.free_buff_list.next; | |
1044 | list_del (tmp); | |
1045 | bp = list_entry (tmp, auerbuf_t, buff_list); | |
1046 | } | |
1047 | spin_unlock_irqrestore (&cp->bufctl.lock, flags); | |
1048 | ||
1049 | /* if no buffer available: skip it */ | |
1050 | if (!bp) { | |
1051 | dbg ("auerswald_int_complete: no data buffer available"); | |
1052 | /* can we do something more? | |
1053 | This is a big problem: if this int packet is ignored, the | |
1054 | device will wait forever and not signal any more data. | |
1055 | The only real solution is: having enough buffers! | |
1056 | Or perhaps temporary disabling the int endpoint? | |
1057 | */ | |
1058 | goto exit; | |
1059 | } | |
1060 | ||
1061 | /* fill the control message */ | |
1062 | bp->dr->bRequestType = AUT_RREQ; | |
1063 | bp->dr->bRequest = AUV_RBLOCK; | |
1064 | bp->dr->wValue = cpu_to_le16 (0); | |
1065 | bp->dr->wIndex = cpu_to_le16 (channelid | AUH_DIRECT | AUH_UNSPLIT); | |
1066 | bp->dr->wLength = cpu_to_le16 (bytecount); | |
1067 | usb_fill_control_urb (bp->urbp, cp->usbdev, usb_rcvctrlpipe (cp->usbdev, 0), | |
1068 | (unsigned char*)bp->dr, bp->bufp, bytecount, | |
1069 | auerswald_ctrlread_complete,bp); | |
1070 | ||
1071 | /* submit the control msg */ | |
1072 | ret = auerchain_submit_urb (&cp->controlchain, bp->urbp); | |
1073 | if (ret) { | |
1074 | dbg ("auerswald_int_complete: nonzero result of auerchain_submit_urb %d", ret); | |
1075 | bp->urbp->status = ret; | |
7d12e780 | 1076 | auerswald_ctrlread_complete( bp->urbp); |
1da177e4 LT |
1077 | /* here applies the same problem as above: device locking! */ |
1078 | } | |
1079 | exit: | |
1080 | ret = usb_submit_urb (urb, GFP_ATOMIC); | |
1081 | if (ret) | |
1082 | err ("%s - usb_submit_urb failed with result %d", | |
1083 | __FUNCTION__, ret); | |
1084 | } | |
1085 | ||
1086 | /* int memory deallocation | |
1087 | NOTE: no mutex please! | |
1088 | */ | |
1089 | static void auerswald_int_free (pauerswald_t cp) | |
1090 | { | |
1bc3c9e1 JJ |
1091 | if (cp->inturbp) { |
1092 | usb_free_urb(cp->inturbp); | |
1093 | cp->inturbp = NULL; | |
1094 | } | |
1095 | kfree(cp->intbufp); | |
1096 | cp->intbufp = NULL; | |
1da177e4 LT |
1097 | } |
1098 | ||
1099 | /* This function is called to activate the interrupt | |
1100 | endpoint. This function returns 0 if successful or an error code. | |
1101 | NOTE: no mutex please! | |
1102 | */ | |
1103 | static int auerswald_int_open (pauerswald_t cp) | |
1104 | { | |
1105 | int ret; | |
1106 | struct usb_host_endpoint *ep; | |
1107 | int irqsize; | |
1108 | dbg ("auerswald_int_open"); | |
1109 | ||
1110 | ep = cp->usbdev->ep_in[AU_IRQENDP]; | |
1111 | if (!ep) { | |
1112 | ret = -EFAULT; | |
1113 | goto intoend; | |
1114 | } | |
1115 | irqsize = le16_to_cpu(ep->desc.wMaxPacketSize); | |
1116 | cp->irqsize = irqsize; | |
1117 | ||
1118 | /* allocate the urb and data buffer */ | |
1119 | if (!cp->inturbp) { | |
1120 | cp->inturbp = usb_alloc_urb (0, GFP_KERNEL); | |
1121 | if (!cp->inturbp) { | |
1122 | ret = -ENOMEM; | |
1123 | goto intoend; | |
1124 | } | |
1125 | } | |
1126 | if (!cp->intbufp) { | |
0e8eb0f0 | 1127 | cp->intbufp = kmalloc (irqsize, GFP_KERNEL); |
1da177e4 LT |
1128 | if (!cp->intbufp) { |
1129 | ret = -ENOMEM; | |
1130 | goto intoend; | |
1131 | } | |
1132 | } | |
1133 | /* setup urb */ | |
1134 | usb_fill_int_urb (cp->inturbp, cp->usbdev, | |
1135 | usb_rcvintpipe (cp->usbdev,AU_IRQENDP), cp->intbufp, | |
1136 | irqsize, auerswald_int_complete, cp, ep->desc.bInterval); | |
1137 | /* start the urb */ | |
1138 | cp->inturbp->status = 0; /* needed! */ | |
1139 | ret = usb_submit_urb (cp->inturbp, GFP_KERNEL); | |
1140 | ||
1141 | intoend: | |
1142 | if (ret < 0) { | |
1143 | /* activation of interrupt endpoint has failed. Now clean up. */ | |
1144 | dbg ("auerswald_int_open: activation of int endpoint failed"); | |
1145 | ||
1146 | /* deallocate memory */ | |
1147 | auerswald_int_free (cp); | |
1148 | } | |
1149 | return ret; | |
1150 | } | |
1151 | ||
1152 | /* This function is called to deactivate the interrupt | |
1153 | endpoint. This function returns 0 if successful or an error code. | |
1154 | NOTE: no mutex please! | |
1155 | */ | |
1156 | static void auerswald_int_release (pauerswald_t cp) | |
1157 | { | |
1158 | dbg ("auerswald_int_release"); | |
1159 | ||
1160 | /* stop the int endpoint */ | |
2891a51c | 1161 | usb_kill_urb (cp->inturbp); |
1da177e4 LT |
1162 | |
1163 | /* deallocate memory */ | |
1164 | auerswald_int_free (cp); | |
1165 | } | |
1166 | ||
1167 | /* --------------------------------------------------------------------- */ | |
1168 | /* Helper functions */ | |
1169 | ||
1170 | /* wake up waiting readers */ | |
1171 | static void auerchar_disconnect (pauerscon_t scp) | |
1172 | { | |
1173 | pauerchar_t ccp = ((pauerchar_t)((char *)(scp)-(unsigned long)(&((pauerchar_t)0)->scontext))); | |
1174 | dbg ("auerchar_disconnect called"); | |
1175 | ccp->removed = 1; | |
1176 | wake_up (&ccp->readwait); | |
1177 | } | |
1178 | ||
1179 | ||
1180 | /* dispatch a read paket to a waiting character device */ | |
1181 | static void auerchar_ctrlread_dispatch (pauerscon_t scp, pauerbuf_t bp) | |
1182 | { | |
1183 | unsigned long flags; | |
1184 | pauerchar_t ccp; | |
1185 | pauerbuf_t newbp = NULL; | |
1186 | char * charp; | |
1187 | dbg ("auerchar_ctrlread_dispatch called"); | |
1188 | ccp = ((pauerchar_t)((char *)(scp)-(unsigned long)(&((pauerchar_t)0)->scontext))); | |
1189 | ||
1190 | /* get a read buffer from character device context */ | |
1191 | spin_lock_irqsave (&ccp->bufctl.lock, flags); | |
1192 | if (!list_empty (&ccp->bufctl.free_buff_list)) { | |
1193 | /* yes: get the entry */ | |
1194 | struct list_head *tmp = ccp->bufctl.free_buff_list.next; | |
1195 | list_del (tmp); | |
1196 | newbp = list_entry (tmp, auerbuf_t, buff_list); | |
1197 | } | |
1198 | spin_unlock_irqrestore (&ccp->bufctl.lock, flags); | |
1199 | ||
1200 | if (!newbp) { | |
1201 | dbg ("No read buffer available, discard paket!"); | |
1202 | return; /* no buffer, no dispatch */ | |
1203 | } | |
1204 | ||
1205 | /* copy information to new buffer element | |
1206 | (all buffers have the same length) */ | |
1207 | charp = newbp->bufp; | |
1208 | newbp->bufp = bp->bufp; | |
1209 | bp->bufp = charp; | |
1210 | newbp->len = bp->len; | |
1211 | ||
1212 | /* insert new buffer in read list */ | |
1213 | spin_lock_irqsave (&ccp->bufctl.lock, flags); | |
1214 | list_add_tail (&newbp->buff_list, &ccp->bufctl.rec_buff_list); | |
1215 | spin_unlock_irqrestore (&ccp->bufctl.lock, flags); | |
1216 | dbg ("read buffer appended to rec_list"); | |
1217 | ||
1218 | /* wake up pending synchronous reads */ | |
1219 | wake_up (&ccp->readwait); | |
1220 | } | |
1221 | ||
1222 | ||
1223 | /* Delete an auerswald driver context */ | |
1224 | static void auerswald_delete( pauerswald_t cp) | |
1225 | { | |
1226 | dbg( "auerswald_delete"); | |
1227 | if (cp == NULL) | |
1228 | return; | |
1229 | ||
1230 | /* Wake up all processes waiting for a buffer */ | |
1231 | wake_up (&cp->bufferwait); | |
1232 | ||
1233 | /* Cleaning up */ | |
1234 | auerswald_int_release (cp); | |
1235 | auerchain_free (&cp->controlchain); | |
1236 | auerbuf_free_buffers (&cp->bufctl); | |
1237 | ||
1238 | /* release the memory */ | |
1239 | kfree( cp); | |
1240 | } | |
1241 | ||
1242 | ||
1243 | /* Delete an auerswald character context */ | |
1244 | static void auerchar_delete( pauerchar_t ccp) | |
1245 | { | |
1246 | dbg ("auerchar_delete"); | |
1247 | if (ccp == NULL) | |
1248 | return; | |
1249 | ||
1250 | /* wake up pending synchronous reads */ | |
1251 | ccp->removed = 1; | |
1252 | wake_up (&ccp->readwait); | |
1253 | ||
1254 | /* remove the read buffer */ | |
1255 | if (ccp->readbuf) { | |
1256 | auerbuf_releasebuf (ccp->readbuf); | |
1257 | ccp->readbuf = NULL; | |
1258 | } | |
1259 | ||
1260 | /* remove the character buffers */ | |
1261 | auerbuf_free_buffers (&ccp->bufctl); | |
1262 | ||
1263 | /* release the memory */ | |
1264 | kfree( ccp); | |
1265 | } | |
1266 | ||
1267 | ||
1268 | /* add a new service to the device | |
1269 | scp->id must be set! | |
1270 | return: 0 if OK, else error code | |
1271 | */ | |
1272 | static int auerswald_addservice (pauerswald_t cp, pauerscon_t scp) | |
1273 | { | |
1274 | int ret; | |
1275 | ||
1276 | /* is the device available? */ | |
1277 | if (!cp->usbdev) { | |
1278 | dbg ("usbdev == NULL"); | |
1279 | return -EIO; /*no: can not add a service, sorry*/ | |
1280 | } | |
1281 | ||
1282 | /* is the service available? */ | |
1283 | if (cp->services[scp->id]) { | |
1284 | dbg ("service is busy"); | |
1285 | return -EBUSY; | |
1286 | } | |
1287 | ||
1288 | /* device is available, service is free */ | |
1289 | cp->services[scp->id] = scp; | |
1290 | ||
1291 | /* register service in device */ | |
1292 | ret = auerchain_control_msg( | |
1293 | &cp->controlchain, /* pointer to control chain */ | |
1294 | cp->usbdev, /* pointer to device */ | |
1295 | usb_sndctrlpipe (cp->usbdev, 0), /* pipe to control endpoint */ | |
1296 | AUV_CHANNELCTL, /* USB message request value */ | |
1297 | AUT_WREQ, /* USB message request type value */ | |
1298 | 0x01, /* open USB message value */ | |
1299 | scp->id, /* USB message index value */ | |
1300 | NULL, /* pointer to the data to send */ | |
1301 | 0, /* length in bytes of the data to send */ | |
1302 | HZ * 2); /* time to wait for the message to complete before timing out */ | |
1303 | if (ret < 0) { | |
1304 | dbg ("auerswald_addservice: auerchain_control_msg returned error code %d", ret); | |
1305 | /* undo above actions */ | |
1306 | cp->services[scp->id] = NULL; | |
1307 | return ret; | |
1308 | } | |
1309 | ||
1310 | dbg ("auerswald_addservice: channel open OK"); | |
1311 | return 0; | |
1312 | } | |
1313 | ||
1314 | ||
59c51591 | 1315 | /* remove a service from the device |
1da177e4 LT |
1316 | scp->id must be set! */ |
1317 | static void auerswald_removeservice (pauerswald_t cp, pauerscon_t scp) | |
1318 | { | |
1319 | dbg ("auerswald_removeservice called"); | |
1320 | ||
1321 | /* check if we have a service allocated */ | |
1322 | if (scp->id == AUH_UNASSIGNED) | |
1323 | return; | |
1324 | ||
1325 | /* If there is a device: close the channel */ | |
1326 | if (cp->usbdev) { | |
1327 | /* Close the service channel inside the device */ | |
1328 | int ret = auerchain_control_msg( | |
1329 | &cp->controlchain, /* pointer to control chain */ | |
1330 | cp->usbdev, /* pointer to device */ | |
1331 | usb_sndctrlpipe (cp->usbdev, 0), /* pipe to control endpoint */ | |
1332 | AUV_CHANNELCTL, /* USB message request value */ | |
1333 | AUT_WREQ, /* USB message request type value */ | |
1334 | 0x00, // close /* USB message value */ | |
1335 | scp->id, /* USB message index value */ | |
1336 | NULL, /* pointer to the data to send */ | |
1337 | 0, /* length in bytes of the data to send */ | |
1338 | HZ * 2); /* time to wait for the message to complete before timing out */ | |
1339 | if (ret < 0) { | |
1340 | dbg ("auerswald_removeservice: auerchain_control_msg returned error code %d", ret); | |
1341 | } | |
1342 | else { | |
1343 | dbg ("auerswald_removeservice: channel close OK"); | |
1344 | } | |
1345 | } | |
1346 | ||
1347 | /* remove the service from the device */ | |
1348 | cp->services[scp->id] = NULL; | |
1349 | scp->id = AUH_UNASSIGNED; | |
1350 | } | |
1351 | ||
1352 | ||
1353 | /* --------------------------------------------------------------------- */ | |
1354 | /* Char device functions */ | |
1355 | ||
1356 | /* Open a new character device */ | |
1357 | static int auerchar_open (struct inode *inode, struct file *file) | |
1358 | { | |
1359 | int dtindex = iminor(inode); | |
1360 | pauerswald_t cp = NULL; | |
1361 | pauerchar_t ccp = NULL; | |
1362 | struct usb_interface *intf; | |
1363 | int ret; | |
1364 | ||
1365 | /* minor number in range? */ | |
1366 | if (dtindex < 0) { | |
1367 | return -ENODEV; | |
1368 | } | |
1369 | intf = usb_find_interface(&auerswald_driver, dtindex); | |
1370 | if (!intf) { | |
1371 | return -ENODEV; | |
1372 | } | |
1373 | ||
1374 | /* usb device available? */ | |
1375 | cp = usb_get_intfdata (intf); | |
1376 | if (cp == NULL) { | |
1377 | return -ENODEV; | |
1378 | } | |
1379 | if (down_interruptible (&cp->mutex)) { | |
1380 | return -ERESTARTSYS; | |
1381 | } | |
1382 | ||
1383 | /* we have access to the device. Now lets allocate memory */ | |
66eb2e93 | 1384 | ccp = kzalloc(sizeof(auerchar_t), GFP_KERNEL); |
1da177e4 LT |
1385 | if (ccp == NULL) { |
1386 | err ("out of memory"); | |
1387 | ret = -ENOMEM; | |
1388 | goto ofail; | |
1389 | } | |
1390 | ||
1391 | /* Initialize device descriptor */ | |
1da177e4 LT |
1392 | init_MUTEX( &ccp->mutex); |
1393 | init_MUTEX( &ccp->readmutex); | |
1394 | auerbuf_init (&ccp->bufctl); | |
1395 | ccp->scontext.id = AUH_UNASSIGNED; | |
1396 | ccp->scontext.dispatch = auerchar_ctrlread_dispatch; | |
1397 | ccp->scontext.disconnect = auerchar_disconnect; | |
1398 | init_waitqueue_head (&ccp->readwait); | |
1399 | ||
1400 | ret = auerbuf_setup (&ccp->bufctl, AU_RBUFFERS, cp->maxControlLength+AUH_SIZE); | |
1401 | if (ret) { | |
1402 | goto ofail; | |
1403 | } | |
1404 | ||
1405 | cp->open_count++; | |
1406 | ccp->auerdev = cp; | |
1407 | dbg("open %s as /dev/%s", cp->dev_desc, cp->name); | |
1408 | up (&cp->mutex); | |
1409 | ||
1410 | /* file IO stuff */ | |
1411 | file->f_pos = 0; | |
1412 | file->private_data = ccp; | |
1413 | return nonseekable_open(inode, file); | |
1414 | ||
1415 | /* Error exit */ | |
1416 | ofail: up (&cp->mutex); | |
1417 | auerchar_delete (ccp); | |
1418 | return ret; | |
1419 | } | |
1420 | ||
1421 | ||
1422 | /* IOCTL functions */ | |
1423 | static int auerchar_ioctl (struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg) | |
1424 | { | |
1425 | pauerchar_t ccp = (pauerchar_t) file->private_data; | |
1426 | int ret = 0; | |
1427 | audevinfo_t devinfo; | |
1428 | pauerswald_t cp = NULL; | |
1429 | unsigned int u; | |
1430 | unsigned int __user *user_arg = (unsigned int __user *)arg; | |
1431 | ||
1432 | dbg ("ioctl"); | |
1433 | ||
1434 | /* get the mutexes */ | |
1435 | if (down_interruptible (&ccp->mutex)) { | |
1436 | return -ERESTARTSYS; | |
1437 | } | |
1438 | cp = ccp->auerdev; | |
1439 | if (!cp) { | |
1440 | up (&ccp->mutex); | |
1441 | return -ENODEV; | |
1442 | } | |
1443 | if (down_interruptible (&cp->mutex)) { | |
1444 | up(&ccp->mutex); | |
1445 | return -ERESTARTSYS; | |
1446 | } | |
1447 | ||
1448 | /* Check for removal */ | |
1449 | if (!cp->usbdev) { | |
1450 | up(&cp->mutex); | |
1451 | up(&ccp->mutex); | |
1452 | return -ENODEV; | |
1453 | } | |
1454 | ||
1455 | switch (cmd) { | |
1456 | ||
1457 | /* return != 0 if Transmitt channel ready to send */ | |
1458 | case IOCTL_AU_TXREADY: | |
1459 | dbg ("IOCTL_AU_TXREADY"); | |
1460 | u = ccp->auerdev | |
1461 | && (ccp->scontext.id != AUH_UNASSIGNED) | |
1462 | && !list_empty (&cp->bufctl.free_buff_list); | |
1463 | ret = put_user (u, user_arg); | |
1464 | break; | |
1465 | ||
1466 | /* return != 0 if connected to a service channel */ | |
1467 | case IOCTL_AU_CONNECT: | |
1468 | dbg ("IOCTL_AU_CONNECT"); | |
1469 | u = (ccp->scontext.id != AUH_UNASSIGNED); | |
1470 | ret = put_user (u, user_arg); | |
1471 | break; | |
1472 | ||
1473 | /* return != 0 if Receive Data available */ | |
1474 | case IOCTL_AU_RXAVAIL: | |
1475 | dbg ("IOCTL_AU_RXAVAIL"); | |
1476 | if (ccp->scontext.id == AUH_UNASSIGNED) { | |
1477 | ret = -EIO; | |
1478 | break; | |
1479 | } | |
1480 | u = 0; /* no data */ | |
1481 | if (ccp->readbuf) { | |
1482 | int restlen = ccp->readbuf->len - ccp->readoffset; | |
1483 | if (restlen > 0) | |
1484 | u = 1; | |
1485 | } | |
1486 | if (!u) { | |
1487 | if (!list_empty (&ccp->bufctl.rec_buff_list)) { | |
1488 | u = 1; | |
1489 | } | |
1490 | } | |
1491 | ret = put_user (u, user_arg); | |
1492 | break; | |
1493 | ||
1494 | /* return the max. buffer length for the device */ | |
1495 | case IOCTL_AU_BUFLEN: | |
1496 | dbg ("IOCTL_AU_BUFLEN"); | |
1497 | u = cp->maxControlLength; | |
1498 | ret = put_user (u, user_arg); | |
1499 | break; | |
1500 | ||
1501 | /* requesting a service channel */ | |
1502 | case IOCTL_AU_SERVREQ: | |
1503 | dbg ("IOCTL_AU_SERVREQ"); | |
1504 | /* requesting a service means: release the previous one first */ | |
1505 | auerswald_removeservice (cp, &ccp->scontext); | |
1506 | /* get the channel number */ | |
1507 | ret = get_user (u, user_arg); | |
1508 | if (ret) { | |
1509 | break; | |
1510 | } | |
1511 | if ((u < AUH_FIRSTUSERCH) || (u >= AUH_TYPESIZE)) { | |
1512 | ret = -EIO; | |
1513 | break; | |
1514 | } | |
1515 | dbg ("auerchar service request parameters are ok"); | |
1516 | ccp->scontext.id = u; | |
1517 | ||
1518 | /* request the service now */ | |
1519 | ret = auerswald_addservice (cp, &ccp->scontext); | |
1520 | if (ret) { | |
1521 | /* no: revert service entry */ | |
1522 | ccp->scontext.id = AUH_UNASSIGNED; | |
1523 | } | |
1524 | break; | |
1525 | ||
1526 | /* get a string descriptor for the device */ | |
1527 | case IOCTL_AU_DEVINFO: | |
1528 | dbg ("IOCTL_AU_DEVINFO"); | |
1529 | if (copy_from_user (&devinfo, (void __user *) arg, sizeof (audevinfo_t))) { | |
1530 | ret = -EFAULT; | |
1531 | break; | |
1532 | } | |
1533 | u = strlen(cp->dev_desc)+1; | |
1534 | if (u > devinfo.bsize) { | |
1535 | u = devinfo.bsize; | |
1536 | } | |
1537 | ret = copy_to_user(devinfo.buf, cp->dev_desc, u) ? -EFAULT : 0; | |
1538 | break; | |
1539 | ||
1540 | /* get the max. string descriptor length */ | |
1541 | case IOCTL_AU_SLEN: | |
1542 | dbg ("IOCTL_AU_SLEN"); | |
1543 | u = AUSI_DLEN; | |
1544 | ret = put_user (u, user_arg); | |
1545 | break; | |
1546 | ||
1547 | default: | |
1548 | dbg ("IOCTL_AU_UNKNOWN"); | |
1549 | ret = -ENOIOCTLCMD; | |
1550 | break; | |
1551 | } | |
1552 | /* release the mutexes */ | |
1553 | up(&cp->mutex); | |
1554 | up(&ccp->mutex); | |
1555 | return ret; | |
1556 | } | |
1557 | ||
1558 | /* Read data from the device */ | |
1559 | static ssize_t auerchar_read (struct file *file, char __user *buf, size_t count, loff_t * ppos) | |
1560 | { | |
1561 | unsigned long flags; | |
1562 | pauerchar_t ccp = (pauerchar_t) file->private_data; | |
1563 | pauerbuf_t bp = NULL; | |
1564 | wait_queue_t wait; | |
1565 | ||
1566 | dbg ("auerchar_read"); | |
1567 | ||
1568 | /* Error checking */ | |
1569 | if (!ccp) | |
1570 | return -EIO; | |
1571 | if (*ppos) | |
1572 | return -ESPIPE; | |
1573 | if (count == 0) | |
1574 | return 0; | |
1575 | ||
1576 | /* get the mutex */ | |
1577 | if (down_interruptible (&ccp->mutex)) | |
1578 | return -ERESTARTSYS; | |
1579 | ||
1580 | /* Can we expect to read something? */ | |
1581 | if (ccp->scontext.id == AUH_UNASSIGNED) { | |
1582 | up (&ccp->mutex); | |
1583 | return -EIO; | |
1584 | } | |
1585 | ||
1586 | /* only one reader per device allowed */ | |
1587 | if (down_interruptible (&ccp->readmutex)) { | |
1588 | up (&ccp->mutex); | |
1589 | return -ERESTARTSYS; | |
1590 | } | |
1591 | ||
1592 | /* read data from readbuf, if available */ | |
1593 | doreadbuf: | |
1594 | bp = ccp->readbuf; | |
1595 | if (bp) { | |
1596 | /* read the maximum bytes */ | |
1597 | int restlen = bp->len - ccp->readoffset; | |
1598 | if (restlen < 0) | |
1599 | restlen = 0; | |
1600 | if (count > restlen) | |
1601 | count = restlen; | |
1602 | if (count) { | |
1603 | if (copy_to_user (buf, bp->bufp+ccp->readoffset, count)) { | |
1604 | dbg ("auerswald_read: copy_to_user failed"); | |
1605 | up (&ccp->readmutex); | |
1606 | up (&ccp->mutex); | |
1607 | return -EFAULT; | |
1608 | } | |
1609 | } | |
1610 | /* advance the read offset */ | |
1611 | ccp->readoffset += count; | |
1612 | restlen -= count; | |
1613 | // reuse the read buffer | |
1614 | if (restlen <= 0) { | |
1615 | auerbuf_releasebuf (bp); | |
1616 | ccp->readbuf = NULL; | |
1617 | } | |
1618 | /* return with number of bytes read */ | |
1619 | if (count) { | |
1620 | up (&ccp->readmutex); | |
1621 | up (&ccp->mutex); | |
1622 | return count; | |
1623 | } | |
1624 | } | |
1625 | ||
1626 | /* a read buffer is not available. Try to get the next data block. */ | |
1627 | doreadlist: | |
1628 | /* Preparing for sleep */ | |
1629 | init_waitqueue_entry (&wait, current); | |
1630 | set_current_state (TASK_INTERRUPTIBLE); | |
1631 | add_wait_queue (&ccp->readwait, &wait); | |
1632 | ||
1633 | bp = NULL; | |
1634 | spin_lock_irqsave (&ccp->bufctl.lock, flags); | |
1635 | if (!list_empty (&ccp->bufctl.rec_buff_list)) { | |
1636 | /* yes: get the entry */ | |
1637 | struct list_head *tmp = ccp->bufctl.rec_buff_list.next; | |
1638 | list_del (tmp); | |
1639 | bp = list_entry (tmp, auerbuf_t, buff_list); | |
1640 | } | |
1641 | spin_unlock_irqrestore (&ccp->bufctl.lock, flags); | |
1642 | ||
1643 | /* have we got data? */ | |
1644 | if (bp) { | |
1645 | ccp->readbuf = bp; | |
1646 | ccp->readoffset = AUH_SIZE; /* for headerbyte */ | |
1647 | set_current_state (TASK_RUNNING); | |
1648 | remove_wait_queue (&ccp->readwait, &wait); | |
1649 | goto doreadbuf; /* now we can read! */ | |
1650 | } | |
1651 | ||
1652 | /* no data available. Should we wait? */ | |
1653 | if (file->f_flags & O_NONBLOCK) { | |
1654 | dbg ("No read buffer available, returning -EAGAIN"); | |
1655 | set_current_state (TASK_RUNNING); | |
1656 | remove_wait_queue (&ccp->readwait, &wait); | |
1657 | up (&ccp->readmutex); | |
1658 | up (&ccp->mutex); | |
1659 | return -EAGAIN; /* nonblocking, no data available */ | |
1660 | } | |
1661 | ||
1662 | /* yes, we should wait! */ | |
1663 | up (&ccp->mutex); /* allow other operations while we wait */ | |
1664 | schedule(); | |
1665 | remove_wait_queue (&ccp->readwait, &wait); | |
1666 | if (signal_pending (current)) { | |
1667 | /* waked up by a signal */ | |
1668 | up (&ccp->readmutex); | |
1669 | return -ERESTARTSYS; | |
1670 | } | |
1671 | ||
1672 | /* Anything left to read? */ | |
1673 | if ((ccp->scontext.id == AUH_UNASSIGNED) || ccp->removed) { | |
1674 | up (&ccp->readmutex); | |
1675 | return -EIO; | |
1676 | } | |
1677 | ||
1678 | if (down_interruptible (&ccp->mutex)) { | |
1679 | up (&ccp->readmutex); | |
1680 | return -ERESTARTSYS; | |
1681 | } | |
1682 | ||
1683 | /* try to read the incoming data again */ | |
1684 | goto doreadlist; | |
1685 | } | |
1686 | ||
1687 | ||
1688 | /* Write a data block into the right service channel of the device */ | |
1689 | static ssize_t auerchar_write (struct file *file, const char __user *buf, size_t len, loff_t *ppos) | |
1690 | { | |
1691 | pauerchar_t ccp = (pauerchar_t) file->private_data; | |
1692 | pauerswald_t cp = NULL; | |
1693 | pauerbuf_t bp; | |
1694 | unsigned long flags; | |
1695 | int ret; | |
1696 | wait_queue_t wait; | |
1697 | ||
53b3de1e | 1698 | dbg ("auerchar_write %zd bytes", len); |
1da177e4 LT |
1699 | |
1700 | /* Error checking */ | |
1701 | if (!ccp) | |
1702 | return -EIO; | |
1703 | if (*ppos) | |
1704 | return -ESPIPE; | |
1705 | if (len == 0) | |
1706 | return 0; | |
1707 | ||
1708 | write_again: | |
1709 | /* get the mutex */ | |
1710 | if (down_interruptible (&ccp->mutex)) | |
1711 | return -ERESTARTSYS; | |
1712 | ||
1713 | /* Can we expect to write something? */ | |
1714 | if (ccp->scontext.id == AUH_UNASSIGNED) { | |
1715 | up (&ccp->mutex); | |
1716 | return -EIO; | |
1717 | } | |
1718 | ||
1719 | cp = ccp->auerdev; | |
1720 | if (!cp) { | |
1721 | up (&ccp->mutex); | |
1722 | return -ERESTARTSYS; | |
1723 | } | |
1724 | if (down_interruptible (&cp->mutex)) { | |
1725 | up (&ccp->mutex); | |
1726 | return -ERESTARTSYS; | |
1727 | } | |
1728 | if (!cp->usbdev) { | |
1729 | up (&cp->mutex); | |
1730 | up (&ccp->mutex); | |
1731 | return -EIO; | |
1732 | } | |
1733 | /* Prepare for sleep */ | |
1734 | init_waitqueue_entry (&wait, current); | |
1735 | set_current_state (TASK_INTERRUPTIBLE); | |
1736 | add_wait_queue (&cp->bufferwait, &wait); | |
1737 | ||
1738 | /* Try to get a buffer from the device pool. | |
1739 | We can't use a buffer from ccp->bufctl because the write | |
1740 | command will last beond a release() */ | |
1741 | bp = NULL; | |
1742 | spin_lock_irqsave (&cp->bufctl.lock, flags); | |
1743 | if (!list_empty (&cp->bufctl.free_buff_list)) { | |
1744 | /* yes: get the entry */ | |
1745 | struct list_head *tmp = cp->bufctl.free_buff_list.next; | |
1746 | list_del (tmp); | |
1747 | bp = list_entry (tmp, auerbuf_t, buff_list); | |
1748 | } | |
1749 | spin_unlock_irqrestore (&cp->bufctl.lock, flags); | |
1750 | ||
1751 | /* are there any buffers left? */ | |
1752 | if (!bp) { | |
1753 | up (&cp->mutex); | |
1754 | up (&ccp->mutex); | |
1755 | ||
1756 | /* NONBLOCK: don't wait */ | |
1757 | if (file->f_flags & O_NONBLOCK) { | |
1758 | set_current_state (TASK_RUNNING); | |
1759 | remove_wait_queue (&cp->bufferwait, &wait); | |
1760 | return -EAGAIN; | |
1761 | } | |
1762 | ||
1763 | /* BLOCKING: wait */ | |
1764 | schedule(); | |
1765 | remove_wait_queue (&cp->bufferwait, &wait); | |
1766 | if (signal_pending (current)) { | |
1767 | /* waked up by a signal */ | |
1768 | return -ERESTARTSYS; | |
1769 | } | |
1770 | goto write_again; | |
1771 | } else { | |
1772 | set_current_state (TASK_RUNNING); | |
1773 | remove_wait_queue (&cp->bufferwait, &wait); | |
1774 | } | |
1775 | ||
1776 | /* protect against too big write requests */ | |
1777 | if (len > cp->maxControlLength) | |
1778 | len = cp->maxControlLength; | |
1779 | ||
1780 | /* Fill the buffer */ | |
1781 | if (copy_from_user ( bp->bufp+AUH_SIZE, buf, len)) { | |
1782 | dbg ("copy_from_user failed"); | |
1783 | auerbuf_releasebuf (bp); | |
1784 | /* Wake up all processes waiting for a buffer */ | |
1785 | wake_up (&cp->bufferwait); | |
1786 | up (&cp->mutex); | |
1787 | up (&ccp->mutex); | |
1788 | return -EFAULT; | |
1789 | } | |
1790 | ||
1791 | /* set the header byte */ | |
1792 | *(bp->bufp) = ccp->scontext.id | AUH_DIRECT | AUH_UNSPLIT; | |
1793 | ||
1794 | /* Set the transfer Parameters */ | |
1795 | bp->len = len+AUH_SIZE; | |
1796 | bp->dr->bRequestType = AUT_WREQ; | |
1797 | bp->dr->bRequest = AUV_WBLOCK; | |
1798 | bp->dr->wValue = cpu_to_le16 (0); | |
1799 | bp->dr->wIndex = cpu_to_le16 (ccp->scontext.id | AUH_DIRECT | AUH_UNSPLIT); | |
1800 | bp->dr->wLength = cpu_to_le16 (len+AUH_SIZE); | |
1801 | usb_fill_control_urb (bp->urbp, cp->usbdev, usb_sndctrlpipe (cp->usbdev, 0), | |
1802 | (unsigned char*)bp->dr, bp->bufp, len+AUH_SIZE, | |
1803 | auerchar_ctrlwrite_complete, bp); | |
1804 | /* up we go */ | |
1805 | ret = auerchain_submit_urb (&cp->controlchain, bp->urbp); | |
1806 | up (&cp->mutex); | |
1807 | if (ret) { | |
1808 | dbg ("auerchar_write: nonzero result of auerchain_submit_urb %d", ret); | |
1809 | auerbuf_releasebuf (bp); | |
1810 | /* Wake up all processes waiting for a buffer */ | |
1811 | wake_up (&cp->bufferwait); | |
1812 | up (&ccp->mutex); | |
1813 | return -EIO; | |
1814 | } | |
1815 | else { | |
1816 | dbg ("auerchar_write: Write OK"); | |
1817 | up (&ccp->mutex); | |
1818 | return len; | |
1819 | } | |
1820 | } | |
1821 | ||
1822 | ||
1823 | /* Close a character device */ | |
1824 | static int auerchar_release (struct inode *inode, struct file *file) | |
1825 | { | |
1826 | pauerchar_t ccp = (pauerchar_t) file->private_data; | |
1827 | pauerswald_t cp; | |
1828 | dbg("release"); | |
1829 | ||
be23edf8 | 1830 | down(&ccp->mutex); |
1da177e4 LT |
1831 | cp = ccp->auerdev; |
1832 | if (cp) { | |
be23edf8 | 1833 | down(&cp->mutex); |
1da177e4 LT |
1834 | /* remove an open service */ |
1835 | auerswald_removeservice (cp, &ccp->scontext); | |
1836 | /* detach from device */ | |
1837 | if ((--cp->open_count <= 0) && (cp->usbdev == NULL)) { | |
1838 | /* usb device waits for removal */ | |
1839 | up (&cp->mutex); | |
1840 | auerswald_delete (cp); | |
1841 | } else { | |
1842 | up (&cp->mutex); | |
1843 | } | |
1844 | cp = NULL; | |
1845 | ccp->auerdev = NULL; | |
1846 | } | |
1847 | up (&ccp->mutex); | |
1848 | auerchar_delete (ccp); | |
1849 | ||
1850 | return 0; | |
1851 | } | |
1852 | ||
1853 | ||
1854 | /*----------------------------------------------------------------------*/ | |
1855 | /* File operation structure */ | |
066202dd | 1856 | static const struct file_operations auerswald_fops = |
1da177e4 LT |
1857 | { |
1858 | .owner = THIS_MODULE, | |
1859 | .llseek = no_llseek, | |
1860 | .read = auerchar_read, | |
1861 | .write = auerchar_write, | |
1862 | .ioctl = auerchar_ioctl, | |
1863 | .open = auerchar_open, | |
1864 | .release = auerchar_release, | |
1865 | }; | |
1866 | ||
1867 | static struct usb_class_driver auerswald_class = { | |
d6e5bcf4 | 1868 | .name = "auer%d", |
1da177e4 | 1869 | .fops = &auerswald_fops, |
1da177e4 LT |
1870 | .minor_base = AUER_MINOR_BASE, |
1871 | }; | |
1872 | ||
1873 | ||
1874 | /* --------------------------------------------------------------------- */ | |
1875 | /* Special USB driver functions */ | |
1876 | ||
1877 | /* Probe if this driver wants to serve an USB device | |
1878 | ||
1879 | This entry point is called whenever a new device is attached to the bus. | |
1880 | Then the device driver has to create a new instance of its internal data | |
1881 | structures for the new device. | |
1882 | ||
1883 | The dev argument specifies the device context, which contains pointers | |
1884 | to all USB descriptors. The interface argument specifies the interface | |
1885 | number. If a USB driver wants to bind itself to a particular device and | |
1886 | interface it has to return a pointer. This pointer normally references | |
1887 | the device driver's context structure. | |
1888 | ||
1889 | Probing normally is done by checking the vendor and product identifications | |
1890 | or the class and subclass definitions. If they match the interface number | |
1891 | is compared with the ones supported by the driver. When probing is done | |
1892 | class based it might be necessary to parse some more USB descriptors because | |
1893 | the device properties can differ in a wide range. | |
1894 | */ | |
1895 | static int auerswald_probe (struct usb_interface *intf, | |
1896 | const struct usb_device_id *id) | |
1897 | { | |
1898 | struct usb_device *usbdev = interface_to_usbdev(intf); | |
1899 | pauerswald_t cp = NULL; | |
1900 | unsigned int u = 0; | |
1901 | __le16 *pbuf; | |
1902 | int ret; | |
1903 | ||
1904 | dbg ("probe: vendor id 0x%x, device id 0x%x", | |
1905 | le16_to_cpu(usbdev->descriptor.idVendor), | |
1906 | le16_to_cpu(usbdev->descriptor.idProduct)); | |
1907 | ||
1908 | /* we use only the first -and only- interface */ | |
1909 | if (intf->altsetting->desc.bInterfaceNumber != 0) | |
1910 | return -ENODEV; | |
1911 | ||
1912 | /* allocate memory for our device and initialize it */ | |
66eb2e93 | 1913 | cp = kzalloc (sizeof(auerswald_t), GFP_KERNEL); |
1da177e4 LT |
1914 | if (cp == NULL) { |
1915 | err ("out of memory"); | |
1916 | goto pfail; | |
1917 | } | |
1918 | ||
1919 | /* Initialize device descriptor */ | |
1da177e4 LT |
1920 | init_MUTEX (&cp->mutex); |
1921 | cp->usbdev = usbdev; | |
1922 | auerchain_init (&cp->controlchain); | |
1923 | auerbuf_init (&cp->bufctl); | |
1924 | init_waitqueue_head (&cp->bufferwait); | |
1925 | ||
1926 | ret = usb_register_dev(intf, &auerswald_class); | |
1927 | if (ret) { | |
1928 | err ("Not able to get a minor for this device."); | |
1929 | goto pfail; | |
1930 | } | |
1931 | ||
1932 | /* Give the device a name */ | |
1933 | sprintf (cp->name, "usb/auer%d", intf->minor); | |
1934 | ||
1935 | /* Store the index */ | |
1936 | cp->dtindex = intf->minor; | |
1937 | ||
1938 | /* Get the usb version of the device */ | |
1939 | cp->version = le16_to_cpu(cp->usbdev->descriptor.bcdDevice); | |
1940 | dbg ("Version is %X", cp->version); | |
1941 | ||
1942 | /* allow some time to settle the device */ | |
1943 | msleep(334); | |
1944 | ||
1945 | /* Try to get a suitable textual description of the device */ | |
1946 | /* Device name:*/ | |
1947 | ret = usb_string( cp->usbdev, AUSI_DEVICE, cp->dev_desc, AUSI_DLEN-1); | |
1948 | if (ret >= 0) { | |
1949 | u += ret; | |
1950 | /* Append Serial Number */ | |
1951 | memcpy(&cp->dev_desc[u], ",Ser# ", 6); | |
1952 | u += 6; | |
1953 | ret = usb_string( cp->usbdev, AUSI_SERIALNR, &cp->dev_desc[u], AUSI_DLEN-u-1); | |
1954 | if (ret >= 0) { | |
1955 | u += ret; | |
1956 | /* Append subscriber number */ | |
1957 | memcpy(&cp->dev_desc[u], ", ", 2); | |
1958 | u += 2; | |
1959 | ret = usb_string( cp->usbdev, AUSI_MSN, &cp->dev_desc[u], AUSI_DLEN-u-1); | |
1960 | if (ret >= 0) { | |
1961 | u += ret; | |
1962 | } | |
1963 | } | |
1964 | } | |
1965 | cp->dev_desc[u] = '\0'; | |
1966 | info("device is a %s", cp->dev_desc); | |
1967 | ||
1968 | /* get the maximum allowed control transfer length */ | |
5cbded58 | 1969 | pbuf = kmalloc(2, GFP_KERNEL); /* use an allocated buffer because of urb target */ |
1da177e4 LT |
1970 | if (!pbuf) { |
1971 | err( "out of memory"); | |
1972 | goto pfail; | |
1973 | } | |
1974 | ret = usb_control_msg(cp->usbdev, /* pointer to device */ | |
1975 | usb_rcvctrlpipe( cp->usbdev, 0 ), /* pipe to control endpoint */ | |
1976 | AUV_GETINFO, /* USB message request value */ | |
1977 | AUT_RREQ, /* USB message request type value */ | |
1978 | 0, /* USB message value */ | |
1979 | AUDI_MBCTRANS, /* USB message index value */ | |
1980 | pbuf, /* pointer to the receive buffer */ | |
1981 | 2, /* length of the buffer */ | |
1982 | 2000); /* time to wait for the message to complete before timing out */ | |
1983 | if (ret == 2) { | |
1984 | cp->maxControlLength = le16_to_cpup(pbuf); | |
1985 | kfree(pbuf); | |
1986 | dbg("setup: max. allowed control transfersize is %d bytes", cp->maxControlLength); | |
1987 | } else { | |
1988 | kfree(pbuf); | |
1989 | err("setup: getting max. allowed control transfer length failed with error %d", ret); | |
1990 | goto pfail; | |
1991 | } | |
1992 | ||
1993 | /* allocate a chain for the control messages */ | |
1994 | if (auerchain_setup (&cp->controlchain, AUCH_ELEMENTS)) { | |
1995 | err ("out of memory"); | |
1996 | goto pfail; | |
1997 | } | |
1998 | ||
1999 | /* allocate buffers for control messages */ | |
2000 | if (auerbuf_setup (&cp->bufctl, AU_RBUFFERS, cp->maxControlLength+AUH_SIZE)) { | |
2001 | err ("out of memory"); | |
2002 | goto pfail; | |
2003 | } | |
2004 | ||
2005 | /* start the interrupt endpoint */ | |
2006 | if (auerswald_int_open (cp)) { | |
2007 | err ("int endpoint failed"); | |
2008 | goto pfail; | |
2009 | } | |
2010 | ||
2011 | /* all OK */ | |
2012 | usb_set_intfdata (intf, cp); | |
2013 | return 0; | |
2014 | ||
2015 | /* Error exit: clean up the memory */ | |
2016 | pfail: auerswald_delete (cp); | |
2017 | return -EIO; | |
2018 | } | |
2019 | ||
2020 | ||
2021 | /* Disconnect driver from a served device | |
2022 | ||
2023 | This function is called whenever a device which was served by this driver | |
2024 | is disconnected. | |
2025 | ||
2026 | The argument dev specifies the device context and the driver_context | |
2027 | returns a pointer to the previously registered driver_context of the | |
2028 | probe function. After returning from the disconnect function the USB | |
2029 | framework completely deallocates all data structures associated with | |
2030 | this device. So especially the usb_device structure must not be used | |
2031 | any longer by the usb driver. | |
2032 | */ | |
2033 | static void auerswald_disconnect (struct usb_interface *intf) | |
2034 | { | |
2035 | pauerswald_t cp = usb_get_intfdata (intf); | |
2036 | unsigned int u; | |
2037 | ||
2038 | usb_set_intfdata (intf, NULL); | |
2039 | if (!cp) | |
2040 | return; | |
2041 | ||
1da177e4 LT |
2042 | /* give back our USB minor number */ |
2043 | usb_deregister_dev(intf, &auerswald_class); | |
2044 | ||
d4ead16f AS |
2045 | down (&cp->mutex); |
2046 | info ("device /dev/%s now disconnecting", cp->name); | |
2047 | ||
1da177e4 LT |
2048 | /* Stop the interrupt endpoint */ |
2049 | auerswald_int_release (cp); | |
2050 | ||
2051 | /* remove the control chain allocated in auerswald_probe | |
2052 | This has the benefit of | |
2053 | a) all pending (a)synchronous urbs are unlinked | |
2054 | b) all buffers dealing with urbs are reclaimed | |
2055 | */ | |
2056 | auerchain_free (&cp->controlchain); | |
2057 | ||
2058 | if (cp->open_count == 0) { | |
2059 | /* nobody is using this device. So we can clean up now */ | |
2060 | up (&cp->mutex);/* up() is possible here because no other task | |
2061 | can open the device (see above). I don't want | |
2062 | to kfree() a locked mutex. */ | |
2063 | auerswald_delete (cp); | |
2064 | } else { | |
2065 | /* device is used. Remove the pointer to the | |
2066 | usb device (it's not valid any more). The last | |
2067 | release() will do the clean up */ | |
2068 | cp->usbdev = NULL; | |
2069 | up (&cp->mutex); | |
2070 | /* Terminate waiting writers */ | |
2071 | wake_up (&cp->bufferwait); | |
2072 | /* Inform all waiting readers */ | |
2073 | for ( u = 0; u < AUH_TYPESIZE; u++) { | |
2074 | pauerscon_t scp = cp->services[u]; | |
2075 | if (scp) | |
2076 | scp->disconnect( scp); | |
2077 | } | |
2078 | } | |
2079 | } | |
2080 | ||
2081 | /* Descriptor for the devices which are served by this driver. | |
2082 | NOTE: this struct is parsed by the usbmanager install scripts. | |
2083 | Don't change without caution! | |
2084 | */ | |
2085 | static struct usb_device_id auerswald_ids [] = { | |
2086 | { USB_DEVICE (ID_AUERSWALD, 0x00C0) }, /* COMpact 2104 USB */ | |
2087 | { USB_DEVICE (ID_AUERSWALD, 0x00DB) }, /* COMpact 4410/2206 USB */ | |
885e7743 AM |
2088 | { USB_DEVICE (ID_AUERSWALD, 0x00DC) }, /* COMpact 4406 DSL */ |
2089 | { USB_DEVICE (ID_AUERSWALD, 0x00DD) }, /* COMpact 2204 USB */ | |
1da177e4 LT |
2090 | { USB_DEVICE (ID_AUERSWALD, 0x00F1) }, /* Comfort 2000 System Telephone */ |
2091 | { USB_DEVICE (ID_AUERSWALD, 0x00F2) }, /* Comfort 1200 System Telephone */ | |
2092 | { } /* Terminating entry */ | |
2093 | }; | |
2094 | ||
2095 | /* Standard module device table */ | |
2096 | MODULE_DEVICE_TABLE (usb, auerswald_ids); | |
2097 | ||
2098 | /* Standard usb driver struct */ | |
2099 | static struct usb_driver auerswald_driver = { | |
1da177e4 LT |
2100 | .name = "auerswald", |
2101 | .probe = auerswald_probe, | |
2102 | .disconnect = auerswald_disconnect, | |
2103 | .id_table = auerswald_ids, | |
2104 | }; | |
2105 | ||
2106 | ||
2107 | /* --------------------------------------------------------------------- */ | |
2108 | /* Module loading/unloading */ | |
2109 | ||
2110 | /* Driver initialisation. Called after module loading. | |
2111 | NOTE: there is no concurrency at _init | |
2112 | */ | |
2113 | static int __init auerswald_init (void) | |
2114 | { | |
2115 | int result; | |
2116 | dbg ("init"); | |
2117 | ||
2118 | /* register driver at the USB subsystem */ | |
2119 | result = usb_register (&auerswald_driver); | |
2120 | if (result < 0) { | |
2121 | err ("driver could not be registered"); | |
2122 | return -1; | |
2123 | } | |
2124 | return 0; | |
2125 | } | |
2126 | ||
2127 | /* Driver deinit. Called before module removal. | |
2128 | NOTE: there is no concurrency at _cleanup | |
2129 | */ | |
2130 | static void __exit auerswald_cleanup (void) | |
2131 | { | |
2132 | dbg ("cleanup"); | |
2133 | usb_deregister (&auerswald_driver); | |
2134 | } | |
2135 | ||
2136 | /* --------------------------------------------------------------------- */ | |
2137 | /* Linux device driver module description */ | |
2138 | ||
2139 | MODULE_AUTHOR (DRIVER_AUTHOR); | |
2140 | MODULE_DESCRIPTION (DRIVER_DESC); | |
2141 | MODULE_LICENSE ("GPL"); | |
2142 | ||
2143 | module_init (auerswald_init); | |
2144 | module_exit (auerswald_cleanup); | |
2145 | ||
2146 | /* --------------------------------------------------------------------- */ | |
2147 |