1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Linux driver for TerraTec DMX 6Fire USB
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * PCM driver
6*4882a593Smuzhiyun *
7*4882a593Smuzhiyun * Author: Torsten Schenk <torsten.schenk@zoho.com>
8*4882a593Smuzhiyun * Created: Jan 01, 2011
9*4882a593Smuzhiyun * Copyright: (C) Torsten Schenk
10*4882a593Smuzhiyun */
11*4882a593Smuzhiyun
12*4882a593Smuzhiyun #include "pcm.h"
13*4882a593Smuzhiyun #include "chip.h"
14*4882a593Smuzhiyun #include "comm.h"
15*4882a593Smuzhiyun #include "control.h"
16*4882a593Smuzhiyun
17*4882a593Smuzhiyun enum {
18*4882a593Smuzhiyun OUT_N_CHANNELS = 6, IN_N_CHANNELS = 4
19*4882a593Smuzhiyun };
20*4882a593Smuzhiyun
21*4882a593Smuzhiyun /* keep next two synced with
22*4882a593Smuzhiyun * FW_EP_W_MAX_PACKET_SIZE[] and RATES_MAX_PACKET_SIZE
23*4882a593Smuzhiyun * and CONTROL_RATE_XXX in control.h */
24*4882a593Smuzhiyun static const int rates_in_packet_size[] = { 228, 228, 420, 420, 404, 404 };
25*4882a593Smuzhiyun static const int rates_out_packet_size[] = { 228, 228, 420, 420, 604, 604 };
26*4882a593Smuzhiyun static const int rates[] = { 44100, 48000, 88200, 96000, 176400, 192000 };
27*4882a593Smuzhiyun static const int rates_alsaid[] = {
28*4882a593Smuzhiyun SNDRV_PCM_RATE_44100, SNDRV_PCM_RATE_48000,
29*4882a593Smuzhiyun SNDRV_PCM_RATE_88200, SNDRV_PCM_RATE_96000,
30*4882a593Smuzhiyun SNDRV_PCM_RATE_176400, SNDRV_PCM_RATE_192000 };
31*4882a593Smuzhiyun
32*4882a593Smuzhiyun enum { /* settings for pcm */
33*4882a593Smuzhiyun OUT_EP = 6, IN_EP = 2, MAX_BUFSIZE = 128 * 1024
34*4882a593Smuzhiyun };
35*4882a593Smuzhiyun
36*4882a593Smuzhiyun enum { /* pcm streaming states */
37*4882a593Smuzhiyun STREAM_DISABLED, /* no pcm streaming */
38*4882a593Smuzhiyun STREAM_STARTING, /* pcm streaming requested, waiting to become ready */
39*4882a593Smuzhiyun STREAM_RUNNING, /* pcm streaming running */
40*4882a593Smuzhiyun STREAM_STOPPING
41*4882a593Smuzhiyun };
42*4882a593Smuzhiyun
43*4882a593Smuzhiyun static const struct snd_pcm_hardware pcm_hw = {
44*4882a593Smuzhiyun .info = SNDRV_PCM_INFO_MMAP |
45*4882a593Smuzhiyun SNDRV_PCM_INFO_INTERLEAVED |
46*4882a593Smuzhiyun SNDRV_PCM_INFO_BLOCK_TRANSFER |
47*4882a593Smuzhiyun SNDRV_PCM_INFO_MMAP_VALID |
48*4882a593Smuzhiyun SNDRV_PCM_INFO_BATCH,
49*4882a593Smuzhiyun
50*4882a593Smuzhiyun .formats = SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE,
51*4882a593Smuzhiyun
52*4882a593Smuzhiyun .rates = SNDRV_PCM_RATE_44100 |
53*4882a593Smuzhiyun SNDRV_PCM_RATE_48000 |
54*4882a593Smuzhiyun SNDRV_PCM_RATE_88200 |
55*4882a593Smuzhiyun SNDRV_PCM_RATE_96000 |
56*4882a593Smuzhiyun SNDRV_PCM_RATE_176400 |
57*4882a593Smuzhiyun SNDRV_PCM_RATE_192000,
58*4882a593Smuzhiyun
59*4882a593Smuzhiyun .rate_min = 44100,
60*4882a593Smuzhiyun .rate_max = 192000,
61*4882a593Smuzhiyun .channels_min = 1,
62*4882a593Smuzhiyun .channels_max = 0, /* set in pcm_open, depending on capture/playback */
63*4882a593Smuzhiyun .buffer_bytes_max = MAX_BUFSIZE,
64*4882a593Smuzhiyun .period_bytes_min = PCM_N_PACKETS_PER_URB * (PCM_MAX_PACKET_SIZE - 4),
65*4882a593Smuzhiyun .period_bytes_max = MAX_BUFSIZE,
66*4882a593Smuzhiyun .periods_min = 2,
67*4882a593Smuzhiyun .periods_max = 1024
68*4882a593Smuzhiyun };
69*4882a593Smuzhiyun
usb6fire_pcm_set_rate(struct pcm_runtime * rt)70*4882a593Smuzhiyun static int usb6fire_pcm_set_rate(struct pcm_runtime *rt)
71*4882a593Smuzhiyun {
72*4882a593Smuzhiyun int ret;
73*4882a593Smuzhiyun struct control_runtime *ctrl_rt = rt->chip->control;
74*4882a593Smuzhiyun
75*4882a593Smuzhiyun ctrl_rt->usb_streaming = false;
76*4882a593Smuzhiyun ret = ctrl_rt->update_streaming(ctrl_rt);
77*4882a593Smuzhiyun if (ret < 0) {
78*4882a593Smuzhiyun dev_err(&rt->chip->dev->dev,
79*4882a593Smuzhiyun "error stopping streaming while setting samplerate %d.\n",
80*4882a593Smuzhiyun rates[rt->rate]);
81*4882a593Smuzhiyun return ret;
82*4882a593Smuzhiyun }
83*4882a593Smuzhiyun
84*4882a593Smuzhiyun ret = ctrl_rt->set_rate(ctrl_rt, rt->rate);
85*4882a593Smuzhiyun if (ret < 0) {
86*4882a593Smuzhiyun dev_err(&rt->chip->dev->dev,
87*4882a593Smuzhiyun "error setting samplerate %d.\n",
88*4882a593Smuzhiyun rates[rt->rate]);
89*4882a593Smuzhiyun return ret;
90*4882a593Smuzhiyun }
91*4882a593Smuzhiyun
92*4882a593Smuzhiyun ret = ctrl_rt->set_channels(ctrl_rt, OUT_N_CHANNELS, IN_N_CHANNELS,
93*4882a593Smuzhiyun false, false);
94*4882a593Smuzhiyun if (ret < 0) {
95*4882a593Smuzhiyun dev_err(&rt->chip->dev->dev,
96*4882a593Smuzhiyun "error initializing channels while setting samplerate %d.\n",
97*4882a593Smuzhiyun rates[rt->rate]);
98*4882a593Smuzhiyun return ret;
99*4882a593Smuzhiyun }
100*4882a593Smuzhiyun
101*4882a593Smuzhiyun ctrl_rt->usb_streaming = true;
102*4882a593Smuzhiyun ret = ctrl_rt->update_streaming(ctrl_rt);
103*4882a593Smuzhiyun if (ret < 0) {
104*4882a593Smuzhiyun dev_err(&rt->chip->dev->dev,
105*4882a593Smuzhiyun "error starting streaming while setting samplerate %d.\n",
106*4882a593Smuzhiyun rates[rt->rate]);
107*4882a593Smuzhiyun return ret;
108*4882a593Smuzhiyun }
109*4882a593Smuzhiyun
110*4882a593Smuzhiyun rt->in_n_analog = IN_N_CHANNELS;
111*4882a593Smuzhiyun rt->out_n_analog = OUT_N_CHANNELS;
112*4882a593Smuzhiyun rt->in_packet_size = rates_in_packet_size[rt->rate];
113*4882a593Smuzhiyun rt->out_packet_size = rates_out_packet_size[rt->rate];
114*4882a593Smuzhiyun return 0;
115*4882a593Smuzhiyun }
116*4882a593Smuzhiyun
usb6fire_pcm_get_substream(struct snd_pcm_substream * alsa_sub)117*4882a593Smuzhiyun static struct pcm_substream *usb6fire_pcm_get_substream(
118*4882a593Smuzhiyun struct snd_pcm_substream *alsa_sub)
119*4882a593Smuzhiyun {
120*4882a593Smuzhiyun struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub);
121*4882a593Smuzhiyun
122*4882a593Smuzhiyun if (alsa_sub->stream == SNDRV_PCM_STREAM_PLAYBACK)
123*4882a593Smuzhiyun return &rt->playback;
124*4882a593Smuzhiyun else if (alsa_sub->stream == SNDRV_PCM_STREAM_CAPTURE)
125*4882a593Smuzhiyun return &rt->capture;
126*4882a593Smuzhiyun dev_err(&rt->chip->dev->dev, "error getting pcm substream slot.\n");
127*4882a593Smuzhiyun return NULL;
128*4882a593Smuzhiyun }
129*4882a593Smuzhiyun
130*4882a593Smuzhiyun /* call with stream_mutex locked */
usb6fire_pcm_stream_stop(struct pcm_runtime * rt)131*4882a593Smuzhiyun static void usb6fire_pcm_stream_stop(struct pcm_runtime *rt)
132*4882a593Smuzhiyun {
133*4882a593Smuzhiyun int i;
134*4882a593Smuzhiyun struct control_runtime *ctrl_rt = rt->chip->control;
135*4882a593Smuzhiyun
136*4882a593Smuzhiyun if (rt->stream_state != STREAM_DISABLED) {
137*4882a593Smuzhiyun
138*4882a593Smuzhiyun rt->stream_state = STREAM_STOPPING;
139*4882a593Smuzhiyun
140*4882a593Smuzhiyun for (i = 0; i < PCM_N_URBS; i++) {
141*4882a593Smuzhiyun usb_kill_urb(&rt->in_urbs[i].instance);
142*4882a593Smuzhiyun usb_kill_urb(&rt->out_urbs[i].instance);
143*4882a593Smuzhiyun }
144*4882a593Smuzhiyun ctrl_rt->usb_streaming = false;
145*4882a593Smuzhiyun ctrl_rt->update_streaming(ctrl_rt);
146*4882a593Smuzhiyun rt->stream_state = STREAM_DISABLED;
147*4882a593Smuzhiyun }
148*4882a593Smuzhiyun }
149*4882a593Smuzhiyun
150*4882a593Smuzhiyun /* call with stream_mutex locked */
usb6fire_pcm_stream_start(struct pcm_runtime * rt)151*4882a593Smuzhiyun static int usb6fire_pcm_stream_start(struct pcm_runtime *rt)
152*4882a593Smuzhiyun {
153*4882a593Smuzhiyun int ret;
154*4882a593Smuzhiyun int i;
155*4882a593Smuzhiyun int k;
156*4882a593Smuzhiyun struct usb_iso_packet_descriptor *packet;
157*4882a593Smuzhiyun
158*4882a593Smuzhiyun if (rt->stream_state == STREAM_DISABLED) {
159*4882a593Smuzhiyun /* submit our in urbs */
160*4882a593Smuzhiyun rt->stream_wait_cond = false;
161*4882a593Smuzhiyun rt->stream_state = STREAM_STARTING;
162*4882a593Smuzhiyun for (i = 0; i < PCM_N_URBS; i++) {
163*4882a593Smuzhiyun for (k = 0; k < PCM_N_PACKETS_PER_URB; k++) {
164*4882a593Smuzhiyun packet = &rt->in_urbs[i].packets[k];
165*4882a593Smuzhiyun packet->offset = k * rt->in_packet_size;
166*4882a593Smuzhiyun packet->length = rt->in_packet_size;
167*4882a593Smuzhiyun packet->actual_length = 0;
168*4882a593Smuzhiyun packet->status = 0;
169*4882a593Smuzhiyun }
170*4882a593Smuzhiyun ret = usb_submit_urb(&rt->in_urbs[i].instance,
171*4882a593Smuzhiyun GFP_ATOMIC);
172*4882a593Smuzhiyun if (ret) {
173*4882a593Smuzhiyun usb6fire_pcm_stream_stop(rt);
174*4882a593Smuzhiyun return ret;
175*4882a593Smuzhiyun }
176*4882a593Smuzhiyun }
177*4882a593Smuzhiyun
178*4882a593Smuzhiyun /* wait for first out urb to return (sent in in urb handler) */
179*4882a593Smuzhiyun wait_event_timeout(rt->stream_wait_queue, rt->stream_wait_cond,
180*4882a593Smuzhiyun HZ);
181*4882a593Smuzhiyun if (rt->stream_wait_cond)
182*4882a593Smuzhiyun rt->stream_state = STREAM_RUNNING;
183*4882a593Smuzhiyun else {
184*4882a593Smuzhiyun usb6fire_pcm_stream_stop(rt);
185*4882a593Smuzhiyun return -EIO;
186*4882a593Smuzhiyun }
187*4882a593Smuzhiyun }
188*4882a593Smuzhiyun return 0;
189*4882a593Smuzhiyun }
190*4882a593Smuzhiyun
191*4882a593Smuzhiyun /* call with substream locked */
usb6fire_pcm_capture(struct pcm_substream * sub,struct pcm_urb * urb)192*4882a593Smuzhiyun static void usb6fire_pcm_capture(struct pcm_substream *sub, struct pcm_urb *urb)
193*4882a593Smuzhiyun {
194*4882a593Smuzhiyun int i;
195*4882a593Smuzhiyun int frame;
196*4882a593Smuzhiyun int frame_count;
197*4882a593Smuzhiyun unsigned int total_length = 0;
198*4882a593Smuzhiyun struct pcm_runtime *rt = snd_pcm_substream_chip(sub->instance);
199*4882a593Smuzhiyun struct snd_pcm_runtime *alsa_rt = sub->instance->runtime;
200*4882a593Smuzhiyun u32 *src = NULL;
201*4882a593Smuzhiyun u32 *dest = (u32 *) (alsa_rt->dma_area + sub->dma_off
202*4882a593Smuzhiyun * (alsa_rt->frame_bits >> 3));
203*4882a593Smuzhiyun u32 *dest_end = (u32 *) (alsa_rt->dma_area + alsa_rt->buffer_size
204*4882a593Smuzhiyun * (alsa_rt->frame_bits >> 3));
205*4882a593Smuzhiyun int bytes_per_frame = alsa_rt->channels << 2;
206*4882a593Smuzhiyun
207*4882a593Smuzhiyun for (i = 0; i < PCM_N_PACKETS_PER_URB; i++) {
208*4882a593Smuzhiyun /* at least 4 header bytes for valid packet.
209*4882a593Smuzhiyun * after that: 32 bits per sample for analog channels */
210*4882a593Smuzhiyun if (urb->packets[i].actual_length > 4)
211*4882a593Smuzhiyun frame_count = (urb->packets[i].actual_length - 4)
212*4882a593Smuzhiyun / (rt->in_n_analog << 2);
213*4882a593Smuzhiyun else
214*4882a593Smuzhiyun frame_count = 0;
215*4882a593Smuzhiyun
216*4882a593Smuzhiyun if (alsa_rt->format == SNDRV_PCM_FORMAT_S24_LE)
217*4882a593Smuzhiyun src = (u32 *) (urb->buffer + total_length);
218*4882a593Smuzhiyun else if (alsa_rt->format == SNDRV_PCM_FORMAT_S32_LE)
219*4882a593Smuzhiyun src = (u32 *) (urb->buffer - 1 + total_length);
220*4882a593Smuzhiyun else
221*4882a593Smuzhiyun return;
222*4882a593Smuzhiyun src++; /* skip leading 4 bytes of every packet */
223*4882a593Smuzhiyun total_length += urb->packets[i].length;
224*4882a593Smuzhiyun for (frame = 0; frame < frame_count; frame++) {
225*4882a593Smuzhiyun memcpy(dest, src, bytes_per_frame);
226*4882a593Smuzhiyun dest += alsa_rt->channels;
227*4882a593Smuzhiyun src += rt->in_n_analog;
228*4882a593Smuzhiyun sub->dma_off++;
229*4882a593Smuzhiyun sub->period_off++;
230*4882a593Smuzhiyun if (dest == dest_end) {
231*4882a593Smuzhiyun sub->dma_off = 0;
232*4882a593Smuzhiyun dest = (u32 *) alsa_rt->dma_area;
233*4882a593Smuzhiyun }
234*4882a593Smuzhiyun }
235*4882a593Smuzhiyun }
236*4882a593Smuzhiyun }
237*4882a593Smuzhiyun
238*4882a593Smuzhiyun /* call with substream locked */
usb6fire_pcm_playback(struct pcm_substream * sub,struct pcm_urb * urb)239*4882a593Smuzhiyun static void usb6fire_pcm_playback(struct pcm_substream *sub,
240*4882a593Smuzhiyun struct pcm_urb *urb)
241*4882a593Smuzhiyun {
242*4882a593Smuzhiyun int i;
243*4882a593Smuzhiyun int frame;
244*4882a593Smuzhiyun int frame_count;
245*4882a593Smuzhiyun struct pcm_runtime *rt = snd_pcm_substream_chip(sub->instance);
246*4882a593Smuzhiyun struct snd_pcm_runtime *alsa_rt = sub->instance->runtime;
247*4882a593Smuzhiyun u32 *src = (u32 *) (alsa_rt->dma_area + sub->dma_off
248*4882a593Smuzhiyun * (alsa_rt->frame_bits >> 3));
249*4882a593Smuzhiyun u32 *src_end = (u32 *) (alsa_rt->dma_area + alsa_rt->buffer_size
250*4882a593Smuzhiyun * (alsa_rt->frame_bits >> 3));
251*4882a593Smuzhiyun u32 *dest;
252*4882a593Smuzhiyun int bytes_per_frame = alsa_rt->channels << 2;
253*4882a593Smuzhiyun
254*4882a593Smuzhiyun if (alsa_rt->format == SNDRV_PCM_FORMAT_S32_LE)
255*4882a593Smuzhiyun dest = (u32 *) (urb->buffer - 1);
256*4882a593Smuzhiyun else if (alsa_rt->format == SNDRV_PCM_FORMAT_S24_LE)
257*4882a593Smuzhiyun dest = (u32 *) (urb->buffer);
258*4882a593Smuzhiyun else {
259*4882a593Smuzhiyun dev_err(&rt->chip->dev->dev, "Unknown sample format.");
260*4882a593Smuzhiyun return;
261*4882a593Smuzhiyun }
262*4882a593Smuzhiyun
263*4882a593Smuzhiyun for (i = 0; i < PCM_N_PACKETS_PER_URB; i++) {
264*4882a593Smuzhiyun /* at least 4 header bytes for valid packet.
265*4882a593Smuzhiyun * after that: 32 bits per sample for analog channels */
266*4882a593Smuzhiyun if (urb->packets[i].length > 4)
267*4882a593Smuzhiyun frame_count = (urb->packets[i].length - 4)
268*4882a593Smuzhiyun / (rt->out_n_analog << 2);
269*4882a593Smuzhiyun else
270*4882a593Smuzhiyun frame_count = 0;
271*4882a593Smuzhiyun dest++; /* skip leading 4 bytes of every frame */
272*4882a593Smuzhiyun for (frame = 0; frame < frame_count; frame++) {
273*4882a593Smuzhiyun memcpy(dest, src, bytes_per_frame);
274*4882a593Smuzhiyun src += alsa_rt->channels;
275*4882a593Smuzhiyun dest += rt->out_n_analog;
276*4882a593Smuzhiyun sub->dma_off++;
277*4882a593Smuzhiyun sub->period_off++;
278*4882a593Smuzhiyun if (src == src_end) {
279*4882a593Smuzhiyun src = (u32 *) alsa_rt->dma_area;
280*4882a593Smuzhiyun sub->dma_off = 0;
281*4882a593Smuzhiyun }
282*4882a593Smuzhiyun }
283*4882a593Smuzhiyun }
284*4882a593Smuzhiyun }
285*4882a593Smuzhiyun
usb6fire_pcm_in_urb_handler(struct urb * usb_urb)286*4882a593Smuzhiyun static void usb6fire_pcm_in_urb_handler(struct urb *usb_urb)
287*4882a593Smuzhiyun {
288*4882a593Smuzhiyun struct pcm_urb *in_urb = usb_urb->context;
289*4882a593Smuzhiyun struct pcm_urb *out_urb = in_urb->peer;
290*4882a593Smuzhiyun struct pcm_runtime *rt = in_urb->chip->pcm;
291*4882a593Smuzhiyun struct pcm_substream *sub;
292*4882a593Smuzhiyun unsigned long flags;
293*4882a593Smuzhiyun int total_length = 0;
294*4882a593Smuzhiyun int frame_count;
295*4882a593Smuzhiyun int frame;
296*4882a593Smuzhiyun int channel;
297*4882a593Smuzhiyun int i;
298*4882a593Smuzhiyun u8 *dest;
299*4882a593Smuzhiyun
300*4882a593Smuzhiyun if (usb_urb->status || rt->panic || rt->stream_state == STREAM_STOPPING)
301*4882a593Smuzhiyun return;
302*4882a593Smuzhiyun for (i = 0; i < PCM_N_PACKETS_PER_URB; i++)
303*4882a593Smuzhiyun if (in_urb->packets[i].status) {
304*4882a593Smuzhiyun rt->panic = true;
305*4882a593Smuzhiyun return;
306*4882a593Smuzhiyun }
307*4882a593Smuzhiyun
308*4882a593Smuzhiyun if (rt->stream_state == STREAM_DISABLED) {
309*4882a593Smuzhiyun dev_err(&rt->chip->dev->dev,
310*4882a593Smuzhiyun "internal error: stream disabled in in-urb handler.\n");
311*4882a593Smuzhiyun return;
312*4882a593Smuzhiyun }
313*4882a593Smuzhiyun
314*4882a593Smuzhiyun /* receive our capture data */
315*4882a593Smuzhiyun sub = &rt->capture;
316*4882a593Smuzhiyun spin_lock_irqsave(&sub->lock, flags);
317*4882a593Smuzhiyun if (sub->active) {
318*4882a593Smuzhiyun usb6fire_pcm_capture(sub, in_urb);
319*4882a593Smuzhiyun if (sub->period_off >= sub->instance->runtime->period_size) {
320*4882a593Smuzhiyun sub->period_off %= sub->instance->runtime->period_size;
321*4882a593Smuzhiyun spin_unlock_irqrestore(&sub->lock, flags);
322*4882a593Smuzhiyun snd_pcm_period_elapsed(sub->instance);
323*4882a593Smuzhiyun } else
324*4882a593Smuzhiyun spin_unlock_irqrestore(&sub->lock, flags);
325*4882a593Smuzhiyun } else
326*4882a593Smuzhiyun spin_unlock_irqrestore(&sub->lock, flags);
327*4882a593Smuzhiyun
328*4882a593Smuzhiyun /* setup out urb structure */
329*4882a593Smuzhiyun for (i = 0; i < PCM_N_PACKETS_PER_URB; i++) {
330*4882a593Smuzhiyun out_urb->packets[i].offset = total_length;
331*4882a593Smuzhiyun out_urb->packets[i].length = (in_urb->packets[i].actual_length
332*4882a593Smuzhiyun - 4) / (rt->in_n_analog << 2)
333*4882a593Smuzhiyun * (rt->out_n_analog << 2) + 4;
334*4882a593Smuzhiyun out_urb->packets[i].status = 0;
335*4882a593Smuzhiyun total_length += out_urb->packets[i].length;
336*4882a593Smuzhiyun }
337*4882a593Smuzhiyun memset(out_urb->buffer, 0, total_length);
338*4882a593Smuzhiyun
339*4882a593Smuzhiyun /* now send our playback data (if a free out urb was found) */
340*4882a593Smuzhiyun sub = &rt->playback;
341*4882a593Smuzhiyun spin_lock_irqsave(&sub->lock, flags);
342*4882a593Smuzhiyun if (sub->active) {
343*4882a593Smuzhiyun usb6fire_pcm_playback(sub, out_urb);
344*4882a593Smuzhiyun if (sub->period_off >= sub->instance->runtime->period_size) {
345*4882a593Smuzhiyun sub->period_off %= sub->instance->runtime->period_size;
346*4882a593Smuzhiyun spin_unlock_irqrestore(&sub->lock, flags);
347*4882a593Smuzhiyun snd_pcm_period_elapsed(sub->instance);
348*4882a593Smuzhiyun } else
349*4882a593Smuzhiyun spin_unlock_irqrestore(&sub->lock, flags);
350*4882a593Smuzhiyun } else
351*4882a593Smuzhiyun spin_unlock_irqrestore(&sub->lock, flags);
352*4882a593Smuzhiyun
353*4882a593Smuzhiyun /* setup the 4th byte of each sample (0x40 for analog channels) */
354*4882a593Smuzhiyun dest = out_urb->buffer;
355*4882a593Smuzhiyun for (i = 0; i < PCM_N_PACKETS_PER_URB; i++)
356*4882a593Smuzhiyun if (out_urb->packets[i].length >= 4) {
357*4882a593Smuzhiyun frame_count = (out_urb->packets[i].length - 4)
358*4882a593Smuzhiyun / (rt->out_n_analog << 2);
359*4882a593Smuzhiyun *(dest++) = 0xaa;
360*4882a593Smuzhiyun *(dest++) = 0xaa;
361*4882a593Smuzhiyun *(dest++) = frame_count;
362*4882a593Smuzhiyun *(dest++) = 0x00;
363*4882a593Smuzhiyun for (frame = 0; frame < frame_count; frame++)
364*4882a593Smuzhiyun for (channel = 0;
365*4882a593Smuzhiyun channel < rt->out_n_analog;
366*4882a593Smuzhiyun channel++) {
367*4882a593Smuzhiyun dest += 3; /* skip sample data */
368*4882a593Smuzhiyun *(dest++) = 0x40;
369*4882a593Smuzhiyun }
370*4882a593Smuzhiyun }
371*4882a593Smuzhiyun usb_submit_urb(&out_urb->instance, GFP_ATOMIC);
372*4882a593Smuzhiyun usb_submit_urb(&in_urb->instance, GFP_ATOMIC);
373*4882a593Smuzhiyun }
374*4882a593Smuzhiyun
usb6fire_pcm_out_urb_handler(struct urb * usb_urb)375*4882a593Smuzhiyun static void usb6fire_pcm_out_urb_handler(struct urb *usb_urb)
376*4882a593Smuzhiyun {
377*4882a593Smuzhiyun struct pcm_urb *urb = usb_urb->context;
378*4882a593Smuzhiyun struct pcm_runtime *rt = urb->chip->pcm;
379*4882a593Smuzhiyun
380*4882a593Smuzhiyun if (rt->stream_state == STREAM_STARTING) {
381*4882a593Smuzhiyun rt->stream_wait_cond = true;
382*4882a593Smuzhiyun wake_up(&rt->stream_wait_queue);
383*4882a593Smuzhiyun }
384*4882a593Smuzhiyun }
385*4882a593Smuzhiyun
usb6fire_pcm_open(struct snd_pcm_substream * alsa_sub)386*4882a593Smuzhiyun static int usb6fire_pcm_open(struct snd_pcm_substream *alsa_sub)
387*4882a593Smuzhiyun {
388*4882a593Smuzhiyun struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub);
389*4882a593Smuzhiyun struct pcm_substream *sub = NULL;
390*4882a593Smuzhiyun struct snd_pcm_runtime *alsa_rt = alsa_sub->runtime;
391*4882a593Smuzhiyun
392*4882a593Smuzhiyun if (rt->panic)
393*4882a593Smuzhiyun return -EPIPE;
394*4882a593Smuzhiyun
395*4882a593Smuzhiyun mutex_lock(&rt->stream_mutex);
396*4882a593Smuzhiyun alsa_rt->hw = pcm_hw;
397*4882a593Smuzhiyun
398*4882a593Smuzhiyun if (alsa_sub->stream == SNDRV_PCM_STREAM_PLAYBACK) {
399*4882a593Smuzhiyun if (rt->rate < ARRAY_SIZE(rates))
400*4882a593Smuzhiyun alsa_rt->hw.rates = rates_alsaid[rt->rate];
401*4882a593Smuzhiyun alsa_rt->hw.channels_max = OUT_N_CHANNELS;
402*4882a593Smuzhiyun sub = &rt->playback;
403*4882a593Smuzhiyun } else if (alsa_sub->stream == SNDRV_PCM_STREAM_CAPTURE) {
404*4882a593Smuzhiyun if (rt->rate < ARRAY_SIZE(rates))
405*4882a593Smuzhiyun alsa_rt->hw.rates = rates_alsaid[rt->rate];
406*4882a593Smuzhiyun alsa_rt->hw.channels_max = IN_N_CHANNELS;
407*4882a593Smuzhiyun sub = &rt->capture;
408*4882a593Smuzhiyun }
409*4882a593Smuzhiyun
410*4882a593Smuzhiyun if (!sub) {
411*4882a593Smuzhiyun mutex_unlock(&rt->stream_mutex);
412*4882a593Smuzhiyun dev_err(&rt->chip->dev->dev, "invalid stream type.\n");
413*4882a593Smuzhiyun return -EINVAL;
414*4882a593Smuzhiyun }
415*4882a593Smuzhiyun
416*4882a593Smuzhiyun sub->instance = alsa_sub;
417*4882a593Smuzhiyun sub->active = false;
418*4882a593Smuzhiyun mutex_unlock(&rt->stream_mutex);
419*4882a593Smuzhiyun return 0;
420*4882a593Smuzhiyun }
421*4882a593Smuzhiyun
usb6fire_pcm_close(struct snd_pcm_substream * alsa_sub)422*4882a593Smuzhiyun static int usb6fire_pcm_close(struct snd_pcm_substream *alsa_sub)
423*4882a593Smuzhiyun {
424*4882a593Smuzhiyun struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub);
425*4882a593Smuzhiyun struct pcm_substream *sub = usb6fire_pcm_get_substream(alsa_sub);
426*4882a593Smuzhiyun unsigned long flags;
427*4882a593Smuzhiyun
428*4882a593Smuzhiyun if (rt->panic)
429*4882a593Smuzhiyun return 0;
430*4882a593Smuzhiyun
431*4882a593Smuzhiyun mutex_lock(&rt->stream_mutex);
432*4882a593Smuzhiyun if (sub) {
433*4882a593Smuzhiyun /* deactivate substream */
434*4882a593Smuzhiyun spin_lock_irqsave(&sub->lock, flags);
435*4882a593Smuzhiyun sub->instance = NULL;
436*4882a593Smuzhiyun sub->active = false;
437*4882a593Smuzhiyun spin_unlock_irqrestore(&sub->lock, flags);
438*4882a593Smuzhiyun
439*4882a593Smuzhiyun /* all substreams closed? if so, stop streaming */
440*4882a593Smuzhiyun if (!rt->playback.instance && !rt->capture.instance) {
441*4882a593Smuzhiyun usb6fire_pcm_stream_stop(rt);
442*4882a593Smuzhiyun rt->rate = ARRAY_SIZE(rates);
443*4882a593Smuzhiyun }
444*4882a593Smuzhiyun }
445*4882a593Smuzhiyun mutex_unlock(&rt->stream_mutex);
446*4882a593Smuzhiyun return 0;
447*4882a593Smuzhiyun }
448*4882a593Smuzhiyun
usb6fire_pcm_prepare(struct snd_pcm_substream * alsa_sub)449*4882a593Smuzhiyun static int usb6fire_pcm_prepare(struct snd_pcm_substream *alsa_sub)
450*4882a593Smuzhiyun {
451*4882a593Smuzhiyun struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub);
452*4882a593Smuzhiyun struct pcm_substream *sub = usb6fire_pcm_get_substream(alsa_sub);
453*4882a593Smuzhiyun struct snd_pcm_runtime *alsa_rt = alsa_sub->runtime;
454*4882a593Smuzhiyun int ret;
455*4882a593Smuzhiyun
456*4882a593Smuzhiyun if (rt->panic)
457*4882a593Smuzhiyun return -EPIPE;
458*4882a593Smuzhiyun if (!sub)
459*4882a593Smuzhiyun return -ENODEV;
460*4882a593Smuzhiyun
461*4882a593Smuzhiyun mutex_lock(&rt->stream_mutex);
462*4882a593Smuzhiyun sub->dma_off = 0;
463*4882a593Smuzhiyun sub->period_off = 0;
464*4882a593Smuzhiyun
465*4882a593Smuzhiyun if (rt->stream_state == STREAM_DISABLED) {
466*4882a593Smuzhiyun for (rt->rate = 0; rt->rate < ARRAY_SIZE(rates); rt->rate++)
467*4882a593Smuzhiyun if (alsa_rt->rate == rates[rt->rate])
468*4882a593Smuzhiyun break;
469*4882a593Smuzhiyun if (rt->rate == ARRAY_SIZE(rates)) {
470*4882a593Smuzhiyun mutex_unlock(&rt->stream_mutex);
471*4882a593Smuzhiyun dev_err(&rt->chip->dev->dev,
472*4882a593Smuzhiyun "invalid rate %d in prepare.\n",
473*4882a593Smuzhiyun alsa_rt->rate);
474*4882a593Smuzhiyun return -EINVAL;
475*4882a593Smuzhiyun }
476*4882a593Smuzhiyun
477*4882a593Smuzhiyun ret = usb6fire_pcm_set_rate(rt);
478*4882a593Smuzhiyun if (ret) {
479*4882a593Smuzhiyun mutex_unlock(&rt->stream_mutex);
480*4882a593Smuzhiyun return ret;
481*4882a593Smuzhiyun }
482*4882a593Smuzhiyun ret = usb6fire_pcm_stream_start(rt);
483*4882a593Smuzhiyun if (ret) {
484*4882a593Smuzhiyun mutex_unlock(&rt->stream_mutex);
485*4882a593Smuzhiyun dev_err(&rt->chip->dev->dev,
486*4882a593Smuzhiyun "could not start pcm stream.\n");
487*4882a593Smuzhiyun return ret;
488*4882a593Smuzhiyun }
489*4882a593Smuzhiyun }
490*4882a593Smuzhiyun mutex_unlock(&rt->stream_mutex);
491*4882a593Smuzhiyun return 0;
492*4882a593Smuzhiyun }
493*4882a593Smuzhiyun
usb6fire_pcm_trigger(struct snd_pcm_substream * alsa_sub,int cmd)494*4882a593Smuzhiyun static int usb6fire_pcm_trigger(struct snd_pcm_substream *alsa_sub, int cmd)
495*4882a593Smuzhiyun {
496*4882a593Smuzhiyun struct pcm_substream *sub = usb6fire_pcm_get_substream(alsa_sub);
497*4882a593Smuzhiyun struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub);
498*4882a593Smuzhiyun unsigned long flags;
499*4882a593Smuzhiyun
500*4882a593Smuzhiyun if (rt->panic)
501*4882a593Smuzhiyun return -EPIPE;
502*4882a593Smuzhiyun if (!sub)
503*4882a593Smuzhiyun return -ENODEV;
504*4882a593Smuzhiyun
505*4882a593Smuzhiyun switch (cmd) {
506*4882a593Smuzhiyun case SNDRV_PCM_TRIGGER_START:
507*4882a593Smuzhiyun case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
508*4882a593Smuzhiyun spin_lock_irqsave(&sub->lock, flags);
509*4882a593Smuzhiyun sub->active = true;
510*4882a593Smuzhiyun spin_unlock_irqrestore(&sub->lock, flags);
511*4882a593Smuzhiyun return 0;
512*4882a593Smuzhiyun
513*4882a593Smuzhiyun case SNDRV_PCM_TRIGGER_STOP:
514*4882a593Smuzhiyun case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
515*4882a593Smuzhiyun spin_lock_irqsave(&sub->lock, flags);
516*4882a593Smuzhiyun sub->active = false;
517*4882a593Smuzhiyun spin_unlock_irqrestore(&sub->lock, flags);
518*4882a593Smuzhiyun return 0;
519*4882a593Smuzhiyun
520*4882a593Smuzhiyun default:
521*4882a593Smuzhiyun return -EINVAL;
522*4882a593Smuzhiyun }
523*4882a593Smuzhiyun }
524*4882a593Smuzhiyun
usb6fire_pcm_pointer(struct snd_pcm_substream * alsa_sub)525*4882a593Smuzhiyun static snd_pcm_uframes_t usb6fire_pcm_pointer(
526*4882a593Smuzhiyun struct snd_pcm_substream *alsa_sub)
527*4882a593Smuzhiyun {
528*4882a593Smuzhiyun struct pcm_substream *sub = usb6fire_pcm_get_substream(alsa_sub);
529*4882a593Smuzhiyun struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub);
530*4882a593Smuzhiyun unsigned long flags;
531*4882a593Smuzhiyun snd_pcm_uframes_t ret;
532*4882a593Smuzhiyun
533*4882a593Smuzhiyun if (rt->panic || !sub)
534*4882a593Smuzhiyun return SNDRV_PCM_POS_XRUN;
535*4882a593Smuzhiyun
536*4882a593Smuzhiyun spin_lock_irqsave(&sub->lock, flags);
537*4882a593Smuzhiyun ret = sub->dma_off;
538*4882a593Smuzhiyun spin_unlock_irqrestore(&sub->lock, flags);
539*4882a593Smuzhiyun return ret;
540*4882a593Smuzhiyun }
541*4882a593Smuzhiyun
542*4882a593Smuzhiyun static const struct snd_pcm_ops pcm_ops = {
543*4882a593Smuzhiyun .open = usb6fire_pcm_open,
544*4882a593Smuzhiyun .close = usb6fire_pcm_close,
545*4882a593Smuzhiyun .prepare = usb6fire_pcm_prepare,
546*4882a593Smuzhiyun .trigger = usb6fire_pcm_trigger,
547*4882a593Smuzhiyun .pointer = usb6fire_pcm_pointer,
548*4882a593Smuzhiyun };
549*4882a593Smuzhiyun
usb6fire_pcm_init_urb(struct pcm_urb * urb,struct sfire_chip * chip,bool in,int ep,void (* handler)(struct urb *))550*4882a593Smuzhiyun static void usb6fire_pcm_init_urb(struct pcm_urb *urb,
551*4882a593Smuzhiyun struct sfire_chip *chip, bool in, int ep,
552*4882a593Smuzhiyun void (*handler)(struct urb *))
553*4882a593Smuzhiyun {
554*4882a593Smuzhiyun urb->chip = chip;
555*4882a593Smuzhiyun usb_init_urb(&urb->instance);
556*4882a593Smuzhiyun urb->instance.transfer_buffer = urb->buffer;
557*4882a593Smuzhiyun urb->instance.transfer_buffer_length =
558*4882a593Smuzhiyun PCM_N_PACKETS_PER_URB * PCM_MAX_PACKET_SIZE;
559*4882a593Smuzhiyun urb->instance.dev = chip->dev;
560*4882a593Smuzhiyun urb->instance.pipe = in ? usb_rcvisocpipe(chip->dev, ep)
561*4882a593Smuzhiyun : usb_sndisocpipe(chip->dev, ep);
562*4882a593Smuzhiyun urb->instance.interval = 1;
563*4882a593Smuzhiyun urb->instance.complete = handler;
564*4882a593Smuzhiyun urb->instance.context = urb;
565*4882a593Smuzhiyun urb->instance.number_of_packets = PCM_N_PACKETS_PER_URB;
566*4882a593Smuzhiyun }
567*4882a593Smuzhiyun
usb6fire_pcm_buffers_init(struct pcm_runtime * rt)568*4882a593Smuzhiyun static int usb6fire_pcm_buffers_init(struct pcm_runtime *rt)
569*4882a593Smuzhiyun {
570*4882a593Smuzhiyun int i;
571*4882a593Smuzhiyun
572*4882a593Smuzhiyun for (i = 0; i < PCM_N_URBS; i++) {
573*4882a593Smuzhiyun rt->out_urbs[i].buffer = kcalloc(PCM_MAX_PACKET_SIZE,
574*4882a593Smuzhiyun PCM_N_PACKETS_PER_URB,
575*4882a593Smuzhiyun GFP_KERNEL);
576*4882a593Smuzhiyun if (!rt->out_urbs[i].buffer)
577*4882a593Smuzhiyun return -ENOMEM;
578*4882a593Smuzhiyun rt->in_urbs[i].buffer = kcalloc(PCM_MAX_PACKET_SIZE,
579*4882a593Smuzhiyun PCM_N_PACKETS_PER_URB,
580*4882a593Smuzhiyun GFP_KERNEL);
581*4882a593Smuzhiyun if (!rt->in_urbs[i].buffer)
582*4882a593Smuzhiyun return -ENOMEM;
583*4882a593Smuzhiyun }
584*4882a593Smuzhiyun return 0;
585*4882a593Smuzhiyun }
586*4882a593Smuzhiyun
usb6fire_pcm_buffers_destroy(struct pcm_runtime * rt)587*4882a593Smuzhiyun static void usb6fire_pcm_buffers_destroy(struct pcm_runtime *rt)
588*4882a593Smuzhiyun {
589*4882a593Smuzhiyun int i;
590*4882a593Smuzhiyun
591*4882a593Smuzhiyun for (i = 0; i < PCM_N_URBS; i++) {
592*4882a593Smuzhiyun kfree(rt->out_urbs[i].buffer);
593*4882a593Smuzhiyun kfree(rt->in_urbs[i].buffer);
594*4882a593Smuzhiyun }
595*4882a593Smuzhiyun }
596*4882a593Smuzhiyun
usb6fire_pcm_init(struct sfire_chip * chip)597*4882a593Smuzhiyun int usb6fire_pcm_init(struct sfire_chip *chip)
598*4882a593Smuzhiyun {
599*4882a593Smuzhiyun int i;
600*4882a593Smuzhiyun int ret;
601*4882a593Smuzhiyun struct snd_pcm *pcm;
602*4882a593Smuzhiyun struct pcm_runtime *rt =
603*4882a593Smuzhiyun kzalloc(sizeof(struct pcm_runtime), GFP_KERNEL);
604*4882a593Smuzhiyun
605*4882a593Smuzhiyun if (!rt)
606*4882a593Smuzhiyun return -ENOMEM;
607*4882a593Smuzhiyun
608*4882a593Smuzhiyun ret = usb6fire_pcm_buffers_init(rt);
609*4882a593Smuzhiyun if (ret) {
610*4882a593Smuzhiyun usb6fire_pcm_buffers_destroy(rt);
611*4882a593Smuzhiyun kfree(rt);
612*4882a593Smuzhiyun return ret;
613*4882a593Smuzhiyun }
614*4882a593Smuzhiyun
615*4882a593Smuzhiyun rt->chip = chip;
616*4882a593Smuzhiyun rt->stream_state = STREAM_DISABLED;
617*4882a593Smuzhiyun rt->rate = ARRAY_SIZE(rates);
618*4882a593Smuzhiyun init_waitqueue_head(&rt->stream_wait_queue);
619*4882a593Smuzhiyun mutex_init(&rt->stream_mutex);
620*4882a593Smuzhiyun
621*4882a593Smuzhiyun spin_lock_init(&rt->playback.lock);
622*4882a593Smuzhiyun spin_lock_init(&rt->capture.lock);
623*4882a593Smuzhiyun
624*4882a593Smuzhiyun for (i = 0; i < PCM_N_URBS; i++) {
625*4882a593Smuzhiyun usb6fire_pcm_init_urb(&rt->in_urbs[i], chip, true, IN_EP,
626*4882a593Smuzhiyun usb6fire_pcm_in_urb_handler);
627*4882a593Smuzhiyun usb6fire_pcm_init_urb(&rt->out_urbs[i], chip, false, OUT_EP,
628*4882a593Smuzhiyun usb6fire_pcm_out_urb_handler);
629*4882a593Smuzhiyun
630*4882a593Smuzhiyun rt->in_urbs[i].peer = &rt->out_urbs[i];
631*4882a593Smuzhiyun rt->out_urbs[i].peer = &rt->in_urbs[i];
632*4882a593Smuzhiyun }
633*4882a593Smuzhiyun
634*4882a593Smuzhiyun ret = snd_pcm_new(chip->card, "DMX6FireUSB", 0, 1, 1, &pcm);
635*4882a593Smuzhiyun if (ret < 0) {
636*4882a593Smuzhiyun usb6fire_pcm_buffers_destroy(rt);
637*4882a593Smuzhiyun kfree(rt);
638*4882a593Smuzhiyun dev_err(&chip->dev->dev, "cannot create pcm instance.\n");
639*4882a593Smuzhiyun return ret;
640*4882a593Smuzhiyun }
641*4882a593Smuzhiyun
642*4882a593Smuzhiyun pcm->private_data = rt;
643*4882a593Smuzhiyun strcpy(pcm->name, "DMX 6Fire USB");
644*4882a593Smuzhiyun snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &pcm_ops);
645*4882a593Smuzhiyun snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &pcm_ops);
646*4882a593Smuzhiyun snd_pcm_set_managed_buffer_all(pcm, SNDRV_DMA_TYPE_VMALLOC, NULL, 0, 0);
647*4882a593Smuzhiyun
648*4882a593Smuzhiyun rt->instance = pcm;
649*4882a593Smuzhiyun
650*4882a593Smuzhiyun chip->pcm = rt;
651*4882a593Smuzhiyun return 0;
652*4882a593Smuzhiyun }
653*4882a593Smuzhiyun
usb6fire_pcm_abort(struct sfire_chip * chip)654*4882a593Smuzhiyun void usb6fire_pcm_abort(struct sfire_chip *chip)
655*4882a593Smuzhiyun {
656*4882a593Smuzhiyun struct pcm_runtime *rt = chip->pcm;
657*4882a593Smuzhiyun int i;
658*4882a593Smuzhiyun
659*4882a593Smuzhiyun if (rt) {
660*4882a593Smuzhiyun rt->panic = true;
661*4882a593Smuzhiyun
662*4882a593Smuzhiyun if (rt->playback.instance)
663*4882a593Smuzhiyun snd_pcm_stop_xrun(rt->playback.instance);
664*4882a593Smuzhiyun
665*4882a593Smuzhiyun if (rt->capture.instance)
666*4882a593Smuzhiyun snd_pcm_stop_xrun(rt->capture.instance);
667*4882a593Smuzhiyun
668*4882a593Smuzhiyun for (i = 0; i < PCM_N_URBS; i++) {
669*4882a593Smuzhiyun usb_poison_urb(&rt->in_urbs[i].instance);
670*4882a593Smuzhiyun usb_poison_urb(&rt->out_urbs[i].instance);
671*4882a593Smuzhiyun }
672*4882a593Smuzhiyun
673*4882a593Smuzhiyun }
674*4882a593Smuzhiyun }
675*4882a593Smuzhiyun
usb6fire_pcm_destroy(struct sfire_chip * chip)676*4882a593Smuzhiyun void usb6fire_pcm_destroy(struct sfire_chip *chip)
677*4882a593Smuzhiyun {
678*4882a593Smuzhiyun struct pcm_runtime *rt = chip->pcm;
679*4882a593Smuzhiyun
680*4882a593Smuzhiyun usb6fire_pcm_buffers_destroy(rt);
681*4882a593Smuzhiyun kfree(rt);
682*4882a593Smuzhiyun chip->pcm = NULL;
683*4882a593Smuzhiyun }
684