162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Linux driver for TerraTec DMX 6Fire USB 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * PCM driver 662306a36Sopenharmony_ci * 762306a36Sopenharmony_ci * Author: Torsten Schenk <torsten.schenk@zoho.com> 862306a36Sopenharmony_ci * Created: Jan 01, 2011 962306a36Sopenharmony_ci * Copyright: (C) Torsten Schenk 1062306a36Sopenharmony_ci */ 1162306a36Sopenharmony_ci 1262306a36Sopenharmony_ci#include "pcm.h" 1362306a36Sopenharmony_ci#include "chip.h" 1462306a36Sopenharmony_ci#include "comm.h" 1562306a36Sopenharmony_ci#include "control.h" 1662306a36Sopenharmony_ci 1762306a36Sopenharmony_cienum { 1862306a36Sopenharmony_ci OUT_N_CHANNELS = 6, IN_N_CHANNELS = 4 1962306a36Sopenharmony_ci}; 2062306a36Sopenharmony_ci 2162306a36Sopenharmony_ci/* keep next two synced with 2262306a36Sopenharmony_ci * FW_EP_W_MAX_PACKET_SIZE[] and RATES_MAX_PACKET_SIZE 2362306a36Sopenharmony_ci * and CONTROL_RATE_XXX in control.h */ 2462306a36Sopenharmony_cistatic const int rates_in_packet_size[] = { 228, 228, 420, 420, 404, 404 }; 2562306a36Sopenharmony_cistatic const int rates_out_packet_size[] = { 228, 228, 420, 420, 604, 604 }; 2662306a36Sopenharmony_cistatic const int rates[] = { 44100, 48000, 88200, 96000, 176400, 192000 }; 2762306a36Sopenharmony_cistatic const int rates_alsaid[] = { 2862306a36Sopenharmony_ci SNDRV_PCM_RATE_44100, SNDRV_PCM_RATE_48000, 2962306a36Sopenharmony_ci SNDRV_PCM_RATE_88200, SNDRV_PCM_RATE_96000, 3062306a36Sopenharmony_ci SNDRV_PCM_RATE_176400, SNDRV_PCM_RATE_192000 }; 3162306a36Sopenharmony_ci 3262306a36Sopenharmony_cienum { /* settings for pcm */ 3362306a36Sopenharmony_ci OUT_EP = 6, IN_EP = 2, MAX_BUFSIZE = 128 * 1024 3462306a36Sopenharmony_ci}; 3562306a36Sopenharmony_ci 3662306a36Sopenharmony_cienum { /* pcm streaming states */ 3762306a36Sopenharmony_ci STREAM_DISABLED, /* no pcm streaming */ 3862306a36Sopenharmony_ci STREAM_STARTING, /* pcm streaming requested, waiting to become ready */ 3962306a36Sopenharmony_ci STREAM_RUNNING, /* pcm streaming running */ 4062306a36Sopenharmony_ci STREAM_STOPPING 4162306a36Sopenharmony_ci}; 4262306a36Sopenharmony_ci 4362306a36Sopenharmony_cistatic const struct snd_pcm_hardware pcm_hw = { 4462306a36Sopenharmony_ci .info = SNDRV_PCM_INFO_MMAP | 4562306a36Sopenharmony_ci SNDRV_PCM_INFO_INTERLEAVED | 4662306a36Sopenharmony_ci SNDRV_PCM_INFO_BLOCK_TRANSFER | 4762306a36Sopenharmony_ci SNDRV_PCM_INFO_MMAP_VALID | 4862306a36Sopenharmony_ci SNDRV_PCM_INFO_BATCH, 4962306a36Sopenharmony_ci 5062306a36Sopenharmony_ci .formats = SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE, 5162306a36Sopenharmony_ci 5262306a36Sopenharmony_ci .rates = SNDRV_PCM_RATE_44100 | 5362306a36Sopenharmony_ci SNDRV_PCM_RATE_48000 | 5462306a36Sopenharmony_ci SNDRV_PCM_RATE_88200 | 5562306a36Sopenharmony_ci SNDRV_PCM_RATE_96000 | 5662306a36Sopenharmony_ci SNDRV_PCM_RATE_176400 | 5762306a36Sopenharmony_ci SNDRV_PCM_RATE_192000, 5862306a36Sopenharmony_ci 5962306a36Sopenharmony_ci .rate_min = 44100, 6062306a36Sopenharmony_ci .rate_max = 192000, 6162306a36Sopenharmony_ci .channels_min = 1, 6262306a36Sopenharmony_ci .channels_max = 0, /* set in pcm_open, depending on capture/playback */ 6362306a36Sopenharmony_ci .buffer_bytes_max = MAX_BUFSIZE, 6462306a36Sopenharmony_ci .period_bytes_min = PCM_N_PACKETS_PER_URB * (PCM_MAX_PACKET_SIZE - 4), 6562306a36Sopenharmony_ci .period_bytes_max = MAX_BUFSIZE, 6662306a36Sopenharmony_ci .periods_min = 2, 6762306a36Sopenharmony_ci .periods_max = 1024 6862306a36Sopenharmony_ci}; 6962306a36Sopenharmony_ci 7062306a36Sopenharmony_cistatic int usb6fire_pcm_set_rate(struct pcm_runtime *rt) 7162306a36Sopenharmony_ci{ 7262306a36Sopenharmony_ci int ret; 7362306a36Sopenharmony_ci struct control_runtime *ctrl_rt = rt->chip->control; 7462306a36Sopenharmony_ci 7562306a36Sopenharmony_ci ctrl_rt->usb_streaming = false; 7662306a36Sopenharmony_ci ret = ctrl_rt->update_streaming(ctrl_rt); 7762306a36Sopenharmony_ci if (ret < 0) { 7862306a36Sopenharmony_ci dev_err(&rt->chip->dev->dev, 7962306a36Sopenharmony_ci "error stopping streaming while setting samplerate %d.\n", 8062306a36Sopenharmony_ci rates[rt->rate]); 8162306a36Sopenharmony_ci return ret; 8262306a36Sopenharmony_ci } 8362306a36Sopenharmony_ci 8462306a36Sopenharmony_ci ret = ctrl_rt->set_rate(ctrl_rt, rt->rate); 8562306a36Sopenharmony_ci if (ret < 0) { 8662306a36Sopenharmony_ci dev_err(&rt->chip->dev->dev, 8762306a36Sopenharmony_ci "error setting samplerate %d.\n", 8862306a36Sopenharmony_ci rates[rt->rate]); 8962306a36Sopenharmony_ci return ret; 9062306a36Sopenharmony_ci } 9162306a36Sopenharmony_ci 9262306a36Sopenharmony_ci ret = ctrl_rt->set_channels(ctrl_rt, OUT_N_CHANNELS, IN_N_CHANNELS, 9362306a36Sopenharmony_ci false, false); 9462306a36Sopenharmony_ci if (ret < 0) { 9562306a36Sopenharmony_ci dev_err(&rt->chip->dev->dev, 9662306a36Sopenharmony_ci "error initializing channels while setting samplerate %d.\n", 9762306a36Sopenharmony_ci rates[rt->rate]); 9862306a36Sopenharmony_ci return ret; 9962306a36Sopenharmony_ci } 10062306a36Sopenharmony_ci 10162306a36Sopenharmony_ci ctrl_rt->usb_streaming = true; 10262306a36Sopenharmony_ci ret = ctrl_rt->update_streaming(ctrl_rt); 10362306a36Sopenharmony_ci if (ret < 0) { 10462306a36Sopenharmony_ci dev_err(&rt->chip->dev->dev, 10562306a36Sopenharmony_ci "error starting streaming while setting samplerate %d.\n", 10662306a36Sopenharmony_ci rates[rt->rate]); 10762306a36Sopenharmony_ci return ret; 10862306a36Sopenharmony_ci } 10962306a36Sopenharmony_ci 11062306a36Sopenharmony_ci rt->in_n_analog = IN_N_CHANNELS; 11162306a36Sopenharmony_ci rt->out_n_analog = OUT_N_CHANNELS; 11262306a36Sopenharmony_ci rt->in_packet_size = rates_in_packet_size[rt->rate]; 11362306a36Sopenharmony_ci rt->out_packet_size = rates_out_packet_size[rt->rate]; 11462306a36Sopenharmony_ci return 0; 11562306a36Sopenharmony_ci} 11662306a36Sopenharmony_ci 11762306a36Sopenharmony_cistatic struct pcm_substream *usb6fire_pcm_get_substream( 11862306a36Sopenharmony_ci struct snd_pcm_substream *alsa_sub) 11962306a36Sopenharmony_ci{ 12062306a36Sopenharmony_ci struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub); 12162306a36Sopenharmony_ci 12262306a36Sopenharmony_ci if (alsa_sub->stream == SNDRV_PCM_STREAM_PLAYBACK) 12362306a36Sopenharmony_ci return &rt->playback; 12462306a36Sopenharmony_ci else if (alsa_sub->stream == SNDRV_PCM_STREAM_CAPTURE) 12562306a36Sopenharmony_ci return &rt->capture; 12662306a36Sopenharmony_ci dev_err(&rt->chip->dev->dev, "error getting pcm substream slot.\n"); 12762306a36Sopenharmony_ci return NULL; 12862306a36Sopenharmony_ci} 12962306a36Sopenharmony_ci 13062306a36Sopenharmony_ci/* call with stream_mutex locked */ 13162306a36Sopenharmony_cistatic void usb6fire_pcm_stream_stop(struct pcm_runtime *rt) 13262306a36Sopenharmony_ci{ 13362306a36Sopenharmony_ci int i; 13462306a36Sopenharmony_ci struct control_runtime *ctrl_rt = rt->chip->control; 13562306a36Sopenharmony_ci 13662306a36Sopenharmony_ci if (rt->stream_state != STREAM_DISABLED) { 13762306a36Sopenharmony_ci 13862306a36Sopenharmony_ci rt->stream_state = STREAM_STOPPING; 13962306a36Sopenharmony_ci 14062306a36Sopenharmony_ci for (i = 0; i < PCM_N_URBS; i++) { 14162306a36Sopenharmony_ci usb_kill_urb(&rt->in_urbs[i].instance); 14262306a36Sopenharmony_ci usb_kill_urb(&rt->out_urbs[i].instance); 14362306a36Sopenharmony_ci } 14462306a36Sopenharmony_ci ctrl_rt->usb_streaming = false; 14562306a36Sopenharmony_ci ctrl_rt->update_streaming(ctrl_rt); 14662306a36Sopenharmony_ci rt->stream_state = STREAM_DISABLED; 14762306a36Sopenharmony_ci } 14862306a36Sopenharmony_ci} 14962306a36Sopenharmony_ci 15062306a36Sopenharmony_ci/* call with stream_mutex locked */ 15162306a36Sopenharmony_cistatic int usb6fire_pcm_stream_start(struct pcm_runtime *rt) 15262306a36Sopenharmony_ci{ 15362306a36Sopenharmony_ci int ret; 15462306a36Sopenharmony_ci int i; 15562306a36Sopenharmony_ci int k; 15662306a36Sopenharmony_ci struct usb_iso_packet_descriptor *packet; 15762306a36Sopenharmony_ci 15862306a36Sopenharmony_ci if (rt->stream_state == STREAM_DISABLED) { 15962306a36Sopenharmony_ci /* submit our in urbs */ 16062306a36Sopenharmony_ci rt->stream_wait_cond = false; 16162306a36Sopenharmony_ci rt->stream_state = STREAM_STARTING; 16262306a36Sopenharmony_ci for (i = 0; i < PCM_N_URBS; i++) { 16362306a36Sopenharmony_ci for (k = 0; k < PCM_N_PACKETS_PER_URB; k++) { 16462306a36Sopenharmony_ci packet = &rt->in_urbs[i].packets[k]; 16562306a36Sopenharmony_ci packet->offset = k * rt->in_packet_size; 16662306a36Sopenharmony_ci packet->length = rt->in_packet_size; 16762306a36Sopenharmony_ci packet->actual_length = 0; 16862306a36Sopenharmony_ci packet->status = 0; 16962306a36Sopenharmony_ci } 17062306a36Sopenharmony_ci ret = usb_submit_urb(&rt->in_urbs[i].instance, 17162306a36Sopenharmony_ci GFP_ATOMIC); 17262306a36Sopenharmony_ci if (ret) { 17362306a36Sopenharmony_ci usb6fire_pcm_stream_stop(rt); 17462306a36Sopenharmony_ci return ret; 17562306a36Sopenharmony_ci } 17662306a36Sopenharmony_ci } 17762306a36Sopenharmony_ci 17862306a36Sopenharmony_ci /* wait for first out urb to return (sent in urb handler) */ 17962306a36Sopenharmony_ci wait_event_timeout(rt->stream_wait_queue, rt->stream_wait_cond, 18062306a36Sopenharmony_ci HZ); 18162306a36Sopenharmony_ci if (rt->stream_wait_cond) 18262306a36Sopenharmony_ci rt->stream_state = STREAM_RUNNING; 18362306a36Sopenharmony_ci else { 18462306a36Sopenharmony_ci usb6fire_pcm_stream_stop(rt); 18562306a36Sopenharmony_ci return -EIO; 18662306a36Sopenharmony_ci } 18762306a36Sopenharmony_ci } 18862306a36Sopenharmony_ci return 0; 18962306a36Sopenharmony_ci} 19062306a36Sopenharmony_ci 19162306a36Sopenharmony_ci/* call with substream locked */ 19262306a36Sopenharmony_cistatic void usb6fire_pcm_capture(struct pcm_substream *sub, struct pcm_urb *urb) 19362306a36Sopenharmony_ci{ 19462306a36Sopenharmony_ci int i; 19562306a36Sopenharmony_ci int frame; 19662306a36Sopenharmony_ci int frame_count; 19762306a36Sopenharmony_ci unsigned int total_length = 0; 19862306a36Sopenharmony_ci struct pcm_runtime *rt = snd_pcm_substream_chip(sub->instance); 19962306a36Sopenharmony_ci struct snd_pcm_runtime *alsa_rt = sub->instance->runtime; 20062306a36Sopenharmony_ci u32 *src = NULL; 20162306a36Sopenharmony_ci u32 *dest = (u32 *) (alsa_rt->dma_area + sub->dma_off 20262306a36Sopenharmony_ci * (alsa_rt->frame_bits >> 3)); 20362306a36Sopenharmony_ci u32 *dest_end = (u32 *) (alsa_rt->dma_area + alsa_rt->buffer_size 20462306a36Sopenharmony_ci * (alsa_rt->frame_bits >> 3)); 20562306a36Sopenharmony_ci int bytes_per_frame = alsa_rt->channels << 2; 20662306a36Sopenharmony_ci 20762306a36Sopenharmony_ci for (i = 0; i < PCM_N_PACKETS_PER_URB; i++) { 20862306a36Sopenharmony_ci /* at least 4 header bytes for valid packet. 20962306a36Sopenharmony_ci * after that: 32 bits per sample for analog channels */ 21062306a36Sopenharmony_ci if (urb->packets[i].actual_length > 4) 21162306a36Sopenharmony_ci frame_count = (urb->packets[i].actual_length - 4) 21262306a36Sopenharmony_ci / (rt->in_n_analog << 2); 21362306a36Sopenharmony_ci else 21462306a36Sopenharmony_ci frame_count = 0; 21562306a36Sopenharmony_ci 21662306a36Sopenharmony_ci if (alsa_rt->format == SNDRV_PCM_FORMAT_S24_LE) 21762306a36Sopenharmony_ci src = (u32 *) (urb->buffer + total_length); 21862306a36Sopenharmony_ci else if (alsa_rt->format == SNDRV_PCM_FORMAT_S32_LE) 21962306a36Sopenharmony_ci src = (u32 *) (urb->buffer - 1 + total_length); 22062306a36Sopenharmony_ci else 22162306a36Sopenharmony_ci return; 22262306a36Sopenharmony_ci src++; /* skip leading 4 bytes of every packet */ 22362306a36Sopenharmony_ci total_length += urb->packets[i].length; 22462306a36Sopenharmony_ci for (frame = 0; frame < frame_count; frame++) { 22562306a36Sopenharmony_ci memcpy(dest, src, bytes_per_frame); 22662306a36Sopenharmony_ci dest += alsa_rt->channels; 22762306a36Sopenharmony_ci src += rt->in_n_analog; 22862306a36Sopenharmony_ci sub->dma_off++; 22962306a36Sopenharmony_ci sub->period_off++; 23062306a36Sopenharmony_ci if (dest == dest_end) { 23162306a36Sopenharmony_ci sub->dma_off = 0; 23262306a36Sopenharmony_ci dest = (u32 *) alsa_rt->dma_area; 23362306a36Sopenharmony_ci } 23462306a36Sopenharmony_ci } 23562306a36Sopenharmony_ci } 23662306a36Sopenharmony_ci} 23762306a36Sopenharmony_ci 23862306a36Sopenharmony_ci/* call with substream locked */ 23962306a36Sopenharmony_cistatic void usb6fire_pcm_playback(struct pcm_substream *sub, 24062306a36Sopenharmony_ci struct pcm_urb *urb) 24162306a36Sopenharmony_ci{ 24262306a36Sopenharmony_ci int i; 24362306a36Sopenharmony_ci int frame; 24462306a36Sopenharmony_ci int frame_count; 24562306a36Sopenharmony_ci struct pcm_runtime *rt = snd_pcm_substream_chip(sub->instance); 24662306a36Sopenharmony_ci struct snd_pcm_runtime *alsa_rt = sub->instance->runtime; 24762306a36Sopenharmony_ci u32 *src = (u32 *) (alsa_rt->dma_area + sub->dma_off 24862306a36Sopenharmony_ci * (alsa_rt->frame_bits >> 3)); 24962306a36Sopenharmony_ci u32 *src_end = (u32 *) (alsa_rt->dma_area + alsa_rt->buffer_size 25062306a36Sopenharmony_ci * (alsa_rt->frame_bits >> 3)); 25162306a36Sopenharmony_ci u32 *dest; 25262306a36Sopenharmony_ci int bytes_per_frame = alsa_rt->channels << 2; 25362306a36Sopenharmony_ci 25462306a36Sopenharmony_ci if (alsa_rt->format == SNDRV_PCM_FORMAT_S32_LE) 25562306a36Sopenharmony_ci dest = (u32 *) (urb->buffer - 1); 25662306a36Sopenharmony_ci else if (alsa_rt->format == SNDRV_PCM_FORMAT_S24_LE) 25762306a36Sopenharmony_ci dest = (u32 *) (urb->buffer); 25862306a36Sopenharmony_ci else { 25962306a36Sopenharmony_ci dev_err(&rt->chip->dev->dev, "Unknown sample format."); 26062306a36Sopenharmony_ci return; 26162306a36Sopenharmony_ci } 26262306a36Sopenharmony_ci 26362306a36Sopenharmony_ci for (i = 0; i < PCM_N_PACKETS_PER_URB; i++) { 26462306a36Sopenharmony_ci /* at least 4 header bytes for valid packet. 26562306a36Sopenharmony_ci * after that: 32 bits per sample for analog channels */ 26662306a36Sopenharmony_ci if (urb->packets[i].length > 4) 26762306a36Sopenharmony_ci frame_count = (urb->packets[i].length - 4) 26862306a36Sopenharmony_ci / (rt->out_n_analog << 2); 26962306a36Sopenharmony_ci else 27062306a36Sopenharmony_ci frame_count = 0; 27162306a36Sopenharmony_ci dest++; /* skip leading 4 bytes of every frame */ 27262306a36Sopenharmony_ci for (frame = 0; frame < frame_count; frame++) { 27362306a36Sopenharmony_ci memcpy(dest, src, bytes_per_frame); 27462306a36Sopenharmony_ci src += alsa_rt->channels; 27562306a36Sopenharmony_ci dest += rt->out_n_analog; 27662306a36Sopenharmony_ci sub->dma_off++; 27762306a36Sopenharmony_ci sub->period_off++; 27862306a36Sopenharmony_ci if (src == src_end) { 27962306a36Sopenharmony_ci src = (u32 *) alsa_rt->dma_area; 28062306a36Sopenharmony_ci sub->dma_off = 0; 28162306a36Sopenharmony_ci } 28262306a36Sopenharmony_ci } 28362306a36Sopenharmony_ci } 28462306a36Sopenharmony_ci} 28562306a36Sopenharmony_ci 28662306a36Sopenharmony_cistatic void usb6fire_pcm_in_urb_handler(struct urb *usb_urb) 28762306a36Sopenharmony_ci{ 28862306a36Sopenharmony_ci struct pcm_urb *in_urb = usb_urb->context; 28962306a36Sopenharmony_ci struct pcm_urb *out_urb = in_urb->peer; 29062306a36Sopenharmony_ci struct pcm_runtime *rt = in_urb->chip->pcm; 29162306a36Sopenharmony_ci struct pcm_substream *sub; 29262306a36Sopenharmony_ci unsigned long flags; 29362306a36Sopenharmony_ci int total_length = 0; 29462306a36Sopenharmony_ci int frame_count; 29562306a36Sopenharmony_ci int frame; 29662306a36Sopenharmony_ci int channel; 29762306a36Sopenharmony_ci int i; 29862306a36Sopenharmony_ci u8 *dest; 29962306a36Sopenharmony_ci 30062306a36Sopenharmony_ci if (usb_urb->status || rt->panic || rt->stream_state == STREAM_STOPPING) 30162306a36Sopenharmony_ci return; 30262306a36Sopenharmony_ci for (i = 0; i < PCM_N_PACKETS_PER_URB; i++) 30362306a36Sopenharmony_ci if (in_urb->packets[i].status) { 30462306a36Sopenharmony_ci rt->panic = true; 30562306a36Sopenharmony_ci return; 30662306a36Sopenharmony_ci } 30762306a36Sopenharmony_ci 30862306a36Sopenharmony_ci if (rt->stream_state == STREAM_DISABLED) { 30962306a36Sopenharmony_ci dev_err(&rt->chip->dev->dev, 31062306a36Sopenharmony_ci "internal error: stream disabled in in-urb handler.\n"); 31162306a36Sopenharmony_ci return; 31262306a36Sopenharmony_ci } 31362306a36Sopenharmony_ci 31462306a36Sopenharmony_ci /* receive our capture data */ 31562306a36Sopenharmony_ci sub = &rt->capture; 31662306a36Sopenharmony_ci spin_lock_irqsave(&sub->lock, flags); 31762306a36Sopenharmony_ci if (sub->active) { 31862306a36Sopenharmony_ci usb6fire_pcm_capture(sub, in_urb); 31962306a36Sopenharmony_ci if (sub->period_off >= sub->instance->runtime->period_size) { 32062306a36Sopenharmony_ci sub->period_off %= sub->instance->runtime->period_size; 32162306a36Sopenharmony_ci spin_unlock_irqrestore(&sub->lock, flags); 32262306a36Sopenharmony_ci snd_pcm_period_elapsed(sub->instance); 32362306a36Sopenharmony_ci } else 32462306a36Sopenharmony_ci spin_unlock_irqrestore(&sub->lock, flags); 32562306a36Sopenharmony_ci } else 32662306a36Sopenharmony_ci spin_unlock_irqrestore(&sub->lock, flags); 32762306a36Sopenharmony_ci 32862306a36Sopenharmony_ci /* setup out urb structure */ 32962306a36Sopenharmony_ci for (i = 0; i < PCM_N_PACKETS_PER_URB; i++) { 33062306a36Sopenharmony_ci out_urb->packets[i].offset = total_length; 33162306a36Sopenharmony_ci out_urb->packets[i].length = (in_urb->packets[i].actual_length 33262306a36Sopenharmony_ci - 4) / (rt->in_n_analog << 2) 33362306a36Sopenharmony_ci * (rt->out_n_analog << 2) + 4; 33462306a36Sopenharmony_ci out_urb->packets[i].status = 0; 33562306a36Sopenharmony_ci total_length += out_urb->packets[i].length; 33662306a36Sopenharmony_ci } 33762306a36Sopenharmony_ci memset(out_urb->buffer, 0, total_length); 33862306a36Sopenharmony_ci 33962306a36Sopenharmony_ci /* now send our playback data (if a free out urb was found) */ 34062306a36Sopenharmony_ci sub = &rt->playback; 34162306a36Sopenharmony_ci spin_lock_irqsave(&sub->lock, flags); 34262306a36Sopenharmony_ci if (sub->active) { 34362306a36Sopenharmony_ci usb6fire_pcm_playback(sub, out_urb); 34462306a36Sopenharmony_ci if (sub->period_off >= sub->instance->runtime->period_size) { 34562306a36Sopenharmony_ci sub->period_off %= sub->instance->runtime->period_size; 34662306a36Sopenharmony_ci spin_unlock_irqrestore(&sub->lock, flags); 34762306a36Sopenharmony_ci snd_pcm_period_elapsed(sub->instance); 34862306a36Sopenharmony_ci } else 34962306a36Sopenharmony_ci spin_unlock_irqrestore(&sub->lock, flags); 35062306a36Sopenharmony_ci } else 35162306a36Sopenharmony_ci spin_unlock_irqrestore(&sub->lock, flags); 35262306a36Sopenharmony_ci 35362306a36Sopenharmony_ci /* setup the 4th byte of each sample (0x40 for analog channels) */ 35462306a36Sopenharmony_ci dest = out_urb->buffer; 35562306a36Sopenharmony_ci for (i = 0; i < PCM_N_PACKETS_PER_URB; i++) 35662306a36Sopenharmony_ci if (out_urb->packets[i].length >= 4) { 35762306a36Sopenharmony_ci frame_count = (out_urb->packets[i].length - 4) 35862306a36Sopenharmony_ci / (rt->out_n_analog << 2); 35962306a36Sopenharmony_ci *(dest++) = 0xaa; 36062306a36Sopenharmony_ci *(dest++) = 0xaa; 36162306a36Sopenharmony_ci *(dest++) = frame_count; 36262306a36Sopenharmony_ci *(dest++) = 0x00; 36362306a36Sopenharmony_ci for (frame = 0; frame < frame_count; frame++) 36462306a36Sopenharmony_ci for (channel = 0; 36562306a36Sopenharmony_ci channel < rt->out_n_analog; 36662306a36Sopenharmony_ci channel++) { 36762306a36Sopenharmony_ci dest += 3; /* skip sample data */ 36862306a36Sopenharmony_ci *(dest++) = 0x40; 36962306a36Sopenharmony_ci } 37062306a36Sopenharmony_ci } 37162306a36Sopenharmony_ci usb_submit_urb(&out_urb->instance, GFP_ATOMIC); 37262306a36Sopenharmony_ci usb_submit_urb(&in_urb->instance, GFP_ATOMIC); 37362306a36Sopenharmony_ci} 37462306a36Sopenharmony_ci 37562306a36Sopenharmony_cistatic void usb6fire_pcm_out_urb_handler(struct urb *usb_urb) 37662306a36Sopenharmony_ci{ 37762306a36Sopenharmony_ci struct pcm_urb *urb = usb_urb->context; 37862306a36Sopenharmony_ci struct pcm_runtime *rt = urb->chip->pcm; 37962306a36Sopenharmony_ci 38062306a36Sopenharmony_ci if (rt->stream_state == STREAM_STARTING) { 38162306a36Sopenharmony_ci rt->stream_wait_cond = true; 38262306a36Sopenharmony_ci wake_up(&rt->stream_wait_queue); 38362306a36Sopenharmony_ci } 38462306a36Sopenharmony_ci} 38562306a36Sopenharmony_ci 38662306a36Sopenharmony_cistatic int usb6fire_pcm_open(struct snd_pcm_substream *alsa_sub) 38762306a36Sopenharmony_ci{ 38862306a36Sopenharmony_ci struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub); 38962306a36Sopenharmony_ci struct pcm_substream *sub = NULL; 39062306a36Sopenharmony_ci struct snd_pcm_runtime *alsa_rt = alsa_sub->runtime; 39162306a36Sopenharmony_ci 39262306a36Sopenharmony_ci if (rt->panic) 39362306a36Sopenharmony_ci return -EPIPE; 39462306a36Sopenharmony_ci 39562306a36Sopenharmony_ci mutex_lock(&rt->stream_mutex); 39662306a36Sopenharmony_ci alsa_rt->hw = pcm_hw; 39762306a36Sopenharmony_ci 39862306a36Sopenharmony_ci if (alsa_sub->stream == SNDRV_PCM_STREAM_PLAYBACK) { 39962306a36Sopenharmony_ci if (rt->rate < ARRAY_SIZE(rates)) 40062306a36Sopenharmony_ci alsa_rt->hw.rates = rates_alsaid[rt->rate]; 40162306a36Sopenharmony_ci alsa_rt->hw.channels_max = OUT_N_CHANNELS; 40262306a36Sopenharmony_ci sub = &rt->playback; 40362306a36Sopenharmony_ci } else if (alsa_sub->stream == SNDRV_PCM_STREAM_CAPTURE) { 40462306a36Sopenharmony_ci if (rt->rate < ARRAY_SIZE(rates)) 40562306a36Sopenharmony_ci alsa_rt->hw.rates = rates_alsaid[rt->rate]; 40662306a36Sopenharmony_ci alsa_rt->hw.channels_max = IN_N_CHANNELS; 40762306a36Sopenharmony_ci sub = &rt->capture; 40862306a36Sopenharmony_ci } 40962306a36Sopenharmony_ci 41062306a36Sopenharmony_ci if (!sub) { 41162306a36Sopenharmony_ci mutex_unlock(&rt->stream_mutex); 41262306a36Sopenharmony_ci dev_err(&rt->chip->dev->dev, "invalid stream type.\n"); 41362306a36Sopenharmony_ci return -EINVAL; 41462306a36Sopenharmony_ci } 41562306a36Sopenharmony_ci 41662306a36Sopenharmony_ci sub->instance = alsa_sub; 41762306a36Sopenharmony_ci sub->active = false; 41862306a36Sopenharmony_ci mutex_unlock(&rt->stream_mutex); 41962306a36Sopenharmony_ci return 0; 42062306a36Sopenharmony_ci} 42162306a36Sopenharmony_ci 42262306a36Sopenharmony_cistatic int usb6fire_pcm_close(struct snd_pcm_substream *alsa_sub) 42362306a36Sopenharmony_ci{ 42462306a36Sopenharmony_ci struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub); 42562306a36Sopenharmony_ci struct pcm_substream *sub = usb6fire_pcm_get_substream(alsa_sub); 42662306a36Sopenharmony_ci unsigned long flags; 42762306a36Sopenharmony_ci 42862306a36Sopenharmony_ci if (rt->panic) 42962306a36Sopenharmony_ci return 0; 43062306a36Sopenharmony_ci 43162306a36Sopenharmony_ci mutex_lock(&rt->stream_mutex); 43262306a36Sopenharmony_ci if (sub) { 43362306a36Sopenharmony_ci /* deactivate substream */ 43462306a36Sopenharmony_ci spin_lock_irqsave(&sub->lock, flags); 43562306a36Sopenharmony_ci sub->instance = NULL; 43662306a36Sopenharmony_ci sub->active = false; 43762306a36Sopenharmony_ci spin_unlock_irqrestore(&sub->lock, flags); 43862306a36Sopenharmony_ci 43962306a36Sopenharmony_ci /* all substreams closed? if so, stop streaming */ 44062306a36Sopenharmony_ci if (!rt->playback.instance && !rt->capture.instance) { 44162306a36Sopenharmony_ci usb6fire_pcm_stream_stop(rt); 44262306a36Sopenharmony_ci rt->rate = ARRAY_SIZE(rates); 44362306a36Sopenharmony_ci } 44462306a36Sopenharmony_ci } 44562306a36Sopenharmony_ci mutex_unlock(&rt->stream_mutex); 44662306a36Sopenharmony_ci return 0; 44762306a36Sopenharmony_ci} 44862306a36Sopenharmony_ci 44962306a36Sopenharmony_cistatic int usb6fire_pcm_prepare(struct snd_pcm_substream *alsa_sub) 45062306a36Sopenharmony_ci{ 45162306a36Sopenharmony_ci struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub); 45262306a36Sopenharmony_ci struct pcm_substream *sub = usb6fire_pcm_get_substream(alsa_sub); 45362306a36Sopenharmony_ci struct snd_pcm_runtime *alsa_rt = alsa_sub->runtime; 45462306a36Sopenharmony_ci int ret; 45562306a36Sopenharmony_ci 45662306a36Sopenharmony_ci if (rt->panic) 45762306a36Sopenharmony_ci return -EPIPE; 45862306a36Sopenharmony_ci if (!sub) 45962306a36Sopenharmony_ci return -ENODEV; 46062306a36Sopenharmony_ci 46162306a36Sopenharmony_ci mutex_lock(&rt->stream_mutex); 46262306a36Sopenharmony_ci sub->dma_off = 0; 46362306a36Sopenharmony_ci sub->period_off = 0; 46462306a36Sopenharmony_ci 46562306a36Sopenharmony_ci if (rt->stream_state == STREAM_DISABLED) { 46662306a36Sopenharmony_ci for (rt->rate = 0; rt->rate < ARRAY_SIZE(rates); rt->rate++) 46762306a36Sopenharmony_ci if (alsa_rt->rate == rates[rt->rate]) 46862306a36Sopenharmony_ci break; 46962306a36Sopenharmony_ci if (rt->rate == ARRAY_SIZE(rates)) { 47062306a36Sopenharmony_ci mutex_unlock(&rt->stream_mutex); 47162306a36Sopenharmony_ci dev_err(&rt->chip->dev->dev, 47262306a36Sopenharmony_ci "invalid rate %d in prepare.\n", 47362306a36Sopenharmony_ci alsa_rt->rate); 47462306a36Sopenharmony_ci return -EINVAL; 47562306a36Sopenharmony_ci } 47662306a36Sopenharmony_ci 47762306a36Sopenharmony_ci ret = usb6fire_pcm_set_rate(rt); 47862306a36Sopenharmony_ci if (ret) { 47962306a36Sopenharmony_ci mutex_unlock(&rt->stream_mutex); 48062306a36Sopenharmony_ci return ret; 48162306a36Sopenharmony_ci } 48262306a36Sopenharmony_ci ret = usb6fire_pcm_stream_start(rt); 48362306a36Sopenharmony_ci if (ret) { 48462306a36Sopenharmony_ci mutex_unlock(&rt->stream_mutex); 48562306a36Sopenharmony_ci dev_err(&rt->chip->dev->dev, 48662306a36Sopenharmony_ci "could not start pcm stream.\n"); 48762306a36Sopenharmony_ci return ret; 48862306a36Sopenharmony_ci } 48962306a36Sopenharmony_ci } 49062306a36Sopenharmony_ci mutex_unlock(&rt->stream_mutex); 49162306a36Sopenharmony_ci return 0; 49262306a36Sopenharmony_ci} 49362306a36Sopenharmony_ci 49462306a36Sopenharmony_cistatic int usb6fire_pcm_trigger(struct snd_pcm_substream *alsa_sub, int cmd) 49562306a36Sopenharmony_ci{ 49662306a36Sopenharmony_ci struct pcm_substream *sub = usb6fire_pcm_get_substream(alsa_sub); 49762306a36Sopenharmony_ci struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub); 49862306a36Sopenharmony_ci unsigned long flags; 49962306a36Sopenharmony_ci 50062306a36Sopenharmony_ci if (rt->panic) 50162306a36Sopenharmony_ci return -EPIPE; 50262306a36Sopenharmony_ci if (!sub) 50362306a36Sopenharmony_ci return -ENODEV; 50462306a36Sopenharmony_ci 50562306a36Sopenharmony_ci switch (cmd) { 50662306a36Sopenharmony_ci case SNDRV_PCM_TRIGGER_START: 50762306a36Sopenharmony_ci case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 50862306a36Sopenharmony_ci spin_lock_irqsave(&sub->lock, flags); 50962306a36Sopenharmony_ci sub->active = true; 51062306a36Sopenharmony_ci spin_unlock_irqrestore(&sub->lock, flags); 51162306a36Sopenharmony_ci return 0; 51262306a36Sopenharmony_ci 51362306a36Sopenharmony_ci case SNDRV_PCM_TRIGGER_STOP: 51462306a36Sopenharmony_ci case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 51562306a36Sopenharmony_ci spin_lock_irqsave(&sub->lock, flags); 51662306a36Sopenharmony_ci sub->active = false; 51762306a36Sopenharmony_ci spin_unlock_irqrestore(&sub->lock, flags); 51862306a36Sopenharmony_ci return 0; 51962306a36Sopenharmony_ci 52062306a36Sopenharmony_ci default: 52162306a36Sopenharmony_ci return -EINVAL; 52262306a36Sopenharmony_ci } 52362306a36Sopenharmony_ci} 52462306a36Sopenharmony_ci 52562306a36Sopenharmony_cistatic snd_pcm_uframes_t usb6fire_pcm_pointer( 52662306a36Sopenharmony_ci struct snd_pcm_substream *alsa_sub) 52762306a36Sopenharmony_ci{ 52862306a36Sopenharmony_ci struct pcm_substream *sub = usb6fire_pcm_get_substream(alsa_sub); 52962306a36Sopenharmony_ci struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub); 53062306a36Sopenharmony_ci unsigned long flags; 53162306a36Sopenharmony_ci snd_pcm_uframes_t ret; 53262306a36Sopenharmony_ci 53362306a36Sopenharmony_ci if (rt->panic || !sub) 53462306a36Sopenharmony_ci return SNDRV_PCM_POS_XRUN; 53562306a36Sopenharmony_ci 53662306a36Sopenharmony_ci spin_lock_irqsave(&sub->lock, flags); 53762306a36Sopenharmony_ci ret = sub->dma_off; 53862306a36Sopenharmony_ci spin_unlock_irqrestore(&sub->lock, flags); 53962306a36Sopenharmony_ci return ret; 54062306a36Sopenharmony_ci} 54162306a36Sopenharmony_ci 54262306a36Sopenharmony_cistatic const struct snd_pcm_ops pcm_ops = { 54362306a36Sopenharmony_ci .open = usb6fire_pcm_open, 54462306a36Sopenharmony_ci .close = usb6fire_pcm_close, 54562306a36Sopenharmony_ci .prepare = usb6fire_pcm_prepare, 54662306a36Sopenharmony_ci .trigger = usb6fire_pcm_trigger, 54762306a36Sopenharmony_ci .pointer = usb6fire_pcm_pointer, 54862306a36Sopenharmony_ci}; 54962306a36Sopenharmony_ci 55062306a36Sopenharmony_cistatic void usb6fire_pcm_init_urb(struct pcm_urb *urb, 55162306a36Sopenharmony_ci struct sfire_chip *chip, bool in, int ep, 55262306a36Sopenharmony_ci void (*handler)(struct urb *)) 55362306a36Sopenharmony_ci{ 55462306a36Sopenharmony_ci urb->chip = chip; 55562306a36Sopenharmony_ci usb_init_urb(&urb->instance); 55662306a36Sopenharmony_ci urb->instance.transfer_buffer = urb->buffer; 55762306a36Sopenharmony_ci urb->instance.transfer_buffer_length = 55862306a36Sopenharmony_ci PCM_N_PACKETS_PER_URB * PCM_MAX_PACKET_SIZE; 55962306a36Sopenharmony_ci urb->instance.dev = chip->dev; 56062306a36Sopenharmony_ci urb->instance.pipe = in ? usb_rcvisocpipe(chip->dev, ep) 56162306a36Sopenharmony_ci : usb_sndisocpipe(chip->dev, ep); 56262306a36Sopenharmony_ci urb->instance.interval = 1; 56362306a36Sopenharmony_ci urb->instance.complete = handler; 56462306a36Sopenharmony_ci urb->instance.context = urb; 56562306a36Sopenharmony_ci urb->instance.number_of_packets = PCM_N_PACKETS_PER_URB; 56662306a36Sopenharmony_ci} 56762306a36Sopenharmony_ci 56862306a36Sopenharmony_cistatic int usb6fire_pcm_buffers_init(struct pcm_runtime *rt) 56962306a36Sopenharmony_ci{ 57062306a36Sopenharmony_ci int i; 57162306a36Sopenharmony_ci 57262306a36Sopenharmony_ci for (i = 0; i < PCM_N_URBS; i++) { 57362306a36Sopenharmony_ci rt->out_urbs[i].buffer = kcalloc(PCM_MAX_PACKET_SIZE, 57462306a36Sopenharmony_ci PCM_N_PACKETS_PER_URB, 57562306a36Sopenharmony_ci GFP_KERNEL); 57662306a36Sopenharmony_ci if (!rt->out_urbs[i].buffer) 57762306a36Sopenharmony_ci return -ENOMEM; 57862306a36Sopenharmony_ci rt->in_urbs[i].buffer = kcalloc(PCM_MAX_PACKET_SIZE, 57962306a36Sopenharmony_ci PCM_N_PACKETS_PER_URB, 58062306a36Sopenharmony_ci GFP_KERNEL); 58162306a36Sopenharmony_ci if (!rt->in_urbs[i].buffer) 58262306a36Sopenharmony_ci return -ENOMEM; 58362306a36Sopenharmony_ci } 58462306a36Sopenharmony_ci return 0; 58562306a36Sopenharmony_ci} 58662306a36Sopenharmony_ci 58762306a36Sopenharmony_cistatic void usb6fire_pcm_buffers_destroy(struct pcm_runtime *rt) 58862306a36Sopenharmony_ci{ 58962306a36Sopenharmony_ci int i; 59062306a36Sopenharmony_ci 59162306a36Sopenharmony_ci for (i = 0; i < PCM_N_URBS; i++) { 59262306a36Sopenharmony_ci kfree(rt->out_urbs[i].buffer); 59362306a36Sopenharmony_ci kfree(rt->in_urbs[i].buffer); 59462306a36Sopenharmony_ci } 59562306a36Sopenharmony_ci} 59662306a36Sopenharmony_ci 59762306a36Sopenharmony_ciint usb6fire_pcm_init(struct sfire_chip *chip) 59862306a36Sopenharmony_ci{ 59962306a36Sopenharmony_ci int i; 60062306a36Sopenharmony_ci int ret; 60162306a36Sopenharmony_ci struct snd_pcm *pcm; 60262306a36Sopenharmony_ci struct pcm_runtime *rt = 60362306a36Sopenharmony_ci kzalloc(sizeof(struct pcm_runtime), GFP_KERNEL); 60462306a36Sopenharmony_ci 60562306a36Sopenharmony_ci if (!rt) 60662306a36Sopenharmony_ci return -ENOMEM; 60762306a36Sopenharmony_ci 60862306a36Sopenharmony_ci ret = usb6fire_pcm_buffers_init(rt); 60962306a36Sopenharmony_ci if (ret) { 61062306a36Sopenharmony_ci usb6fire_pcm_buffers_destroy(rt); 61162306a36Sopenharmony_ci kfree(rt); 61262306a36Sopenharmony_ci return ret; 61362306a36Sopenharmony_ci } 61462306a36Sopenharmony_ci 61562306a36Sopenharmony_ci rt->chip = chip; 61662306a36Sopenharmony_ci rt->stream_state = STREAM_DISABLED; 61762306a36Sopenharmony_ci rt->rate = ARRAY_SIZE(rates); 61862306a36Sopenharmony_ci init_waitqueue_head(&rt->stream_wait_queue); 61962306a36Sopenharmony_ci mutex_init(&rt->stream_mutex); 62062306a36Sopenharmony_ci 62162306a36Sopenharmony_ci spin_lock_init(&rt->playback.lock); 62262306a36Sopenharmony_ci spin_lock_init(&rt->capture.lock); 62362306a36Sopenharmony_ci 62462306a36Sopenharmony_ci for (i = 0; i < PCM_N_URBS; i++) { 62562306a36Sopenharmony_ci usb6fire_pcm_init_urb(&rt->in_urbs[i], chip, true, IN_EP, 62662306a36Sopenharmony_ci usb6fire_pcm_in_urb_handler); 62762306a36Sopenharmony_ci usb6fire_pcm_init_urb(&rt->out_urbs[i], chip, false, OUT_EP, 62862306a36Sopenharmony_ci usb6fire_pcm_out_urb_handler); 62962306a36Sopenharmony_ci 63062306a36Sopenharmony_ci rt->in_urbs[i].peer = &rt->out_urbs[i]; 63162306a36Sopenharmony_ci rt->out_urbs[i].peer = &rt->in_urbs[i]; 63262306a36Sopenharmony_ci } 63362306a36Sopenharmony_ci 63462306a36Sopenharmony_ci ret = snd_pcm_new(chip->card, "DMX6FireUSB", 0, 1, 1, &pcm); 63562306a36Sopenharmony_ci if (ret < 0) { 63662306a36Sopenharmony_ci usb6fire_pcm_buffers_destroy(rt); 63762306a36Sopenharmony_ci kfree(rt); 63862306a36Sopenharmony_ci dev_err(&chip->dev->dev, "cannot create pcm instance.\n"); 63962306a36Sopenharmony_ci return ret; 64062306a36Sopenharmony_ci } 64162306a36Sopenharmony_ci 64262306a36Sopenharmony_ci pcm->private_data = rt; 64362306a36Sopenharmony_ci strcpy(pcm->name, "DMX 6Fire USB"); 64462306a36Sopenharmony_ci snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &pcm_ops); 64562306a36Sopenharmony_ci snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &pcm_ops); 64662306a36Sopenharmony_ci snd_pcm_set_managed_buffer_all(pcm, SNDRV_DMA_TYPE_VMALLOC, NULL, 0, 0); 64762306a36Sopenharmony_ci 64862306a36Sopenharmony_ci rt->instance = pcm; 64962306a36Sopenharmony_ci 65062306a36Sopenharmony_ci chip->pcm = rt; 65162306a36Sopenharmony_ci return 0; 65262306a36Sopenharmony_ci} 65362306a36Sopenharmony_ci 65462306a36Sopenharmony_civoid usb6fire_pcm_abort(struct sfire_chip *chip) 65562306a36Sopenharmony_ci{ 65662306a36Sopenharmony_ci struct pcm_runtime *rt = chip->pcm; 65762306a36Sopenharmony_ci int i; 65862306a36Sopenharmony_ci 65962306a36Sopenharmony_ci if (rt) { 66062306a36Sopenharmony_ci rt->panic = true; 66162306a36Sopenharmony_ci 66262306a36Sopenharmony_ci if (rt->playback.instance) 66362306a36Sopenharmony_ci snd_pcm_stop_xrun(rt->playback.instance); 66462306a36Sopenharmony_ci 66562306a36Sopenharmony_ci if (rt->capture.instance) 66662306a36Sopenharmony_ci snd_pcm_stop_xrun(rt->capture.instance); 66762306a36Sopenharmony_ci 66862306a36Sopenharmony_ci for (i = 0; i < PCM_N_URBS; i++) { 66962306a36Sopenharmony_ci usb_poison_urb(&rt->in_urbs[i].instance); 67062306a36Sopenharmony_ci usb_poison_urb(&rt->out_urbs[i].instance); 67162306a36Sopenharmony_ci } 67262306a36Sopenharmony_ci 67362306a36Sopenharmony_ci } 67462306a36Sopenharmony_ci} 67562306a36Sopenharmony_ci 67662306a36Sopenharmony_civoid usb6fire_pcm_destroy(struct sfire_chip *chip) 67762306a36Sopenharmony_ci{ 67862306a36Sopenharmony_ci struct pcm_runtime *rt = chip->pcm; 67962306a36Sopenharmony_ci 68062306a36Sopenharmony_ci usb6fire_pcm_buffers_destroy(rt); 68162306a36Sopenharmony_ci kfree(rt); 68262306a36Sopenharmony_ci chip->pcm = NULL; 68362306a36Sopenharmony_ci} 684