diff options
author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /sound/usb/usx2y/usbusx2yaudio.c |
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'sound/usb/usx2y/usbusx2yaudio.c')
-rw-r--r-- | sound/usb/usx2y/usbusx2yaudio.c | 1026 |
1 files changed, 1026 insertions, 0 deletions
diff --git a/sound/usb/usx2y/usbusx2yaudio.c b/sound/usb/usx2y/usbusx2yaudio.c new file mode 100644 index 000000000000..4c292e090069 --- /dev/null +++ b/sound/usb/usx2y/usbusx2yaudio.c | |||
@@ -0,0 +1,1026 @@ | |||
1 | /* | ||
2 | * US-X2Y AUDIO | ||
3 | * Copyright (c) 2002-2004 by Karsten Wiese | ||
4 | * | ||
5 | * based on | ||
6 | * | ||
7 | * (Tentative) USB Audio Driver for ALSA | ||
8 | * | ||
9 | * Main and PCM part | ||
10 | * | ||
11 | * Copyright (c) 2002 by Takashi Iwai <tiwai@suse.de> | ||
12 | * | ||
13 | * Many codes borrowed from audio.c by | ||
14 | * Alan Cox (alan@lxorguk.ukuu.org.uk) | ||
15 | * Thomas Sailer (sailer@ife.ee.ethz.ch) | ||
16 | * | ||
17 | * | ||
18 | * This program is free software; you can redistribute it and/or modify | ||
19 | * it under the terms of the GNU General Public License as published by | ||
20 | * the Free Software Foundation; either version 2 of the License, or | ||
21 | * (at your option) any later version. | ||
22 | * | ||
23 | * This program is distributed in the hope that it will be useful, | ||
24 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
25 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
26 | * GNU General Public License for more details. | ||
27 | * | ||
28 | * You should have received a copy of the GNU General Public License | ||
29 | * along with this program; if not, write to the Free Software | ||
30 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
31 | */ | ||
32 | |||
33 | |||
34 | #include <sound/driver.h> | ||
35 | #include <linux/interrupt.h> | ||
36 | #include <linux/usb.h> | ||
37 | #include <sound/core.h> | ||
38 | #include <sound/info.h> | ||
39 | #include <sound/pcm.h> | ||
40 | #include <sound/pcm_params.h> | ||
41 | #include "usx2y.h" | ||
42 | #include "usbusx2y.h" | ||
43 | |||
44 | #define USX2Y_NRPACKS 4 /* Default value used for nr of packs per urb. | ||
45 | 1 to 4 have been tested ok on uhci. | ||
46 | To use 3 on ohci, you'd need a patch: | ||
47 | look for "0000425-linux-2.6.9-rc4-mm1_ohci-hcd.patch.gz" on | ||
48 | "https://bugtrack.alsa-project.org/alsa-bug/bug_view_page.php?bug_id=0000425" | ||
49 | . | ||
50 | 1, 2 and 4 work out of the box on ohci, if I recall correctly. | ||
51 | Bigger is safer operation, | ||
52 | smaller gives lower latencies. | ||
53 | */ | ||
54 | #define USX2Y_NRPACKS_VARIABLE y /* If your system works ok with this module's parameter | ||
55 | nrpacks set to 1, you might as well comment | ||
56 | this #define out, and thereby produce smaller, faster code. | ||
57 | You'd also set USX2Y_NRPACKS to 1 then. | ||
58 | */ | ||
59 | |||
60 | #ifdef USX2Y_NRPACKS_VARIABLE | ||
61 | static int nrpacks = USX2Y_NRPACKS; /* number of packets per urb */ | ||
62 | #define nr_of_packs() nrpacks | ||
63 | module_param(nrpacks, int, 0444); | ||
64 | MODULE_PARM_DESC(nrpacks, "Number of packets per URB."); | ||
65 | #else | ||
66 | #define nr_of_packs() USX2Y_NRPACKS | ||
67 | #endif | ||
68 | |||
69 | |||
70 | static int usX2Y_urb_capt_retire(snd_usX2Y_substream_t *subs) | ||
71 | { | ||
72 | struct urb *urb = subs->completed_urb; | ||
73 | snd_pcm_runtime_t *runtime = subs->pcm_substream->runtime; | ||
74 | unsigned char *cp; | ||
75 | int i, len, lens = 0, hwptr_done = subs->hwptr_done; | ||
76 | usX2Ydev_t *usX2Y = subs->usX2Y; | ||
77 | |||
78 | for (i = 0; i < nr_of_packs(); i++) { | ||
79 | cp = (unsigned char*)urb->transfer_buffer + urb->iso_frame_desc[i].offset; | ||
80 | if (urb->iso_frame_desc[i].status) { /* active? hmm, skip this */ | ||
81 | snd_printk("activ frame status %i. Most propably some hardware problem.\n", urb->iso_frame_desc[i].status); | ||
82 | return urb->iso_frame_desc[i].status; | ||
83 | } | ||
84 | len = urb->iso_frame_desc[i].actual_length / usX2Y->stride; | ||
85 | if (! len) { | ||
86 | snd_printd("0 == len ERROR!\n"); | ||
87 | continue; | ||
88 | } | ||
89 | |||
90 | /* copy a data chunk */ | ||
91 | if ((hwptr_done + len) > runtime->buffer_size) { | ||
92 | int cnt = runtime->buffer_size - hwptr_done; | ||
93 | int blen = cnt * usX2Y->stride; | ||
94 | memcpy(runtime->dma_area + hwptr_done * usX2Y->stride, cp, blen); | ||
95 | memcpy(runtime->dma_area, cp + blen, len * usX2Y->stride - blen); | ||
96 | } else { | ||
97 | memcpy(runtime->dma_area + hwptr_done * usX2Y->stride, cp, len * usX2Y->stride); | ||
98 | } | ||
99 | lens += len; | ||
100 | if ((hwptr_done += len) >= runtime->buffer_size) | ||
101 | hwptr_done -= runtime->buffer_size; | ||
102 | } | ||
103 | |||
104 | subs->hwptr_done = hwptr_done; | ||
105 | subs->transfer_done += lens; | ||
106 | /* update the pointer, call callback if necessary */ | ||
107 | if (subs->transfer_done >= runtime->period_size) { | ||
108 | subs->transfer_done -= runtime->period_size; | ||
109 | snd_pcm_period_elapsed(subs->pcm_substream); | ||
110 | } | ||
111 | return 0; | ||
112 | } | ||
113 | /* | ||
114 | * prepare urb for playback data pipe | ||
115 | * | ||
116 | * we copy the data directly from the pcm buffer. | ||
117 | * the current position to be copied is held in hwptr field. | ||
118 | * since a urb can handle only a single linear buffer, if the total | ||
119 | * transferred area overflows the buffer boundary, we cannot send | ||
120 | * it directly from the buffer. thus the data is once copied to | ||
121 | * a temporary buffer and urb points to that. | ||
122 | */ | ||
123 | static int usX2Y_urb_play_prepare(snd_usX2Y_substream_t *subs, | ||
124 | struct urb *cap_urb, | ||
125 | struct urb *urb) | ||
126 | { | ||
127 | int count, counts, pack; | ||
128 | usX2Ydev_t* usX2Y = subs->usX2Y; | ||
129 | snd_pcm_runtime_t *runtime = subs->pcm_substream->runtime; | ||
130 | |||
131 | count = 0; | ||
132 | for (pack = 0; pack < nr_of_packs(); pack++) { | ||
133 | /* calculate the size of a packet */ | ||
134 | counts = cap_urb->iso_frame_desc[pack].actual_length / usX2Y->stride; | ||
135 | count += counts; | ||
136 | if (counts < 43 || counts > 50) { | ||
137 | snd_printk("should not be here with counts=%i\n", counts); | ||
138 | return -EPIPE; | ||
139 | } | ||
140 | /* set up descriptor */ | ||
141 | urb->iso_frame_desc[pack].offset = pack ? | ||
142 | urb->iso_frame_desc[pack - 1].offset + urb->iso_frame_desc[pack - 1].length : | ||
143 | 0; | ||
144 | urb->iso_frame_desc[pack].length = cap_urb->iso_frame_desc[pack].actual_length; | ||
145 | } | ||
146 | if (atomic_read(&subs->state) >= state_PRERUNNING) | ||
147 | if (subs->hwptr + count > runtime->buffer_size) { | ||
148 | /* err, the transferred area goes over buffer boundary. | ||
149 | * copy the data to the temp buffer. | ||
150 | */ | ||
151 | int len; | ||
152 | len = runtime->buffer_size - subs->hwptr; | ||
153 | urb->transfer_buffer = subs->tmpbuf; | ||
154 | memcpy(subs->tmpbuf, runtime->dma_area + subs->hwptr * usX2Y->stride, len * usX2Y->stride); | ||
155 | memcpy(subs->tmpbuf + len * usX2Y->stride, runtime->dma_area, (count - len) * usX2Y->stride); | ||
156 | subs->hwptr += count; | ||
157 | subs->hwptr -= runtime->buffer_size; | ||
158 | } else { | ||
159 | /* set the buffer pointer */ | ||
160 | urb->transfer_buffer = runtime->dma_area + subs->hwptr * usX2Y->stride; | ||
161 | if ((subs->hwptr += count) >= runtime->buffer_size) | ||
162 | subs->hwptr -= runtime->buffer_size; | ||
163 | } | ||
164 | else | ||
165 | urb->transfer_buffer = subs->tmpbuf; | ||
166 | urb->transfer_buffer_length = count * usX2Y->stride; | ||
167 | return 0; | ||
168 | } | ||
169 | |||
170 | /* | ||
171 | * process after playback data complete | ||
172 | * | ||
173 | * update the current position and call callback if a period is processed. | ||
174 | */ | ||
175 | static void usX2Y_urb_play_retire(snd_usX2Y_substream_t *subs, struct urb *urb) | ||
176 | { | ||
177 | snd_pcm_runtime_t *runtime = subs->pcm_substream->runtime; | ||
178 | int len = urb->actual_length / subs->usX2Y->stride; | ||
179 | |||
180 | subs->transfer_done += len; | ||
181 | subs->hwptr_done += len; | ||
182 | if (subs->hwptr_done >= runtime->buffer_size) | ||
183 | subs->hwptr_done -= runtime->buffer_size; | ||
184 | if (subs->transfer_done >= runtime->period_size) { | ||
185 | subs->transfer_done -= runtime->period_size; | ||
186 | snd_pcm_period_elapsed(subs->pcm_substream); | ||
187 | } | ||
188 | } | ||
189 | |||
190 | static int usX2Y_urb_submit(snd_usX2Y_substream_t *subs, struct urb *urb, int frame) | ||
191 | { | ||
192 | int err; | ||
193 | if (!urb) | ||
194 | return -ENODEV; | ||
195 | urb->start_frame = (frame + NRURBS * nr_of_packs()); // let hcd do rollover sanity checks | ||
196 | urb->hcpriv = NULL; | ||
197 | urb->dev = subs->usX2Y->chip.dev; /* we need to set this at each time */ | ||
198 | if ((err = usb_submit_urb(urb, GFP_ATOMIC)) < 0) { | ||
199 | snd_printk("usb_submit_urb() returned %i\n", err); | ||
200 | return err; | ||
201 | } | ||
202 | return 0; | ||
203 | } | ||
204 | |||
205 | static inline int usX2Y_usbframe_complete(snd_usX2Y_substream_t *capsubs, snd_usX2Y_substream_t *playbacksubs, int frame) | ||
206 | { | ||
207 | int err, state; | ||
208 | { | ||
209 | struct urb *urb = playbacksubs->completed_urb; | ||
210 | |||
211 | state = atomic_read(&playbacksubs->state); | ||
212 | if (NULL != urb) { | ||
213 | if (state == state_RUNNING) | ||
214 | usX2Y_urb_play_retire(playbacksubs, urb); | ||
215 | else | ||
216 | if (state >= state_PRERUNNING) { | ||
217 | atomic_inc(&playbacksubs->state); | ||
218 | } | ||
219 | } else { | ||
220 | switch (state) { | ||
221 | case state_STARTING1: | ||
222 | urb = playbacksubs->urb[0]; | ||
223 | atomic_inc(&playbacksubs->state); | ||
224 | break; | ||
225 | case state_STARTING2: | ||
226 | urb = playbacksubs->urb[1]; | ||
227 | atomic_inc(&playbacksubs->state); | ||
228 | break; | ||
229 | } | ||
230 | } | ||
231 | if (urb) { | ||
232 | if ((err = usX2Y_urb_play_prepare(playbacksubs, capsubs->completed_urb, urb)) || | ||
233 | (err = usX2Y_urb_submit(playbacksubs, urb, frame))) { | ||
234 | return err; | ||
235 | } | ||
236 | } | ||
237 | |||
238 | playbacksubs->completed_urb = NULL; | ||
239 | } | ||
240 | state = atomic_read(&capsubs->state); | ||
241 | if (state >= state_PREPARED) { | ||
242 | if (state == state_RUNNING) { | ||
243 | if ((err = usX2Y_urb_capt_retire(capsubs))) | ||
244 | return err; | ||
245 | } else | ||
246 | if (state >= state_PRERUNNING) { | ||
247 | atomic_inc(&capsubs->state); | ||
248 | } | ||
249 | if ((err = usX2Y_urb_submit(capsubs, capsubs->completed_urb, frame))) | ||
250 | return err; | ||
251 | } | ||
252 | capsubs->completed_urb = NULL; | ||
253 | return 0; | ||
254 | } | ||
255 | |||
256 | |||
257 | static void usX2Y_clients_stop(usX2Ydev_t *usX2Y) | ||
258 | { | ||
259 | int s, u; | ||
260 | for (s = 0; s < 4; s++) { | ||
261 | snd_usX2Y_substream_t *subs = usX2Y->subs[s]; | ||
262 | if (subs) { | ||
263 | snd_printdd("%i %p state=%i\n", s, subs, atomic_read(&subs->state)); | ||
264 | atomic_set(&subs->state, state_STOPPED); | ||
265 | } | ||
266 | } | ||
267 | for (s = 0; s < 4; s++) { | ||
268 | snd_usX2Y_substream_t *subs = usX2Y->subs[s]; | ||
269 | if (subs) { | ||
270 | if (atomic_read(&subs->state) >= state_PRERUNNING) { | ||
271 | snd_pcm_stop(subs->pcm_substream, SNDRV_PCM_STATE_XRUN); | ||
272 | } | ||
273 | for (u = 0; u < NRURBS; u++) { | ||
274 | struct urb *urb = subs->urb[u]; | ||
275 | if (NULL != urb) | ||
276 | snd_printdd("%i status=%i start_frame=%i\n", u, urb->status, urb->start_frame); | ||
277 | } | ||
278 | } | ||
279 | } | ||
280 | usX2Y->prepare_subs = NULL; | ||
281 | wake_up(&usX2Y->prepare_wait_queue); | ||
282 | } | ||
283 | |||
284 | static void usX2Y_error_urb_status(usX2Ydev_t *usX2Y, snd_usX2Y_substream_t *subs, struct urb *urb) | ||
285 | { | ||
286 | snd_printk("ep=%i stalled with status=%i\n", subs->endpoint, urb->status); | ||
287 | urb->status = 0; | ||
288 | usX2Y_clients_stop(usX2Y); | ||
289 | } | ||
290 | |||
291 | static void usX2Y_error_sequence(usX2Ydev_t *usX2Y, snd_usX2Y_substream_t *subs, struct urb *urb) | ||
292 | { | ||
293 | snd_printk("Sequence Error!(hcd_frame=%i ep=%i%s;wait=%i,frame=%i).\n" | ||
294 | "Most propably some urb of usb-frame %i is still missing.\n" | ||
295 | "Cause could be too long delays in usb-hcd interrupt handling.\n", | ||
296 | usb_get_current_frame_number(usX2Y->chip.dev), | ||
297 | subs->endpoint, usb_pipein(urb->pipe) ? "in" : "out", usX2Y->wait_iso_frame, urb->start_frame, usX2Y->wait_iso_frame); | ||
298 | usX2Y_clients_stop(usX2Y); | ||
299 | } | ||
300 | |||
301 | static void i_usX2Y_urb_complete(struct urb *urb, struct pt_regs *regs) | ||
302 | { | ||
303 | snd_usX2Y_substream_t *subs = (snd_usX2Y_substream_t*)urb->context; | ||
304 | usX2Ydev_t *usX2Y = subs->usX2Y; | ||
305 | |||
306 | if (unlikely(atomic_read(&subs->state) < state_PREPARED)) { | ||
307 | snd_printdd("hcd_frame=%i ep=%i%s status=%i start_frame=%i\n", usb_get_current_frame_number(usX2Y->chip.dev), subs->endpoint, usb_pipein(urb->pipe) ? "in" : "out", urb->status, urb->start_frame); | ||
308 | return; | ||
309 | } | ||
310 | if (unlikely(urb->status)) { | ||
311 | usX2Y_error_urb_status(usX2Y, subs, urb); | ||
312 | return; | ||
313 | } | ||
314 | if (likely((0xFFFF & urb->start_frame) == usX2Y->wait_iso_frame)) | ||
315 | subs->completed_urb = urb; | ||
316 | else { | ||
317 | usX2Y_error_sequence(usX2Y, subs, urb); | ||
318 | return; | ||
319 | } | ||
320 | { | ||
321 | snd_usX2Y_substream_t *capsubs = usX2Y->subs[SNDRV_PCM_STREAM_CAPTURE], | ||
322 | *playbacksubs = usX2Y->subs[SNDRV_PCM_STREAM_PLAYBACK]; | ||
323 | if (capsubs->completed_urb && atomic_read(&capsubs->state) >= state_PREPARED && | ||
324 | (playbacksubs->completed_urb || atomic_read(&playbacksubs->state) < state_PREPARED)) { | ||
325 | if (!usX2Y_usbframe_complete(capsubs, playbacksubs, urb->start_frame)) { | ||
326 | if (nr_of_packs() <= urb->start_frame && | ||
327 | urb->start_frame <= (2 * nr_of_packs() - 1)) // uhci and ohci | ||
328 | usX2Y->wait_iso_frame = urb->start_frame - nr_of_packs(); | ||
329 | else | ||
330 | usX2Y->wait_iso_frame += nr_of_packs(); | ||
331 | } else { | ||
332 | snd_printdd("\n"); | ||
333 | usX2Y_clients_stop(usX2Y); | ||
334 | } | ||
335 | } | ||
336 | } | ||
337 | } | ||
338 | |||
339 | static void usX2Y_urbs_set_complete(usX2Ydev_t * usX2Y, void (*complete)(struct urb *, struct pt_regs *)) | ||
340 | { | ||
341 | int s, u; | ||
342 | for (s = 0; s < 4; s++) { | ||
343 | snd_usX2Y_substream_t *subs = usX2Y->subs[s]; | ||
344 | if (NULL != subs) | ||
345 | for (u = 0; u < NRURBS; u++) { | ||
346 | struct urb * urb = subs->urb[u]; | ||
347 | if (NULL != urb) | ||
348 | urb->complete = complete; | ||
349 | } | ||
350 | } | ||
351 | } | ||
352 | |||
353 | static void usX2Y_subs_startup_finish(usX2Ydev_t * usX2Y) | ||
354 | { | ||
355 | usX2Y_urbs_set_complete(usX2Y, i_usX2Y_urb_complete); | ||
356 | usX2Y->prepare_subs = NULL; | ||
357 | } | ||
358 | |||
359 | static void i_usX2Y_subs_startup(struct urb *urb, struct pt_regs *regs) | ||
360 | { | ||
361 | snd_usX2Y_substream_t *subs = (snd_usX2Y_substream_t*)urb->context; | ||
362 | usX2Ydev_t *usX2Y = subs->usX2Y; | ||
363 | snd_usX2Y_substream_t *prepare_subs = usX2Y->prepare_subs; | ||
364 | if (NULL != prepare_subs) | ||
365 | if (urb->start_frame == prepare_subs->urb[0]->start_frame) { | ||
366 | usX2Y_subs_startup_finish(usX2Y); | ||
367 | atomic_inc(&prepare_subs->state); | ||
368 | wake_up(&usX2Y->prepare_wait_queue); | ||
369 | } | ||
370 | |||
371 | i_usX2Y_urb_complete(urb, regs); | ||
372 | } | ||
373 | |||
374 | static void usX2Y_subs_prepare(snd_usX2Y_substream_t *subs) | ||
375 | { | ||
376 | snd_printdd("usX2Y_substream_prepare(%p) ep=%i urb0=%p urb1=%p\n", subs, subs->endpoint, subs->urb[0], subs->urb[1]); | ||
377 | /* reset the pointer */ | ||
378 | subs->hwptr = 0; | ||
379 | subs->hwptr_done = 0; | ||
380 | subs->transfer_done = 0; | ||
381 | } | ||
382 | |||
383 | |||
384 | static void usX2Y_urb_release(struct urb** urb, int free_tb) | ||
385 | { | ||
386 | if (*urb) { | ||
387 | usb_kill_urb(*urb); | ||
388 | if (free_tb) | ||
389 | kfree((*urb)->transfer_buffer); | ||
390 | usb_free_urb(*urb); | ||
391 | *urb = NULL; | ||
392 | } | ||
393 | } | ||
394 | /* | ||
395 | * release a substreams urbs | ||
396 | */ | ||
397 | static void usX2Y_urbs_release(snd_usX2Y_substream_t *subs) | ||
398 | { | ||
399 | int i; | ||
400 | snd_printdd("usX2Y_urbs_release() %i\n", subs->endpoint); | ||
401 | for (i = 0; i < NRURBS; i++) | ||
402 | usX2Y_urb_release(subs->urb + i, subs != subs->usX2Y->subs[SNDRV_PCM_STREAM_PLAYBACK]); | ||
403 | |||
404 | if (subs->tmpbuf) { | ||
405 | kfree(subs->tmpbuf); | ||
406 | subs->tmpbuf = NULL; | ||
407 | } | ||
408 | } | ||
409 | /* | ||
410 | * initialize a substream's urbs | ||
411 | */ | ||
412 | static int usX2Y_urbs_allocate(snd_usX2Y_substream_t *subs) | ||
413 | { | ||
414 | int i; | ||
415 | unsigned int pipe; | ||
416 | int is_playback = subs == subs->usX2Y->subs[SNDRV_PCM_STREAM_PLAYBACK]; | ||
417 | struct usb_device *dev = subs->usX2Y->chip.dev; | ||
418 | |||
419 | pipe = is_playback ? usb_sndisocpipe(dev, subs->endpoint) : | ||
420 | usb_rcvisocpipe(dev, subs->endpoint); | ||
421 | subs->maxpacksize = usb_maxpacket(dev, pipe, is_playback); | ||
422 | if (!subs->maxpacksize) | ||
423 | return -EINVAL; | ||
424 | |||
425 | if (is_playback && NULL == subs->tmpbuf) { /* allocate a temporary buffer for playback */ | ||
426 | subs->tmpbuf = kcalloc(nr_of_packs(), subs->maxpacksize, GFP_KERNEL); | ||
427 | if (NULL == subs->tmpbuf) { | ||
428 | snd_printk(KERN_ERR "cannot malloc tmpbuf\n"); | ||
429 | return -ENOMEM; | ||
430 | } | ||
431 | } | ||
432 | /* allocate and initialize data urbs */ | ||
433 | for (i = 0; i < NRURBS; i++) { | ||
434 | struct urb** purb = subs->urb + i; | ||
435 | if (*purb) { | ||
436 | usb_kill_urb(*purb); | ||
437 | continue; | ||
438 | } | ||
439 | *purb = usb_alloc_urb(nr_of_packs(), GFP_KERNEL); | ||
440 | if (NULL == *purb) { | ||
441 | usX2Y_urbs_release(subs); | ||
442 | return -ENOMEM; | ||
443 | } | ||
444 | if (!is_playback && !(*purb)->transfer_buffer) { | ||
445 | /* allocate a capture buffer per urb */ | ||
446 | (*purb)->transfer_buffer = kmalloc(subs->maxpacksize * nr_of_packs(), GFP_KERNEL); | ||
447 | if (NULL == (*purb)->transfer_buffer) { | ||
448 | usX2Y_urbs_release(subs); | ||
449 | return -ENOMEM; | ||
450 | } | ||
451 | } | ||
452 | (*purb)->dev = dev; | ||
453 | (*purb)->pipe = pipe; | ||
454 | (*purb)->number_of_packets = nr_of_packs(); | ||
455 | (*purb)->context = subs; | ||
456 | (*purb)->interval = 1; | ||
457 | (*purb)->complete = i_usX2Y_subs_startup; | ||
458 | } | ||
459 | return 0; | ||
460 | } | ||
461 | |||
462 | static void usX2Y_subs_startup(snd_usX2Y_substream_t *subs) | ||
463 | { | ||
464 | usX2Ydev_t *usX2Y = subs->usX2Y; | ||
465 | usX2Y->prepare_subs = subs; | ||
466 | subs->urb[0]->start_frame = -1; | ||
467 | wmb(); | ||
468 | usX2Y_urbs_set_complete(usX2Y, i_usX2Y_subs_startup); | ||
469 | } | ||
470 | |||
471 | static int usX2Y_urbs_start(snd_usX2Y_substream_t *subs) | ||
472 | { | ||
473 | int i, err; | ||
474 | usX2Ydev_t *usX2Y = subs->usX2Y; | ||
475 | |||
476 | if ((err = usX2Y_urbs_allocate(subs)) < 0) | ||
477 | return err; | ||
478 | subs->completed_urb = NULL; | ||
479 | for (i = 0; i < 4; i++) { | ||
480 | snd_usX2Y_substream_t *subs = usX2Y->subs[i]; | ||
481 | if (subs != NULL && atomic_read(&subs->state) >= state_PREPARED) | ||
482 | goto start; | ||
483 | } | ||
484 | usX2Y->wait_iso_frame = -1; | ||
485 | start: | ||
486 | { | ||
487 | usX2Y_subs_startup(subs); | ||
488 | for (i = 0; i < NRURBS; i++) { | ||
489 | struct urb *urb = subs->urb[i]; | ||
490 | if (usb_pipein(urb->pipe)) { | ||
491 | unsigned long pack; | ||
492 | if (0 == i) | ||
493 | atomic_set(&subs->state, state_STARTING3); | ||
494 | urb->dev = usX2Y->chip.dev; | ||
495 | urb->transfer_flags = URB_ISO_ASAP; | ||
496 | for (pack = 0; pack < nr_of_packs(); pack++) { | ||
497 | urb->iso_frame_desc[pack].offset = subs->maxpacksize * pack; | ||
498 | urb->iso_frame_desc[pack].length = subs->maxpacksize; | ||
499 | } | ||
500 | urb->transfer_buffer_length = subs->maxpacksize * nr_of_packs(); | ||
501 | if ((err = usb_submit_urb(urb, GFP_ATOMIC)) < 0) { | ||
502 | snd_printk (KERN_ERR "cannot submit datapipe for urb %d, err = %d\n", i, err); | ||
503 | err = -EPIPE; | ||
504 | goto cleanup; | ||
505 | } else { | ||
506 | if (0 > usX2Y->wait_iso_frame) | ||
507 | usX2Y->wait_iso_frame = urb->start_frame; | ||
508 | } | ||
509 | urb->transfer_flags = 0; | ||
510 | } else { | ||
511 | atomic_set(&subs->state, state_STARTING1); | ||
512 | break; | ||
513 | } | ||
514 | } | ||
515 | err = 0; | ||
516 | wait_event(usX2Y->prepare_wait_queue, NULL == usX2Y->prepare_subs); | ||
517 | if (atomic_read(&subs->state) != state_PREPARED) { | ||
518 | err = -EPIPE; | ||
519 | } | ||
520 | |||
521 | cleanup: | ||
522 | if (err) { | ||
523 | usX2Y_subs_startup_finish(usX2Y); | ||
524 | usX2Y_clients_stop(usX2Y); // something is completely wroong > stop evrything | ||
525 | } | ||
526 | } | ||
527 | return err; | ||
528 | } | ||
529 | |||
530 | /* | ||
531 | * return the current pcm pointer. just return the hwptr_done value. | ||
532 | */ | ||
533 | static snd_pcm_uframes_t snd_usX2Y_pcm_pointer(snd_pcm_substream_t *substream) | ||
534 | { | ||
535 | snd_usX2Y_substream_t *subs = (snd_usX2Y_substream_t *)substream->runtime->private_data; | ||
536 | return subs->hwptr_done; | ||
537 | } | ||
538 | /* | ||
539 | * start/stop substream | ||
540 | */ | ||
541 | static int snd_usX2Y_pcm_trigger(snd_pcm_substream_t *substream, int cmd) | ||
542 | { | ||
543 | snd_usX2Y_substream_t *subs = (snd_usX2Y_substream_t *)substream->runtime->private_data; | ||
544 | |||
545 | switch (cmd) { | ||
546 | case SNDRV_PCM_TRIGGER_START: | ||
547 | snd_printdd("snd_usX2Y_pcm_trigger(START)\n"); | ||
548 | if (atomic_read(&subs->state) == state_PREPARED && | ||
549 | atomic_read(&subs->usX2Y->subs[SNDRV_PCM_STREAM_CAPTURE]->state) >= state_PREPARED) { | ||
550 | atomic_set(&subs->state, state_PRERUNNING); | ||
551 | } else { | ||
552 | snd_printdd("\n"); | ||
553 | return -EPIPE; | ||
554 | } | ||
555 | break; | ||
556 | case SNDRV_PCM_TRIGGER_STOP: | ||
557 | snd_printdd("snd_usX2Y_pcm_trigger(STOP)\n"); | ||
558 | if (atomic_read(&subs->state) >= state_PRERUNNING) | ||
559 | atomic_set(&subs->state, state_PREPARED); | ||
560 | break; | ||
561 | default: | ||
562 | return -EINVAL; | ||
563 | } | ||
564 | return 0; | ||
565 | } | ||
566 | |||
567 | |||
568 | /* | ||
569 | * allocate a buffer, setup samplerate | ||
570 | * | ||
571 | * so far we use a physically linear buffer although packetize transfer | ||
572 | * doesn't need a continuous area. | ||
573 | * if sg buffer is supported on the later version of alsa, we'll follow | ||
574 | * that. | ||
575 | */ | ||
576 | static struct s_c2 | ||
577 | { | ||
578 | char c1, c2; | ||
579 | } | ||
580 | SetRate44100[] = | ||
581 | { | ||
582 | { 0x14, 0x08}, // this line sets 44100, well actually a little less | ||
583 | { 0x18, 0x40}, // only tascam / frontier design knows the further lines ....... | ||
584 | { 0x18, 0x42}, | ||
585 | { 0x18, 0x45}, | ||
586 | { 0x18, 0x46}, | ||
587 | { 0x18, 0x48}, | ||
588 | { 0x18, 0x4A}, | ||
589 | { 0x18, 0x4C}, | ||
590 | { 0x18, 0x4E}, | ||
591 | { 0x18, 0x50}, | ||
592 | { 0x18, 0x52}, | ||
593 | { 0x18, 0x54}, | ||
594 | { 0x18, 0x56}, | ||
595 | { 0x18, 0x58}, | ||
596 | { 0x18, 0x5A}, | ||
597 | { 0x18, 0x5C}, | ||
598 | { 0x18, 0x5E}, | ||
599 | { 0x18, 0x60}, | ||
600 | { 0x18, 0x62}, | ||
601 | { 0x18, 0x64}, | ||
602 | { 0x18, 0x66}, | ||
603 | { 0x18, 0x68}, | ||
604 | { 0x18, 0x6A}, | ||
605 | { 0x18, 0x6C}, | ||
606 | { 0x18, 0x6E}, | ||
607 | { 0x18, 0x70}, | ||
608 | { 0x18, 0x72}, | ||
609 | { 0x18, 0x74}, | ||
610 | { 0x18, 0x76}, | ||
611 | { 0x18, 0x78}, | ||
612 | { 0x18, 0x7A}, | ||
613 | { 0x18, 0x7C}, | ||
614 | { 0x18, 0x7E} | ||
615 | }; | ||
616 | static struct s_c2 SetRate48000[] = | ||
617 | { | ||
618 | { 0x14, 0x09}, // this line sets 48000, well actually a little less | ||
619 | { 0x18, 0x40}, // only tascam / frontier design knows the further lines ....... | ||
620 | { 0x18, 0x42}, | ||
621 | { 0x18, 0x45}, | ||
622 | { 0x18, 0x46}, | ||
623 | { 0x18, 0x48}, | ||
624 | { 0x18, 0x4A}, | ||
625 | { 0x18, 0x4C}, | ||
626 | { 0x18, 0x4E}, | ||
627 | { 0x18, 0x50}, | ||
628 | { 0x18, 0x52}, | ||
629 | { 0x18, 0x54}, | ||
630 | { 0x18, 0x56}, | ||
631 | { 0x18, 0x58}, | ||
632 | { 0x18, 0x5A}, | ||
633 | { 0x18, 0x5C}, | ||
634 | { 0x18, 0x5E}, | ||
635 | { 0x18, 0x60}, | ||
636 | { 0x18, 0x62}, | ||
637 | { 0x18, 0x64}, | ||
638 | { 0x18, 0x66}, | ||
639 | { 0x18, 0x68}, | ||
640 | { 0x18, 0x6A}, | ||
641 | { 0x18, 0x6C}, | ||
642 | { 0x18, 0x6E}, | ||
643 | { 0x18, 0x70}, | ||
644 | { 0x18, 0x73}, | ||
645 | { 0x18, 0x74}, | ||
646 | { 0x18, 0x76}, | ||
647 | { 0x18, 0x78}, | ||
648 | { 0x18, 0x7A}, | ||
649 | { 0x18, 0x7C}, | ||
650 | { 0x18, 0x7E} | ||
651 | }; | ||
652 | #define NOOF_SETRATE_URBS ARRAY_SIZE(SetRate48000) | ||
653 | |||
654 | static void i_usX2Y_04Int(struct urb* urb, struct pt_regs *regs) | ||
655 | { | ||
656 | usX2Ydev_t* usX2Y = urb->context; | ||
657 | |||
658 | if (urb->status) { | ||
659 | snd_printk("snd_usX2Y_04Int() urb->status=%i\n", urb->status); | ||
660 | } | ||
661 | if (0 == --usX2Y->US04->len) | ||
662 | wake_up(&usX2Y->In04WaitQueue); | ||
663 | } | ||
664 | |||
665 | static int usX2Y_rate_set(usX2Ydev_t *usX2Y, int rate) | ||
666 | { | ||
667 | int err = 0, i; | ||
668 | snd_usX2Y_urbSeq_t *us = NULL; | ||
669 | int *usbdata = NULL; | ||
670 | struct s_c2 *ra = rate == 48000 ? SetRate48000 : SetRate44100; | ||
671 | |||
672 | if (usX2Y->rate != rate) { | ||
673 | us = kmalloc(sizeof(*us) + sizeof(struct urb*) * NOOF_SETRATE_URBS, GFP_KERNEL); | ||
674 | if (NULL == us) { | ||
675 | err = -ENOMEM; | ||
676 | goto cleanup; | ||
677 | } | ||
678 | memset(us, 0, sizeof(*us) + sizeof(struct urb*) * NOOF_SETRATE_URBS); | ||
679 | usbdata = kmalloc(sizeof(int)*NOOF_SETRATE_URBS, GFP_KERNEL); | ||
680 | if (NULL == usbdata) { | ||
681 | err = -ENOMEM; | ||
682 | goto cleanup; | ||
683 | } | ||
684 | for (i = 0; i < NOOF_SETRATE_URBS; ++i) { | ||
685 | if (NULL == (us->urb[i] = usb_alloc_urb(0, GFP_KERNEL))) { | ||
686 | err = -ENOMEM; | ||
687 | goto cleanup; | ||
688 | } | ||
689 | ((char*)(usbdata + i))[0] = ra[i].c1; | ||
690 | ((char*)(usbdata + i))[1] = ra[i].c2; | ||
691 | usb_fill_bulk_urb(us->urb[i], usX2Y->chip.dev, usb_sndbulkpipe(usX2Y->chip.dev, 4), | ||
692 | usbdata + i, 2, i_usX2Y_04Int, usX2Y); | ||
693 | #ifdef OLD_USB | ||
694 | us->urb[i]->transfer_flags = USB_QUEUE_BULK; | ||
695 | #endif | ||
696 | } | ||
697 | us->submitted = 0; | ||
698 | us->len = NOOF_SETRATE_URBS; | ||
699 | usX2Y->US04 = us; | ||
700 | wait_event_timeout(usX2Y->In04WaitQueue, 0 == us->len, HZ); | ||
701 | usX2Y->US04 = NULL; | ||
702 | if (us->len) | ||
703 | err = -ENODEV; | ||
704 | cleanup: | ||
705 | if (us) { | ||
706 | us->submitted = 2*NOOF_SETRATE_URBS; | ||
707 | for (i = 0; i < NOOF_SETRATE_URBS; ++i) { | ||
708 | struct urb *urb = us->urb[i]; | ||
709 | if (urb->status) { | ||
710 | if (!err) | ||
711 | err = -ENODEV; | ||
712 | usb_kill_urb(urb); | ||
713 | } | ||
714 | usb_free_urb(urb); | ||
715 | } | ||
716 | usX2Y->US04 = NULL; | ||
717 | kfree(usbdata); | ||
718 | kfree(us); | ||
719 | if (!err) { | ||
720 | usX2Y->rate = rate; | ||
721 | } | ||
722 | } | ||
723 | } | ||
724 | |||
725 | return err; | ||
726 | } | ||
727 | |||
728 | |||
729 | static int usX2Y_format_set(usX2Ydev_t *usX2Y, snd_pcm_format_t format) | ||
730 | { | ||
731 | int alternate, err; | ||
732 | struct list_head* p; | ||
733 | if (format == SNDRV_PCM_FORMAT_S24_3LE) { | ||
734 | alternate = 2; | ||
735 | usX2Y->stride = 6; | ||
736 | } else { | ||
737 | alternate = 1; | ||
738 | usX2Y->stride = 4; | ||
739 | } | ||
740 | list_for_each(p, &usX2Y->chip.midi_list) { | ||
741 | snd_usbmidi_input_stop(p); | ||
742 | } | ||
743 | usb_kill_urb(usX2Y->In04urb); | ||
744 | if ((err = usb_set_interface(usX2Y->chip.dev, 0, alternate))) { | ||
745 | snd_printk("usb_set_interface error \n"); | ||
746 | return err; | ||
747 | } | ||
748 | usX2Y->In04urb->dev = usX2Y->chip.dev; | ||
749 | err = usb_submit_urb(usX2Y->In04urb, GFP_KERNEL); | ||
750 | list_for_each(p, &usX2Y->chip.midi_list) { | ||
751 | snd_usbmidi_input_start(p); | ||
752 | } | ||
753 | usX2Y->format = format; | ||
754 | usX2Y->rate = 0; | ||
755 | return err; | ||
756 | } | ||
757 | |||
758 | |||
759 | static int snd_usX2Y_pcm_hw_params(snd_pcm_substream_t *substream, | ||
760 | snd_pcm_hw_params_t *hw_params) | ||
761 | { | ||
762 | int err = 0; | ||
763 | unsigned int rate = params_rate(hw_params); | ||
764 | snd_pcm_format_t format = params_format(hw_params); | ||
765 | snd_printdd("snd_usX2Y_hw_params(%p, %p)\n", substream, hw_params); | ||
766 | |||
767 | { // all pcm substreams off one usX2Y have to operate at the same rate & format | ||
768 | snd_card_t *card = substream->pstr->pcm->card; | ||
769 | struct list_head *list; | ||
770 | list_for_each(list, &card->devices) { | ||
771 | snd_device_t *dev; | ||
772 | snd_pcm_t *pcm; | ||
773 | int s; | ||
774 | dev = snd_device(list); | ||
775 | if (dev->type != SNDRV_DEV_PCM) | ||
776 | continue; | ||
777 | pcm = dev->device_data; | ||
778 | for (s = 0; s < 2; ++s) { | ||
779 | snd_pcm_substream_t *test_substream; | ||
780 | test_substream = pcm->streams[s].substream; | ||
781 | if (test_substream && test_substream != substream && | ||
782 | test_substream->runtime && | ||
783 | ((test_substream->runtime->format && | ||
784 | test_substream->runtime->format != format) || | ||
785 | (test_substream->runtime->rate && | ||
786 | test_substream->runtime->rate != rate))) | ||
787 | return -EINVAL; | ||
788 | } | ||
789 | } | ||
790 | } | ||
791 | if (0 > (err = snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(hw_params)))) { | ||
792 | snd_printk("snd_pcm_lib_malloc_pages(%p, %i) returned %i\n", substream, params_buffer_bytes(hw_params), err); | ||
793 | return err; | ||
794 | } | ||
795 | return 0; | ||
796 | } | ||
797 | |||
798 | /* | ||
799 | * free the buffer | ||
800 | */ | ||
801 | static int snd_usX2Y_pcm_hw_free(snd_pcm_substream_t *substream) | ||
802 | { | ||
803 | snd_pcm_runtime_t *runtime = substream->runtime; | ||
804 | snd_usX2Y_substream_t *subs = (snd_usX2Y_substream_t *)runtime->private_data; | ||
805 | down(&subs->usX2Y->prepare_mutex); | ||
806 | snd_printdd("snd_usX2Y_hw_free(%p)\n", substream); | ||
807 | |||
808 | if (SNDRV_PCM_STREAM_PLAYBACK == substream->stream) { | ||
809 | snd_usX2Y_substream_t *cap_subs = subs->usX2Y->subs[SNDRV_PCM_STREAM_CAPTURE]; | ||
810 | atomic_set(&subs->state, state_STOPPED); | ||
811 | usX2Y_urbs_release(subs); | ||
812 | if (!cap_subs->pcm_substream || | ||
813 | !cap_subs->pcm_substream->runtime || | ||
814 | !cap_subs->pcm_substream->runtime->status || | ||
815 | cap_subs->pcm_substream->runtime->status->state < SNDRV_PCM_STATE_PREPARED) { | ||
816 | atomic_set(&cap_subs->state, state_STOPPED); | ||
817 | usX2Y_urbs_release(cap_subs); | ||
818 | } | ||
819 | } else { | ||
820 | snd_usX2Y_substream_t *playback_subs = subs->usX2Y->subs[SNDRV_PCM_STREAM_PLAYBACK]; | ||
821 | if (atomic_read(&playback_subs->state) < state_PREPARED) { | ||
822 | atomic_set(&subs->state, state_STOPPED); | ||
823 | usX2Y_urbs_release(subs); | ||
824 | } | ||
825 | } | ||
826 | up(&subs->usX2Y->prepare_mutex); | ||
827 | return snd_pcm_lib_free_pages(substream); | ||
828 | } | ||
829 | /* | ||
830 | * prepare callback | ||
831 | * | ||
832 | * set format and initialize urbs | ||
833 | */ | ||
834 | static int snd_usX2Y_pcm_prepare(snd_pcm_substream_t *substream) | ||
835 | { | ||
836 | snd_pcm_runtime_t *runtime = substream->runtime; | ||
837 | snd_usX2Y_substream_t *subs = (snd_usX2Y_substream_t *)runtime->private_data; | ||
838 | usX2Ydev_t *usX2Y = subs->usX2Y; | ||
839 | snd_usX2Y_substream_t *capsubs = subs->usX2Y->subs[SNDRV_PCM_STREAM_CAPTURE]; | ||
840 | int err = 0; | ||
841 | snd_printdd("snd_usX2Y_pcm_prepare(%p)\n", substream); | ||
842 | |||
843 | down(&usX2Y->prepare_mutex); | ||
844 | usX2Y_subs_prepare(subs); | ||
845 | // Start hardware streams | ||
846 | // SyncStream first.... | ||
847 | if (atomic_read(&capsubs->state) < state_PREPARED) { | ||
848 | if (usX2Y->format != runtime->format) | ||
849 | if ((err = usX2Y_format_set(usX2Y, runtime->format)) < 0) | ||
850 | goto up_prepare_mutex; | ||
851 | if (usX2Y->rate != runtime->rate) | ||
852 | if ((err = usX2Y_rate_set(usX2Y, runtime->rate)) < 0) | ||
853 | goto up_prepare_mutex; | ||
854 | snd_printdd("starting capture pipe for %s\n", subs == capsubs ? "self" : "playpipe"); | ||
855 | if (0 > (err = usX2Y_urbs_start(capsubs))) | ||
856 | goto up_prepare_mutex; | ||
857 | } | ||
858 | |||
859 | if (subs != capsubs && atomic_read(&subs->state) < state_PREPARED) | ||
860 | err = usX2Y_urbs_start(subs); | ||
861 | |||
862 | up_prepare_mutex: | ||
863 | up(&usX2Y->prepare_mutex); | ||
864 | return err; | ||
865 | } | ||
866 | |||
867 | static snd_pcm_hardware_t snd_usX2Y_2c = | ||
868 | { | ||
869 | .info = (SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED | | ||
870 | SNDRV_PCM_INFO_BLOCK_TRANSFER | | ||
871 | SNDRV_PCM_INFO_MMAP_VALID), | ||
872 | .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_3LE, | ||
873 | .rates = SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000, | ||
874 | .rate_min = 44100, | ||
875 | .rate_max = 48000, | ||
876 | .channels_min = 2, | ||
877 | .channels_max = 2, | ||
878 | .buffer_bytes_max = (2*128*1024), | ||
879 | .period_bytes_min = 64, | ||
880 | .period_bytes_max = (128*1024), | ||
881 | .periods_min = 2, | ||
882 | .periods_max = 1024, | ||
883 | .fifo_size = 0 | ||
884 | }; | ||
885 | |||
886 | |||
887 | |||
888 | static int snd_usX2Y_pcm_open(snd_pcm_substream_t *substream) | ||
889 | { | ||
890 | snd_usX2Y_substream_t *subs = ((snd_usX2Y_substream_t **) | ||
891 | snd_pcm_substream_chip(substream))[substream->stream]; | ||
892 | snd_pcm_runtime_t *runtime = substream->runtime; | ||
893 | |||
894 | if (subs->usX2Y->chip_status & USX2Y_STAT_CHIP_MMAP_PCM_URBS) | ||
895 | return -EBUSY; | ||
896 | |||
897 | runtime->hw = snd_usX2Y_2c; | ||
898 | runtime->private_data = subs; | ||
899 | subs->pcm_substream = substream; | ||
900 | snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_PERIOD_TIME, 1000, 200000); | ||
901 | return 0; | ||
902 | } | ||
903 | |||
904 | |||
905 | |||
906 | static int snd_usX2Y_pcm_close(snd_pcm_substream_t *substream) | ||
907 | { | ||
908 | snd_pcm_runtime_t *runtime = substream->runtime; | ||
909 | snd_usX2Y_substream_t *subs = (snd_usX2Y_substream_t *)runtime->private_data; | ||
910 | int err = 0; | ||
911 | |||
912 | subs->pcm_substream = NULL; | ||
913 | |||
914 | return err; | ||
915 | } | ||
916 | |||
917 | |||
918 | static snd_pcm_ops_t snd_usX2Y_pcm_ops = | ||
919 | { | ||
920 | .open = snd_usX2Y_pcm_open, | ||
921 | .close = snd_usX2Y_pcm_close, | ||
922 | .ioctl = snd_pcm_lib_ioctl, | ||
923 | .hw_params = snd_usX2Y_pcm_hw_params, | ||
924 | .hw_free = snd_usX2Y_pcm_hw_free, | ||
925 | .prepare = snd_usX2Y_pcm_prepare, | ||
926 | .trigger = snd_usX2Y_pcm_trigger, | ||
927 | .pointer = snd_usX2Y_pcm_pointer, | ||
928 | }; | ||
929 | |||
930 | |||
931 | /* | ||
932 | * free a usb stream instance | ||
933 | */ | ||
934 | static void usX2Y_audio_stream_free(snd_usX2Y_substream_t **usX2Y_substream) | ||
935 | { | ||
936 | if (NULL != usX2Y_substream[SNDRV_PCM_STREAM_PLAYBACK]) { | ||
937 | kfree(usX2Y_substream[SNDRV_PCM_STREAM_PLAYBACK]); | ||
938 | usX2Y_substream[SNDRV_PCM_STREAM_PLAYBACK] = NULL; | ||
939 | } | ||
940 | kfree(usX2Y_substream[SNDRV_PCM_STREAM_CAPTURE]); | ||
941 | usX2Y_substream[SNDRV_PCM_STREAM_CAPTURE] = NULL; | ||
942 | } | ||
943 | |||
944 | static void snd_usX2Y_pcm_private_free(snd_pcm_t *pcm) | ||
945 | { | ||
946 | snd_usX2Y_substream_t **usX2Y_stream = pcm->private_data; | ||
947 | if (usX2Y_stream) { | ||
948 | snd_pcm_lib_preallocate_free_for_all(pcm); | ||
949 | usX2Y_audio_stream_free(usX2Y_stream); | ||
950 | } | ||
951 | } | ||
952 | |||
953 | static int usX2Y_audio_stream_new(snd_card_t *card, int playback_endpoint, int capture_endpoint) | ||
954 | { | ||
955 | snd_pcm_t *pcm; | ||
956 | int err, i; | ||
957 | snd_usX2Y_substream_t **usX2Y_substream = | ||
958 | usX2Y(card)->subs + 2 * usX2Y(card)->chip.pcm_devs; | ||
959 | |||
960 | for (i = playback_endpoint ? SNDRV_PCM_STREAM_PLAYBACK : SNDRV_PCM_STREAM_CAPTURE; | ||
961 | i <= SNDRV_PCM_STREAM_CAPTURE; ++i) { | ||
962 | usX2Y_substream[i] = kcalloc(1, sizeof(snd_usX2Y_substream_t), GFP_KERNEL); | ||
963 | if (NULL == usX2Y_substream[i]) { | ||
964 | snd_printk(KERN_ERR "cannot malloc\n"); | ||
965 | return -ENOMEM; | ||
966 | } | ||
967 | usX2Y_substream[i]->usX2Y = usX2Y(card); | ||
968 | } | ||
969 | |||
970 | if (playback_endpoint) | ||
971 | usX2Y_substream[SNDRV_PCM_STREAM_PLAYBACK]->endpoint = playback_endpoint; | ||
972 | usX2Y_substream[SNDRV_PCM_STREAM_CAPTURE]->endpoint = capture_endpoint; | ||
973 | |||
974 | err = snd_pcm_new(card, NAME_ALLCAPS" Audio", usX2Y(card)->chip.pcm_devs, | ||
975 | playback_endpoint ? 1 : 0, 1, | ||
976 | &pcm); | ||
977 | if (err < 0) { | ||
978 | usX2Y_audio_stream_free(usX2Y_substream); | ||
979 | return err; | ||
980 | } | ||
981 | |||
982 | if (playback_endpoint) | ||
983 | snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &snd_usX2Y_pcm_ops); | ||
984 | snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_usX2Y_pcm_ops); | ||
985 | |||
986 | pcm->private_data = usX2Y_substream; | ||
987 | pcm->private_free = snd_usX2Y_pcm_private_free; | ||
988 | pcm->info_flags = 0; | ||
989 | |||
990 | sprintf(pcm->name, NAME_ALLCAPS" Audio #%d", usX2Y(card)->chip.pcm_devs); | ||
991 | |||
992 | if ((playback_endpoint && | ||
993 | 0 > (err = snd_pcm_lib_preallocate_pages(pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream, | ||
994 | SNDRV_DMA_TYPE_CONTINUOUS, | ||
995 | snd_dma_continuous_data(GFP_KERNEL), | ||
996 | 64*1024, 128*1024))) || | ||
997 | 0 > (err = snd_pcm_lib_preallocate_pages(pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream, | ||
998 | SNDRV_DMA_TYPE_CONTINUOUS, | ||
999 | snd_dma_continuous_data(GFP_KERNEL), | ||
1000 | 64*1024, 128*1024))) { | ||
1001 | snd_usX2Y_pcm_private_free(pcm); | ||
1002 | return err; | ||
1003 | } | ||
1004 | usX2Y(card)->chip.pcm_devs++; | ||
1005 | |||
1006 | return 0; | ||
1007 | } | ||
1008 | |||
1009 | /* | ||
1010 | * create a chip instance and set its names. | ||
1011 | */ | ||
1012 | int usX2Y_audio_create(snd_card_t* card) | ||
1013 | { | ||
1014 | int err = 0; | ||
1015 | |||
1016 | INIT_LIST_HEAD(&usX2Y(card)->chip.pcm_list); | ||
1017 | |||
1018 | if (0 > (err = usX2Y_audio_stream_new(card, 0xA, 0x8))) | ||
1019 | return err; | ||
1020 | if (le16_to_cpu(usX2Y(card)->chip.dev->descriptor.idProduct) == USB_ID_US428) | ||
1021 | if (0 > (err = usX2Y_audio_stream_new(card, 0, 0xA))) | ||
1022 | return err; | ||
1023 | if (le16_to_cpu(usX2Y(card)->chip.dev->descriptor.idProduct) != USB_ID_US122) | ||
1024 | err = usX2Y_rate_set(usX2Y(card), 44100); // Lets us428 recognize output-volume settings, disturbs us122. | ||
1025 | return err; | ||
1026 | } | ||