blob: 88ac1c4ee163ae2a6a2be171cd8c7a383e5fe17d [file] [log] [blame]
Thomas Gleixner2874c5f2019-05-27 08:55:01 +02001// SPDX-License-Identifier: GPL-2.0-or-later
Torsten Schenkc6d43ba2011-01-24 18:45:30 +01002/*
3 * Linux driver for TerraTec DMX 6Fire USB
4 *
5 * PCM driver
6 *
7 * Author: Torsten Schenk <torsten.schenk@zoho.com>
8 * Created: Jan 01, 2011
Torsten Schenkc6d43ba2011-01-24 18:45:30 +01009 * Copyright: (C) Torsten Schenk
Torsten Schenkc6d43ba2011-01-24 18:45:30 +010010 */
11
12#include "pcm.h"
13#include "chip.h"
14#include "comm.h"
Torsten Schenk2475b0d2011-04-04 11:50:53 +020015#include "control.h"
Torsten Schenkc6d43ba2011-01-24 18:45:30 +010016
17enum {
18 OUT_N_CHANNELS = 6, IN_N_CHANNELS = 4
19};
20
21/* keep next two synced with
Torsten Schenk2475b0d2011-04-04 11:50:53 +020022 * FW_EP_W_MAX_PACKET_SIZE[] and RATES_MAX_PACKET_SIZE
23 * and CONTROL_RATE_XXX in control.h */
Torsten Schenkc6d43ba2011-01-24 18:45:30 +010024static const int rates_in_packet_size[] = { 228, 228, 420, 420, 404, 404 };
25static const int rates_out_packet_size[] = { 228, 228, 420, 420, 604, 604 };
26static const int rates[] = { 44100, 48000, 88200, 96000, 176400, 192000 };
Torsten Schenkc6d43ba2011-01-24 18:45:30 +010027static const int rates_alsaid[] = {
28 SNDRV_PCM_RATE_44100, SNDRV_PCM_RATE_48000,
29 SNDRV_PCM_RATE_88200, SNDRV_PCM_RATE_96000,
30 SNDRV_PCM_RATE_176400, SNDRV_PCM_RATE_192000 };
31
Torsten Schenkc6d43ba2011-01-24 18:45:30 +010032enum { /* settings for pcm */
33 OUT_EP = 6, IN_EP = 2, MAX_BUFSIZE = 128 * 1024
34};
35
36enum { /* pcm streaming states */
37 STREAM_DISABLED, /* no pcm streaming */
38 STREAM_STARTING, /* pcm streaming requested, waiting to become ready */
39 STREAM_RUNNING, /* pcm streaming running */
40 STREAM_STOPPING
41};
42
Torsten Schenkc6d43ba2011-01-24 18:45:30 +010043static const struct snd_pcm_hardware pcm_hw = {
44 .info = SNDRV_PCM_INFO_MMAP |
45 SNDRV_PCM_INFO_INTERLEAVED |
46 SNDRV_PCM_INFO_BLOCK_TRANSFER |
47 SNDRV_PCM_INFO_MMAP_VALID |
48 SNDRV_PCM_INFO_BATCH,
49
Torsten Schenk58c54fa2011-04-04 11:49:00 +020050 .formats = SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE,
Torsten Schenkc6d43ba2011-01-24 18:45:30 +010051
52 .rates = SNDRV_PCM_RATE_44100 |
53 SNDRV_PCM_RATE_48000 |
54 SNDRV_PCM_RATE_88200 |
55 SNDRV_PCM_RATE_96000 |
56 SNDRV_PCM_RATE_176400 |
57 SNDRV_PCM_RATE_192000,
58
59 .rate_min = 44100,
60 .rate_max = 192000,
61 .channels_min = 1,
62 .channels_max = 0, /* set in pcm_open, depending on capture/playback */
63 .buffer_bytes_max = MAX_BUFSIZE,
64 .period_bytes_min = PCM_N_PACKETS_PER_URB * (PCM_MAX_PACKET_SIZE - 4),
65 .period_bytes_max = MAX_BUFSIZE,
66 .periods_min = 2,
67 .periods_max = 1024
68};
69
70static int usb6fire_pcm_set_rate(struct pcm_runtime *rt)
71{
72 int ret;
Torsten Schenk2475b0d2011-04-04 11:50:53 +020073 struct control_runtime *ctrl_rt = rt->chip->control;
Torsten Schenkc6d43ba2011-01-24 18:45:30 +010074
Torsten Schenk2475b0d2011-04-04 11:50:53 +020075 ctrl_rt->usb_streaming = false;
76 ret = ctrl_rt->update_streaming(ctrl_rt);
Torsten Schenkc6d43ba2011-01-24 18:45:30 +010077 if (ret < 0) {
Takashi Iwaie3b37572014-02-26 15:51:04 +010078 dev_err(&rt->chip->dev->dev,
79 "error stopping streaming while setting samplerate %d.\n",
80 rates[rt->rate]);
Torsten Schenkc6d43ba2011-01-24 18:45:30 +010081 return ret;
82 }
83
Torsten Schenk2475b0d2011-04-04 11:50:53 +020084 ret = ctrl_rt->set_rate(ctrl_rt, rt->rate);
Torsten Schenkc6d43ba2011-01-24 18:45:30 +010085 if (ret < 0) {
Takashi Iwaie3b37572014-02-26 15:51:04 +010086 dev_err(&rt->chip->dev->dev,
87 "error setting samplerate %d.\n",
88 rates[rt->rate]);
Torsten Schenkc6d43ba2011-01-24 18:45:30 +010089 return ret;
90 }
91
Torsten Schenk2475b0d2011-04-04 11:50:53 +020092 ret = ctrl_rt->set_channels(ctrl_rt, OUT_N_CHANNELS, IN_N_CHANNELS,
93 false, false);
Torsten Schenkc6d43ba2011-01-24 18:45:30 +010094 if (ret < 0) {
Takashi Iwaie3b37572014-02-26 15:51:04 +010095 dev_err(&rt->chip->dev->dev,
96 "error initializing channels while setting samplerate %d.\n",
97 rates[rt->rate]);
Torsten Schenkc6d43ba2011-01-24 18:45:30 +010098 return ret;
99 }
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100100
Torsten Schenk2475b0d2011-04-04 11:50:53 +0200101 ctrl_rt->usb_streaming = true;
102 ret = ctrl_rt->update_streaming(ctrl_rt);
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100103 if (ret < 0) {
Takashi Iwaie3b37572014-02-26 15:51:04 +0100104 dev_err(&rt->chip->dev->dev,
105 "error starting streaming while setting samplerate %d.\n",
106 rates[rt->rate]);
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100107 return ret;
108 }
109
110 rt->in_n_analog = IN_N_CHANNELS;
111 rt->out_n_analog = OUT_N_CHANNELS;
112 rt->in_packet_size = rates_in_packet_size[rt->rate];
113 rt->out_packet_size = rates_out_packet_size[rt->rate];
114 return 0;
115}
116
117static struct pcm_substream *usb6fire_pcm_get_substream(
118 struct snd_pcm_substream *alsa_sub)
119{
120 struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub);
121
122 if (alsa_sub->stream == SNDRV_PCM_STREAM_PLAYBACK)
123 return &rt->playback;
124 else if (alsa_sub->stream == SNDRV_PCM_STREAM_CAPTURE)
125 return &rt->capture;
Takashi Iwaie3b37572014-02-26 15:51:04 +0100126 dev_err(&rt->chip->dev->dev, "error getting pcm substream slot.\n");
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100127 return NULL;
128}
129
130/* call with stream_mutex locked */
131static void usb6fire_pcm_stream_stop(struct pcm_runtime *rt)
132{
133 int i;
Torsten Schenk2475b0d2011-04-04 11:50:53 +0200134 struct control_runtime *ctrl_rt = rt->chip->control;
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100135
136 if (rt->stream_state != STREAM_DISABLED) {
Jurgen Kramer96210552012-12-07 10:26:43 +0100137
138 rt->stream_state = STREAM_STOPPING;
139
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100140 for (i = 0; i < PCM_N_URBS; i++) {
141 usb_kill_urb(&rt->in_urbs[i].instance);
142 usb_kill_urb(&rt->out_urbs[i].instance);
143 }
Torsten Schenk2475b0d2011-04-04 11:50:53 +0200144 ctrl_rt->usb_streaming = false;
145 ctrl_rt->update_streaming(ctrl_rt);
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100146 rt->stream_state = STREAM_DISABLED;
147 }
148}
149
150/* call with stream_mutex locked */
151static int usb6fire_pcm_stream_start(struct pcm_runtime *rt)
152{
153 int ret;
154 int i;
155 int k;
156 struct usb_iso_packet_descriptor *packet;
157
158 if (rt->stream_state == STREAM_DISABLED) {
159 /* submit our in urbs */
160 rt->stream_wait_cond = false;
161 rt->stream_state = STREAM_STARTING;
162 for (i = 0; i < PCM_N_URBS; i++) {
163 for (k = 0; k < PCM_N_PACKETS_PER_URB; k++) {
164 packet = &rt->in_urbs[i].packets[k];
165 packet->offset = k * rt->in_packet_size;
166 packet->length = rt->in_packet_size;
167 packet->actual_length = 0;
168 packet->status = 0;
169 }
170 ret = usb_submit_urb(&rt->in_urbs[i].instance,
171 GFP_ATOMIC);
172 if (ret) {
173 usb6fire_pcm_stream_stop(rt);
174 return ret;
175 }
176 }
177
178 /* wait for first out urb to return (sent in in urb handler) */
179 wait_event_timeout(rt->stream_wait_queue, rt->stream_wait_cond,
180 HZ);
181 if (rt->stream_wait_cond)
182 rt->stream_state = STREAM_RUNNING;
183 else {
184 usb6fire_pcm_stream_stop(rt);
185 return -EIO;
186 }
187 }
188 return 0;
189}
190
191/* call with substream locked */
192static void usb6fire_pcm_capture(struct pcm_substream *sub, struct pcm_urb *urb)
193{
194 int i;
195 int frame;
196 int frame_count;
197 unsigned int total_length = 0;
198 struct pcm_runtime *rt = snd_pcm_substream_chip(sub->instance);
199 struct snd_pcm_runtime *alsa_rt = sub->instance->runtime;
Torsten Schenk58c54fa2011-04-04 11:49:00 +0200200 u32 *src = NULL;
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100201 u32 *dest = (u32 *) (alsa_rt->dma_area + sub->dma_off
202 * (alsa_rt->frame_bits >> 3));
203 u32 *dest_end = (u32 *) (alsa_rt->dma_area + alsa_rt->buffer_size
204 * (alsa_rt->frame_bits >> 3));
205 int bytes_per_frame = alsa_rt->channels << 2;
206
207 for (i = 0; i < PCM_N_PACKETS_PER_URB; i++) {
208 /* at least 4 header bytes for valid packet.
209 * after that: 32 bits per sample for analog channels */
210 if (urb->packets[i].actual_length > 4)
211 frame_count = (urb->packets[i].actual_length - 4)
212 / (rt->in_n_analog << 2);
213 else
214 frame_count = 0;
215
Torsten Schenk58c54fa2011-04-04 11:49:00 +0200216 if (alsa_rt->format == SNDRV_PCM_FORMAT_S24_LE)
217 src = (u32 *) (urb->buffer + total_length);
218 else if (alsa_rt->format == SNDRV_PCM_FORMAT_S32_LE)
219 src = (u32 *) (urb->buffer - 1 + total_length);
220 else
221 return;
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100222 src++; /* skip leading 4 bytes of every packet */
223 total_length += urb->packets[i].length;
224 for (frame = 0; frame < frame_count; frame++) {
225 memcpy(dest, src, bytes_per_frame);
226 dest += alsa_rt->channels;
227 src += rt->in_n_analog;
228 sub->dma_off++;
229 sub->period_off++;
230 if (dest == dest_end) {
231 sub->dma_off = 0;
232 dest = (u32 *) alsa_rt->dma_area;
233 }
234 }
235 }
236}
237
238/* call with substream locked */
239static void usb6fire_pcm_playback(struct pcm_substream *sub,
240 struct pcm_urb *urb)
241{
242 int i;
243 int frame;
244 int frame_count;
245 struct pcm_runtime *rt = snd_pcm_substream_chip(sub->instance);
246 struct snd_pcm_runtime *alsa_rt = sub->instance->runtime;
247 u32 *src = (u32 *) (alsa_rt->dma_area + sub->dma_off
248 * (alsa_rt->frame_bits >> 3));
249 u32 *src_end = (u32 *) (alsa_rt->dma_area + alsa_rt->buffer_size
250 * (alsa_rt->frame_bits >> 3));
Torsten Schenk58c54fa2011-04-04 11:49:00 +0200251 u32 *dest;
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100252 int bytes_per_frame = alsa_rt->channels << 2;
253
Torsten Schenk58c54fa2011-04-04 11:49:00 +0200254 if (alsa_rt->format == SNDRV_PCM_FORMAT_S32_LE)
255 dest = (u32 *) (urb->buffer - 1);
256 else if (alsa_rt->format == SNDRV_PCM_FORMAT_S24_LE)
257 dest = (u32 *) (urb->buffer);
258 else {
Takashi Iwaie3b37572014-02-26 15:51:04 +0100259 dev_err(&rt->chip->dev->dev, "Unknown sample format.");
Torsten Schenk58c54fa2011-04-04 11:49:00 +0200260 return;
261 }
262
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100263 for (i = 0; i < PCM_N_PACKETS_PER_URB; i++) {
264 /* at least 4 header bytes for valid packet.
265 * after that: 32 bits per sample for analog channels */
266 if (urb->packets[i].length > 4)
267 frame_count = (urb->packets[i].length - 4)
268 / (rt->out_n_analog << 2);
269 else
270 frame_count = 0;
271 dest++; /* skip leading 4 bytes of every frame */
272 for (frame = 0; frame < frame_count; frame++) {
273 memcpy(dest, src, bytes_per_frame);
274 src += alsa_rt->channels;
275 dest += rt->out_n_analog;
276 sub->dma_off++;
277 sub->period_off++;
278 if (src == src_end) {
279 src = (u32 *) alsa_rt->dma_area;
280 sub->dma_off = 0;
281 }
282 }
283 }
284}
285
286static void usb6fire_pcm_in_urb_handler(struct urb *usb_urb)
287{
288 struct pcm_urb *in_urb = usb_urb->context;
289 struct pcm_urb *out_urb = in_urb->peer;
290 struct pcm_runtime *rt = in_urb->chip->pcm;
291 struct pcm_substream *sub;
292 unsigned long flags;
293 int total_length = 0;
294 int frame_count;
295 int frame;
296 int channel;
297 int i;
298 u8 *dest;
299
300 if (usb_urb->status || rt->panic || rt->stream_state == STREAM_STOPPING)
301 return;
302 for (i = 0; i < PCM_N_PACKETS_PER_URB; i++)
303 if (in_urb->packets[i].status) {
304 rt->panic = true;
305 return;
306 }
307
308 if (rt->stream_state == STREAM_DISABLED) {
Takashi Iwaie3b37572014-02-26 15:51:04 +0100309 dev_err(&rt->chip->dev->dev,
310 "internal error: stream disabled in in-urb handler.\n");
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100311 return;
312 }
313
314 /* receive our capture data */
315 sub = &rt->capture;
316 spin_lock_irqsave(&sub->lock, flags);
317 if (sub->active) {
318 usb6fire_pcm_capture(sub, in_urb);
319 if (sub->period_off >= sub->instance->runtime->period_size) {
320 sub->period_off %= sub->instance->runtime->period_size;
321 spin_unlock_irqrestore(&sub->lock, flags);
322 snd_pcm_period_elapsed(sub->instance);
323 } else
324 spin_unlock_irqrestore(&sub->lock, flags);
325 } else
326 spin_unlock_irqrestore(&sub->lock, flags);
327
328 /* setup out urb structure */
329 for (i = 0; i < PCM_N_PACKETS_PER_URB; i++) {
330 out_urb->packets[i].offset = total_length;
331 out_urb->packets[i].length = (in_urb->packets[i].actual_length
332 - 4) / (rt->in_n_analog << 2)
333 * (rt->out_n_analog << 2) + 4;
334 out_urb->packets[i].status = 0;
335 total_length += out_urb->packets[i].length;
336 }
337 memset(out_urb->buffer, 0, total_length);
338
339 /* now send our playback data (if a free out urb was found) */
340 sub = &rt->playback;
341 spin_lock_irqsave(&sub->lock, flags);
342 if (sub->active) {
343 usb6fire_pcm_playback(sub, out_urb);
344 if (sub->period_off >= sub->instance->runtime->period_size) {
345 sub->period_off %= sub->instance->runtime->period_size;
346 spin_unlock_irqrestore(&sub->lock, flags);
347 snd_pcm_period_elapsed(sub->instance);
348 } else
349 spin_unlock_irqrestore(&sub->lock, flags);
350 } else
351 spin_unlock_irqrestore(&sub->lock, flags);
352
353 /* setup the 4th byte of each sample (0x40 for analog channels) */
354 dest = out_urb->buffer;
355 for (i = 0; i < PCM_N_PACKETS_PER_URB; i++)
356 if (out_urb->packets[i].length >= 4) {
357 frame_count = (out_urb->packets[i].length - 4)
358 / (rt->out_n_analog << 2);
359 *(dest++) = 0xaa;
360 *(dest++) = 0xaa;
361 *(dest++) = frame_count;
362 *(dest++) = 0x00;
363 for (frame = 0; frame < frame_count; frame++)
364 for (channel = 0;
365 channel < rt->out_n_analog;
366 channel++) {
367 dest += 3; /* skip sample data */
368 *(dest++) = 0x40;
369 }
370 }
371 usb_submit_urb(&out_urb->instance, GFP_ATOMIC);
372 usb_submit_urb(&in_urb->instance, GFP_ATOMIC);
373}
374
375static void usb6fire_pcm_out_urb_handler(struct urb *usb_urb)
376{
377 struct pcm_urb *urb = usb_urb->context;
378 struct pcm_runtime *rt = urb->chip->pcm;
379
380 if (rt->stream_state == STREAM_STARTING) {
381 rt->stream_wait_cond = true;
382 wake_up(&rt->stream_wait_queue);
383 }
384}
385
386static int usb6fire_pcm_open(struct snd_pcm_substream *alsa_sub)
387{
388 struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub);
389 struct pcm_substream *sub = NULL;
390 struct snd_pcm_runtime *alsa_rt = alsa_sub->runtime;
391
392 if (rt->panic)
393 return -EPIPE;
394
395 mutex_lock(&rt->stream_mutex);
396 alsa_rt->hw = pcm_hw;
397
398 if (alsa_sub->stream == SNDRV_PCM_STREAM_PLAYBACK) {
Torsten Schenk0ec52582011-06-16 21:06:27 +0200399 if (rt->rate < ARRAY_SIZE(rates))
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100400 alsa_rt->hw.rates = rates_alsaid[rt->rate];
401 alsa_rt->hw.channels_max = OUT_N_CHANNELS;
402 sub = &rt->playback;
403 } else if (alsa_sub->stream == SNDRV_PCM_STREAM_CAPTURE) {
Torsten Schenk0ec52582011-06-16 21:06:27 +0200404 if (rt->rate < ARRAY_SIZE(rates))
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100405 alsa_rt->hw.rates = rates_alsaid[rt->rate];
406 alsa_rt->hw.channels_max = IN_N_CHANNELS;
407 sub = &rt->capture;
408 }
409
410 if (!sub) {
411 mutex_unlock(&rt->stream_mutex);
Takashi Iwaie3b37572014-02-26 15:51:04 +0100412 dev_err(&rt->chip->dev->dev, "invalid stream type.\n");
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100413 return -EINVAL;
414 }
415
416 sub->instance = alsa_sub;
417 sub->active = false;
418 mutex_unlock(&rt->stream_mutex);
419 return 0;
420}
421
422static int usb6fire_pcm_close(struct snd_pcm_substream *alsa_sub)
423{
424 struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub);
425 struct pcm_substream *sub = usb6fire_pcm_get_substream(alsa_sub);
426 unsigned long flags;
427
428 if (rt->panic)
429 return 0;
430
431 mutex_lock(&rt->stream_mutex);
432 if (sub) {
433 /* deactivate substream */
434 spin_lock_irqsave(&sub->lock, flags);
435 sub->instance = NULL;
436 sub->active = false;
437 spin_unlock_irqrestore(&sub->lock, flags);
438
439 /* all substreams closed? if so, stop streaming */
440 if (!rt->playback.instance && !rt->capture.instance) {
441 usb6fire_pcm_stream_stop(rt);
Torsten Schenke220fa32011-04-04 11:47:50 +0200442 rt->rate = ARRAY_SIZE(rates);
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100443 }
444 }
445 mutex_unlock(&rt->stream_mutex);
446 return 0;
447}
448
449static int usb6fire_pcm_hw_params(struct snd_pcm_substream *alsa_sub,
450 struct snd_pcm_hw_params *hw_params)
451{
Antonio Ospite4a9f9112013-06-21 13:11:50 +0200452 return snd_pcm_lib_alloc_vmalloc_buffer(alsa_sub,
453 params_buffer_bytes(hw_params));
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100454}
455
456static int usb6fire_pcm_hw_free(struct snd_pcm_substream *alsa_sub)
457{
Antonio Ospite4a9f9112013-06-21 13:11:50 +0200458 return snd_pcm_lib_free_vmalloc_buffer(alsa_sub);
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100459}
460
461static int usb6fire_pcm_prepare(struct snd_pcm_substream *alsa_sub)
462{
463 struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub);
464 struct pcm_substream *sub = usb6fire_pcm_get_substream(alsa_sub);
465 struct snd_pcm_runtime *alsa_rt = alsa_sub->runtime;
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100466 int ret;
467
468 if (rt->panic)
469 return -EPIPE;
470 if (!sub)
471 return -ENODEV;
472
473 mutex_lock(&rt->stream_mutex);
474 sub->dma_off = 0;
475 sub->period_off = 0;
476
477 if (rt->stream_state == STREAM_DISABLED) {
Torsten Schenke220fa32011-04-04 11:47:50 +0200478 for (rt->rate = 0; rt->rate < ARRAY_SIZE(rates); rt->rate++)
479 if (alsa_rt->rate == rates[rt->rate])
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100480 break;
Torsten Schenke220fa32011-04-04 11:47:50 +0200481 if (rt->rate == ARRAY_SIZE(rates)) {
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100482 mutex_unlock(&rt->stream_mutex);
Takashi Iwaie3b37572014-02-26 15:51:04 +0100483 dev_err(&rt->chip->dev->dev,
484 "invalid rate %d in prepare.\n",
485 alsa_rt->rate);
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100486 return -EINVAL;
487 }
488
489 ret = usb6fire_pcm_set_rate(rt);
490 if (ret) {
491 mutex_unlock(&rt->stream_mutex);
492 return ret;
493 }
494 ret = usb6fire_pcm_stream_start(rt);
495 if (ret) {
496 mutex_unlock(&rt->stream_mutex);
Takashi Iwaie3b37572014-02-26 15:51:04 +0100497 dev_err(&rt->chip->dev->dev,
498 "could not start pcm stream.\n");
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100499 return ret;
500 }
501 }
502 mutex_unlock(&rt->stream_mutex);
503 return 0;
504}
505
506static int usb6fire_pcm_trigger(struct snd_pcm_substream *alsa_sub, int cmd)
507{
508 struct pcm_substream *sub = usb6fire_pcm_get_substream(alsa_sub);
509 struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub);
510 unsigned long flags;
511
512 if (rt->panic)
513 return -EPIPE;
514 if (!sub)
515 return -ENODEV;
516
517 switch (cmd) {
518 case SNDRV_PCM_TRIGGER_START:
519 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
520 spin_lock_irqsave(&sub->lock, flags);
521 sub->active = true;
522 spin_unlock_irqrestore(&sub->lock, flags);
523 return 0;
524
525 case SNDRV_PCM_TRIGGER_STOP:
526 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
527 spin_lock_irqsave(&sub->lock, flags);
528 sub->active = false;
529 spin_unlock_irqrestore(&sub->lock, flags);
530 return 0;
531
532 default:
533 return -EINVAL;
534 }
535}
536
537static snd_pcm_uframes_t usb6fire_pcm_pointer(
538 struct snd_pcm_substream *alsa_sub)
539{
540 struct pcm_substream *sub = usb6fire_pcm_get_substream(alsa_sub);
541 struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub);
542 unsigned long flags;
543 snd_pcm_uframes_t ret;
544
545 if (rt->panic || !sub)
Eldad Zackbe2f93a2013-07-19 18:26:53 +0200546 return SNDRV_PCM_POS_XRUN;
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100547
548 spin_lock_irqsave(&sub->lock, flags);
549 ret = sub->dma_off;
550 spin_unlock_irqrestore(&sub->lock, flags);
551 return ret;
552}
553
Arvind Yadav31cb1fb2017-08-18 13:15:21 +0530554static const struct snd_pcm_ops pcm_ops = {
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100555 .open = usb6fire_pcm_open,
556 .close = usb6fire_pcm_close,
557 .ioctl = snd_pcm_lib_ioctl,
558 .hw_params = usb6fire_pcm_hw_params,
559 .hw_free = usb6fire_pcm_hw_free,
560 .prepare = usb6fire_pcm_prepare,
561 .trigger = usb6fire_pcm_trigger,
562 .pointer = usb6fire_pcm_pointer,
Antonio Ospite4a9f9112013-06-21 13:11:50 +0200563 .page = snd_pcm_lib_get_vmalloc_page,
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100564};
565
Bill Pemberton87f97962012-12-06 12:35:28 -0500566static void usb6fire_pcm_init_urb(struct pcm_urb *urb,
567 struct sfire_chip *chip, bool in, int ep,
568 void (*handler)(struct urb *))
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100569{
570 urb->chip = chip;
571 usb_init_urb(&urb->instance);
572 urb->instance.transfer_buffer = urb->buffer;
573 urb->instance.transfer_buffer_length =
574 PCM_N_PACKETS_PER_URB * PCM_MAX_PACKET_SIZE;
575 urb->instance.dev = chip->dev;
576 urb->instance.pipe = in ? usb_rcvisocpipe(chip->dev, ep)
577 : usb_sndisocpipe(chip->dev, ep);
578 urb->instance.interval = 1;
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100579 urb->instance.complete = handler;
580 urb->instance.context = urb;
581 urb->instance.number_of_packets = PCM_N_PACKETS_PER_URB;
582}
583
Torsten Schenk5ece2632013-08-11 11:11:19 +0200584static int usb6fire_pcm_buffers_init(struct pcm_runtime *rt)
585{
586 int i;
587
588 for (i = 0; i < PCM_N_URBS; i++) {
Kees Cook6396bb22018-06-12 14:03:40 -0700589 rt->out_urbs[i].buffer = kcalloc(PCM_MAX_PACKET_SIZE,
590 PCM_N_PACKETS_PER_URB,
591 GFP_KERNEL);
Torsten Schenk5ece2632013-08-11 11:11:19 +0200592 if (!rt->out_urbs[i].buffer)
593 return -ENOMEM;
Kees Cook6396bb22018-06-12 14:03:40 -0700594 rt->in_urbs[i].buffer = kcalloc(PCM_MAX_PACKET_SIZE,
595 PCM_N_PACKETS_PER_URB,
596 GFP_KERNEL);
Torsten Schenk5ece2632013-08-11 11:11:19 +0200597 if (!rt->in_urbs[i].buffer)
598 return -ENOMEM;
599 }
600 return 0;
601}
602
603static void usb6fire_pcm_buffers_destroy(struct pcm_runtime *rt)
604{
605 int i;
606
607 for (i = 0; i < PCM_N_URBS; i++) {
608 kfree(rt->out_urbs[i].buffer);
609 kfree(rt->in_urbs[i].buffer);
610 }
611}
612
Bill Pemberton87f97962012-12-06 12:35:28 -0500613int usb6fire_pcm_init(struct sfire_chip *chip)
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100614{
615 int i;
616 int ret;
617 struct snd_pcm *pcm;
618 struct pcm_runtime *rt =
619 kzalloc(sizeof(struct pcm_runtime), GFP_KERNEL);
620
621 if (!rt)
622 return -ENOMEM;
623
Torsten Schenk5ece2632013-08-11 11:11:19 +0200624 ret = usb6fire_pcm_buffers_init(rt);
625 if (ret) {
626 usb6fire_pcm_buffers_destroy(rt);
627 kfree(rt);
628 return ret;
629 }
630
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100631 rt->chip = chip;
632 rt->stream_state = STREAM_DISABLED;
Torsten Schenke220fa32011-04-04 11:47:50 +0200633 rt->rate = ARRAY_SIZE(rates);
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100634 init_waitqueue_head(&rt->stream_wait_queue);
635 mutex_init(&rt->stream_mutex);
636
637 spin_lock_init(&rt->playback.lock);
638 spin_lock_init(&rt->capture.lock);
639
640 for (i = 0; i < PCM_N_URBS; i++) {
641 usb6fire_pcm_init_urb(&rt->in_urbs[i], chip, true, IN_EP,
642 usb6fire_pcm_in_urb_handler);
643 usb6fire_pcm_init_urb(&rt->out_urbs[i], chip, false, OUT_EP,
644 usb6fire_pcm_out_urb_handler);
645
646 rt->in_urbs[i].peer = &rt->out_urbs[i];
647 rt->out_urbs[i].peer = &rt->in_urbs[i];
648 }
649
650 ret = snd_pcm_new(chip->card, "DMX6FireUSB", 0, 1, 1, &pcm);
651 if (ret < 0) {
Torsten Schenk5ece2632013-08-11 11:11:19 +0200652 usb6fire_pcm_buffers_destroy(rt);
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100653 kfree(rt);
Takashi Iwaie3b37572014-02-26 15:51:04 +0100654 dev_err(&chip->dev->dev, "cannot create pcm instance.\n");
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100655 return ret;
656 }
657
658 pcm->private_data = rt;
659 strcpy(pcm->name, "DMX 6Fire USB");
660 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &pcm_ops);
661 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &pcm_ops);
662
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100663 if (ret) {
Torsten Schenk5ece2632013-08-11 11:11:19 +0200664 usb6fire_pcm_buffers_destroy(rt);
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100665 kfree(rt);
Takashi Iwaie3b37572014-02-26 15:51:04 +0100666 dev_err(&chip->dev->dev,
667 "error preallocating pcm buffers.\n");
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100668 return ret;
669 }
670 rt->instance = pcm;
671
672 chip->pcm = rt;
673 return 0;
674}
675
676void usb6fire_pcm_abort(struct sfire_chip *chip)
677{
678 struct pcm_runtime *rt = chip->pcm;
679 int i;
680
681 if (rt) {
682 rt->panic = true;
683
Takashi Iwai1fb85102014-11-07 17:08:28 +0100684 if (rt->playback.instance)
685 snd_pcm_stop_xrun(rt->playback.instance);
Takashi Iwai5b9ab3f2013-07-11 17:57:55 +0200686
Takashi Iwai1fb85102014-11-07 17:08:28 +0100687 if (rt->capture.instance)
688 snd_pcm_stop_xrun(rt->capture.instance);
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100689
690 for (i = 0; i < PCM_N_URBS; i++) {
691 usb_poison_urb(&rt->in_urbs[i].instance);
692 usb_poison_urb(&rt->out_urbs[i].instance);
693 }
694
695 }
696}
697
698void usb6fire_pcm_destroy(struct sfire_chip *chip)
699{
Torsten Schenk5ece2632013-08-11 11:11:19 +0200700 struct pcm_runtime *rt = chip->pcm;
701
702 usb6fire_pcm_buffers_destroy(rt);
703 kfree(rt);
Torsten Schenkc6d43ba2011-01-24 18:45:30 +0100704 chip->pcm = NULL;
705}