]>
Commit | Line | Data |
---|---|---|
705ececd MG |
1 | /* |
2 | * Line6 Linux USB driver - 0.8.0 | |
3 | * | |
4 | * Copyright (C) 2004-2009 Markus Grabner (grabner@icg.tugraz.at) | |
5 | * | |
6 | * This program is free software; you can redistribute it and/or | |
7 | * modify it under the terms of the GNU General Public License as | |
8 | * published by the Free Software Foundation, version 2. | |
9 | * | |
10 | */ | |
11 | ||
12 | #include "driver.h" | |
13 | ||
5a0e3ad6 TH |
14 | #include <linux/slab.h> |
15 | ||
705ececd MG |
16 | #include <sound/core.h> |
17 | #include <sound/pcm.h> | |
18 | #include <sound/pcm_params.h> | |
19 | ||
20 | #include "audio.h" | |
21 | #include "pcm.h" | |
22 | #include "pod.h" | |
b702ed25 | 23 | #include "playback.h" |
705ececd | 24 | |
705ececd MG |
25 | /* |
26 | Software stereo volume control. | |
27 | */ | |
010f378e GKH |
28 | static void change_volume(struct urb *urb_out, int volume[], |
29 | int bytes_per_frame) | |
705ececd MG |
30 | { |
31 | int chn = 0; | |
32 | ||
010f378e | 33 | if (volume[0] == 256 && volume[1] == 256) |
45af4977 | 34 | return; /* maximum volume - no change */ |
705ececd | 35 | |
010f378e | 36 | if (bytes_per_frame == 4) { |
705ececd MG |
37 | short *p, *buf_end; |
38 | p = (short *)urb_out->transfer_buffer; | |
39 | buf_end = p + urb_out->transfer_buffer_length / sizeof(*p); | |
40 | ||
010f378e | 41 | for (; p < buf_end; ++p) { |
705ececd MG |
42 | *p = (*p * volume[chn & 1]) >> 8; |
43 | ++chn; | |
44 | } | |
010f378e | 45 | } else if (bytes_per_frame == 6) { |
705ececd MG |
46 | unsigned char *p, *buf_end; |
47 | p = (unsigned char *)urb_out->transfer_buffer; | |
48 | buf_end = p + urb_out->transfer_buffer_length; | |
49 | ||
010f378e GKH |
50 | for (; p < buf_end; p += 3) { |
51 | int val; | |
52 | val = p[0] + (p[1] << 8) + ((signed char)p[2] << 16); | |
705ececd MG |
53 | val = (val * volume[chn & 1]) >> 8; |
54 | p[0] = val; | |
55 | p[1] = val >> 8; | |
56 | p[2] = val >> 16; | |
57 | ++chn; | |
58 | } | |
59 | } | |
60 | } | |
61 | ||
62 | /* | |
63 | Find a free URB, prepare audio data, and submit URB. | |
64 | */ | |
65 | static int submit_audio_out_urb(struct snd_pcm_substream *substream) | |
66 | { | |
67 | int index; | |
68 | unsigned long flags; | |
69 | int i, urb_size, urb_frames; | |
70 | struct snd_line6_pcm *line6pcm = snd_pcm_substream_chip(substream); | |
71 | const int bytes_per_frame = line6pcm->properties->bytes_per_frame; | |
45af4977 SB |
72 | const int frame_increment = |
73 | line6pcm->properties->snd_line6_rates.rats[0].num_min; | |
74 | const int frame_factor = | |
75 | line6pcm->properties->snd_line6_rates.rats[0].den * | |
76 | (USB_INTERVALS_PER_SECOND / LINE6_ISO_INTERVAL); | |
705ececd MG |
77 | struct snd_pcm_runtime *runtime = substream->runtime; |
78 | struct urb *urb_out; | |
79 | ||
80 | spin_lock_irqsave(&line6pcm->lock_audio_out, flags); | |
45af4977 SB |
81 | index = |
82 | find_first_zero_bit(&line6pcm->active_urb_out, LINE6_ISO_BUFFERS); | |
705ececd | 83 | |
010f378e | 84 | if (index < 0 || index >= LINE6_ISO_BUFFERS) { |
705ececd MG |
85 | spin_unlock_irqrestore(&line6pcm->lock_audio_out, flags); |
86 | dev_err(s2m(substream), "no free URB found\n"); | |
87 | return -EINVAL; | |
88 | } | |
89 | ||
90 | urb_out = line6pcm->urb_audio_out[index]; | |
91 | urb_size = 0; | |
92 | ||
010f378e | 93 | for (i = 0; i < LINE6_ISO_PACKETS; ++i) { |
705ececd MG |
94 | /* compute frame size for given sampling rate */ |
95 | int n, fs; | |
45af4977 SB |
96 | struct usb_iso_packet_descriptor *fout = |
97 | &urb_out->iso_frame_desc[i]; | |
705ececd MG |
98 | line6pcm->count_out += frame_increment; |
99 | n = line6pcm->count_out / frame_factor; | |
100 | line6pcm->count_out -= n * frame_factor; | |
101 | fs = n * bytes_per_frame; | |
102 | fout->offset = urb_size; | |
103 | fout->length = fs; | |
104 | urb_size += fs; | |
105 | } | |
106 | ||
107 | urb_frames = urb_size / bytes_per_frame; | |
108 | ||
010f378e | 109 | if (test_bit(BIT_PAUSE_PLAYBACK, &line6pcm->flags)) { |
705ececd MG |
110 | urb_out->transfer_buffer = line6pcm->wrap_out; |
111 | memset(line6pcm->wrap_out, 0, urb_size); | |
010f378e GKH |
112 | } else { |
113 | if (line6pcm->pos_out + urb_frames > runtime->buffer_size) { | |
705ececd | 114 | /* |
45af4977 SB |
115 | The transferred area goes over buffer boundary, |
116 | copy the data to the temp buffer. | |
117 | */ | |
705ececd MG |
118 | int len; |
119 | len = runtime->buffer_size - line6pcm->pos_out; | |
120 | urb_out->transfer_buffer = line6pcm->wrap_out; | |
121 | ||
010f378e | 122 | if (len > 0) { |
45af4977 SB |
123 | memcpy(line6pcm->wrap_out, |
124 | runtime->dma_area + | |
125 | line6pcm->pos_out * bytes_per_frame, | |
126 | len * bytes_per_frame); | |
127 | memcpy(line6pcm->wrap_out + | |
128 | len * bytes_per_frame, runtime->dma_area, | |
129 | (urb_frames - len) * bytes_per_frame); | |
130 | } else { | |
131 | /* this is somewhat paranoid */ | |
132 | dev_err(s2m(substream), | |
133 | "driver bug: len = %d\n", len); | |
134 | } | |
010f378e | 135 | } else { |
705ececd | 136 | /* set the buffer pointer */ |
45af4977 SB |
137 | urb_out->transfer_buffer = |
138 | runtime->dma_area + | |
139 | line6pcm->pos_out * bytes_per_frame; | |
705ececd MG |
140 | } |
141 | } | |
142 | ||
7f66fe58 SB |
143 | line6pcm->pos_out += urb_frames; |
144 | if (line6pcm->pos_out >= runtime->buffer_size) | |
705ececd MG |
145 | line6pcm->pos_out -= runtime->buffer_size; |
146 | ||
147 | urb_out->transfer_buffer_length = urb_size; | |
148 | urb_out->context = substream; | |
149 | change_volume(urb_out, line6pcm->volume, bytes_per_frame); | |
150 | ||
151 | #if DO_DUMP_PCM_SEND | |
010f378e | 152 | for (i = 0; i < LINE6_ISO_PACKETS; ++i) { |
45af4977 SB |
153 | struct usb_iso_packet_descriptor *fout = |
154 | &urb_out->iso_frame_desc[i]; | |
155 | line6_write_hexdump(line6pcm->line6, 'P', | |
156 | urb_out->transfer_buffer + fout->offset, | |
157 | fout->length); | |
705ececd MG |
158 | } |
159 | #endif | |
160 | ||
010f378e | 161 | if (usb_submit_urb(urb_out, GFP_ATOMIC) == 0) |
705ececd MG |
162 | set_bit(index, &line6pcm->active_urb_out); |
163 | else | |
45af4977 SB |
164 | dev_err(s2m(substream), "URB out #%d submission failed\n", |
165 | index); | |
705ececd MG |
166 | |
167 | spin_unlock_irqrestore(&line6pcm->lock_audio_out, flags); | |
168 | return 0; | |
169 | } | |
170 | ||
171 | /* | |
172 | Submit all currently available playback URBs. | |
173 | */ | |
174 | static int submit_audio_out_all_urbs(struct snd_pcm_substream *substream) | |
175 | { | |
176 | int ret, i; | |
177 | ||
010f378e GKH |
178 | for (i = 0; i < LINE6_ISO_BUFFERS; ++i) { |
179 | ret = submit_audio_out_urb(substream); | |
180 | if (ret < 0) | |
705ececd | 181 | return ret; |
010f378e | 182 | } |
705ececd MG |
183 | |
184 | return 0; | |
185 | } | |
186 | ||
187 | /* | |
188 | Unlink all currently active playback URBs. | |
189 | */ | |
190 | static void unlink_audio_out_urbs(struct snd_line6_pcm *line6pcm) | |
191 | { | |
192 | unsigned int i; | |
193 | ||
010f378e GKH |
194 | for (i = LINE6_ISO_BUFFERS; i--;) { |
195 | if (test_bit(i, &line6pcm->active_urb_out)) { | |
196 | if (!test_and_set_bit(i, &line6pcm->unlink_urb_out)) { | |
705ececd | 197 | struct urb *u = line6pcm->urb_audio_out[i]; |
705ececd MG |
198 | usb_unlink_urb(u); |
199 | } | |
200 | } | |
201 | } | |
202 | } | |
203 | ||
204 | /* | |
45af4977 | 205 | Wait until unlinking of all currently active playback URBs has been finished. |
705ececd MG |
206 | */ |
207 | static void wait_clear_audio_out_urbs(struct snd_line6_pcm *line6pcm) | |
208 | { | |
209 | int timeout = HZ; | |
210 | unsigned int i; | |
211 | int alive; | |
212 | ||
213 | do { | |
214 | alive = 0; | |
215 | for (i = LINE6_ISO_BUFFERS; i--;) { | |
216 | if (test_bit(i, &line6pcm->active_urb_out)) | |
217 | alive++; | |
218 | } | |
010f378e | 219 | if (!alive) |
705ececd MG |
220 | break; |
221 | set_current_state(TASK_UNINTERRUPTIBLE); | |
222 | schedule_timeout(1); | |
223 | } while (--timeout > 0); | |
224 | if (alive) | |
225 | snd_printk(KERN_ERR "timeout: still %d active urbs..\n", alive); | |
226 | ||
227 | line6pcm->active_urb_out = 0; | |
228 | line6pcm->unlink_urb_out = 0; | |
229 | } | |
230 | ||
231 | /* | |
232 | Unlink all currently active playback URBs, and wait for finishing. | |
233 | */ | |
234 | void unlink_wait_clear_audio_out_urbs(struct snd_line6_pcm *line6pcm) | |
235 | { | |
236 | unlink_audio_out_urbs(line6pcm); | |
237 | wait_clear_audio_out_urbs(line6pcm); | |
238 | } | |
239 | ||
240 | /* | |
241 | Callback for completed playback URB. | |
242 | */ | |
0c7ab158 | 243 | static void audio_out_callback(struct urb *urb) |
705ececd MG |
244 | { |
245 | int i, index, length = 0, shutdown = 0; | |
246 | unsigned long flags; | |
247 | ||
45af4977 SB |
248 | struct snd_pcm_substream *substream = |
249 | (struct snd_pcm_substream *)urb->context; | |
705ececd MG |
250 | struct snd_line6_pcm *line6pcm = snd_pcm_substream_chip(substream); |
251 | struct snd_pcm_runtime *runtime = substream->runtime; | |
252 | ||
253 | /* find index of URB */ | |
010f378e GKH |
254 | for (index = LINE6_ISO_BUFFERS; index--;) |
255 | if (urb == line6pcm->urb_audio_out[index]) | |
705ececd MG |
256 | break; |
257 | ||
010f378e | 258 | if (index < 0) |
45af4977 | 259 | return; /* URB has been unlinked asynchronously */ |
705ececd | 260 | |
010f378e | 261 | for (i = LINE6_ISO_PACKETS; i--;) |
705ececd MG |
262 | length += urb->iso_frame_desc[i].length; |
263 | ||
264 | spin_lock_irqsave(&line6pcm->lock_audio_out, flags); | |
45af4977 SB |
265 | line6pcm->pos_out_done += |
266 | length / line6pcm->properties->bytes_per_frame; | |
705ececd | 267 | |
010f378e | 268 | if (line6pcm->pos_out_done >= runtime->buffer_size) |
705ececd MG |
269 | line6pcm->pos_out_done -= runtime->buffer_size; |
270 | ||
271 | clear_bit(index, &line6pcm->active_urb_out); | |
272 | ||
010f378e GKH |
273 | for (i = LINE6_ISO_PACKETS; i--;) |
274 | if (urb->iso_frame_desc[i].status == -ESHUTDOWN) { | |
705ececd MG |
275 | shutdown = 1; |
276 | break; | |
277 | } | |
278 | ||
010f378e | 279 | if (test_bit(index, &line6pcm->unlink_urb_out)) |
705ececd MG |
280 | shutdown = 1; |
281 | ||
282 | spin_unlock_irqrestore(&line6pcm->lock_audio_out, flags); | |
283 | ||
010f378e | 284 | if (!shutdown) { |
705ececd MG |
285 | submit_audio_out_urb(substream); |
286 | ||
7f66fe58 SB |
287 | line6pcm->bytes_out += length; |
288 | if (line6pcm->bytes_out >= line6pcm->period_out) { | |
705ececd MG |
289 | line6pcm->bytes_out -= line6pcm->period_out; |
290 | snd_pcm_period_elapsed(substream); | |
291 | } | |
292 | } | |
293 | } | |
294 | ||
295 | /* open playback callback */ | |
296 | static int snd_line6_playback_open(struct snd_pcm_substream *substream) | |
297 | { | |
298 | int err; | |
299 | struct snd_pcm_runtime *runtime = substream->runtime; | |
300 | struct snd_line6_pcm *line6pcm = snd_pcm_substream_chip(substream); | |
301 | ||
010f378e | 302 | err = snd_pcm_hw_constraint_ratdens(runtime, 0, SNDRV_PCM_HW_PARAM_RATE, |
45af4977 SB |
303 | (&line6pcm->properties-> |
304 | snd_line6_rates)); | |
010f378e | 305 | if (err < 0) |
705ececd MG |
306 | return err; |
307 | ||
308 | runtime->hw = line6pcm->properties->snd_line6_playback_hw; | |
309 | return 0; | |
310 | } | |
311 | ||
312 | /* close playback callback */ | |
313 | static int snd_line6_playback_close(struct snd_pcm_substream *substream) | |
314 | { | |
315 | return 0; | |
316 | } | |
317 | ||
318 | /* hw_params playback callback */ | |
45af4977 SB |
319 | static int snd_line6_playback_hw_params(struct snd_pcm_substream *substream, |
320 | struct snd_pcm_hw_params *hw_params) | |
705ececd MG |
321 | { |
322 | int ret; | |
323 | struct snd_line6_pcm *line6pcm = snd_pcm_substream_chip(substream); | |
324 | ||
325 | /* -- Florian Demski [FD] */ | |
326 | /* don't ask me why, but this fixes the bug on my machine */ | |
010f378e GKH |
327 | if (line6pcm == NULL) { |
328 | if (substream->pcm == NULL) | |
705ececd | 329 | return -ENOMEM; |
010f378e | 330 | if (substream->pcm->private_data == NULL) |
705ececd MG |
331 | return -ENOMEM; |
332 | substream->private_data = substream->pcm->private_data; | |
010f378e | 333 | line6pcm = snd_pcm_substream_chip(substream); |
705ececd MG |
334 | } |
335 | /* -- [FD] end */ | |
336 | ||
010f378e GKH |
337 | ret = snd_pcm_lib_malloc_pages(substream, |
338 | params_buffer_bytes(hw_params)); | |
339 | if (ret < 0) | |
705ececd MG |
340 | return ret; |
341 | ||
342 | line6pcm->period_out = params_period_bytes(hw_params); | |
343 | line6pcm->wrap_out = kmalloc(2 * LINE6_ISO_PACKET_SIZE_MAX, GFP_KERNEL); | |
344 | ||
010f378e | 345 | if (!line6pcm->wrap_out) { |
705ececd MG |
346 | dev_err(s2m(substream), "cannot malloc wrap_out\n"); |
347 | return -ENOMEM; | |
348 | } | |
349 | ||
350 | return 0; | |
351 | } | |
352 | ||
353 | /* hw_free playback callback */ | |
354 | static int snd_line6_playback_hw_free(struct snd_pcm_substream *substream) | |
355 | { | |
356 | struct snd_line6_pcm *line6pcm = snd_pcm_substream_chip(substream); | |
357 | unlink_wait_clear_audio_out_urbs(line6pcm); | |
358 | ||
010f378e GKH |
359 | kfree(line6pcm->wrap_out); |
360 | line6pcm->wrap_out = NULL; | |
705ececd MG |
361 | |
362 | return snd_pcm_lib_free_pages(substream); | |
363 | } | |
364 | ||
365 | /* trigger playback callback */ | |
366 | int snd_line6_playback_trigger(struct snd_pcm_substream *substream, int cmd) | |
367 | { | |
368 | struct snd_line6_pcm *line6pcm = snd_pcm_substream_chip(substream); | |
369 | int err; | |
370 | line6pcm->count_out = 0; | |
371 | ||
010f378e | 372 | switch (cmd) { |
705ececd | 373 | case SNDRV_PCM_TRIGGER_START: |
010f378e | 374 | if (!test_and_set_bit(BIT_RUNNING_PLAYBACK, &line6pcm->flags)) { |
705ececd MG |
375 | err = submit_audio_out_all_urbs(substream); |
376 | ||
010f378e | 377 | if (err < 0) { |
45af4977 SB |
378 | clear_bit(BIT_RUNNING_PLAYBACK, |
379 | &line6pcm->flags); | |
705ececd MG |
380 | return err; |
381 | } | |
382 | } | |
383 | ||
384 | break; | |
385 | ||
386 | case SNDRV_PCM_TRIGGER_STOP: | |
010f378e | 387 | if (test_and_clear_bit(BIT_RUNNING_PLAYBACK, &line6pcm->flags)) |
705ececd MG |
388 | unlink_audio_out_urbs(line6pcm); |
389 | ||
390 | break; | |
391 | ||
392 | case SNDRV_PCM_TRIGGER_PAUSE_PUSH: | |
393 | set_bit(BIT_PAUSE_PLAYBACK, &line6pcm->flags); | |
394 | break; | |
395 | ||
396 | case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: | |
397 | clear_bit(BIT_PAUSE_PLAYBACK, &line6pcm->flags); | |
398 | break; | |
399 | ||
400 | default: | |
401 | return -EINVAL; | |
402 | } | |
403 | ||
404 | return 0; | |
405 | } | |
406 | ||
407 | /* playback pointer callback */ | |
408 | static snd_pcm_uframes_t | |
409 | snd_line6_playback_pointer(struct snd_pcm_substream *substream) | |
410 | { | |
411 | struct snd_line6_pcm *line6pcm = snd_pcm_substream_chip(substream); | |
412 | return line6pcm->pos_out_done; | |
413 | } | |
414 | ||
415 | /* playback operators */ | |
416 | struct snd_pcm_ops snd_line6_playback_ops = { | |
45af4977 SB |
417 | .open = snd_line6_playback_open, |
418 | .close = snd_line6_playback_close, | |
419 | .ioctl = snd_pcm_lib_ioctl, | |
420 | .hw_params = snd_line6_playback_hw_params, | |
421 | .hw_free = snd_line6_playback_hw_free, | |
422 | .prepare = snd_line6_prepare, | |
423 | .trigger = snd_line6_trigger, | |
424 | .pointer = snd_line6_playback_pointer, | |
705ececd MG |
425 | }; |
426 | ||
427 | int create_audio_out_urbs(struct snd_line6_pcm *line6pcm) | |
428 | { | |
429 | int i; | |
430 | ||
431 | /* create audio URBs and fill in constant values: */ | |
010f378e | 432 | for (i = 0; i < LINE6_ISO_BUFFERS; ++i) { |
705ececd MG |
433 | struct urb *urb; |
434 | ||
435 | /* URB for audio out: */ | |
45af4977 SB |
436 | urb = line6pcm->urb_audio_out[i] = |
437 | usb_alloc_urb(LINE6_ISO_PACKETS, GFP_KERNEL); | |
705ececd | 438 | |
010f378e | 439 | if (urb == NULL) { |
705ececd MG |
440 | dev_err(line6pcm->line6->ifcdev, "Out of memory\n"); |
441 | return -ENOMEM; | |
442 | } | |
443 | ||
444 | urb->dev = line6pcm->line6->usbdev; | |
45af4977 SB |
445 | urb->pipe = |
446 | usb_sndisocpipe(line6pcm->line6->usbdev, | |
447 | line6pcm-> | |
448 | ep_audio_write & USB_ENDPOINT_NUMBER_MASK); | |
705ececd MG |
449 | urb->transfer_flags = URB_ISO_ASAP; |
450 | urb->start_frame = -1; | |
451 | urb->number_of_packets = LINE6_ISO_PACKETS; | |
452 | urb->interval = LINE6_ISO_INTERVAL; | |
453 | urb->error_count = 0; | |
454 | urb->complete = audio_out_callback; | |
455 | } | |
456 | ||
457 | return 0; | |
458 | } |