/* * Linux driver for TerraTec DMX 6Fire USB * * PCM driver * * Author: Torsten Schenk <torsten.schenk@zoho.com> * Created: Jan 01, 2011 * Copyright: (C) Torsten Schenk * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. */ #include "pcm.h" #include "chip.h" #include "comm.h" #include "control.h" enum { OUT_N_CHANNELS = 6, IN_N_CHANNELS = 4 }; /* keep next two synced with * FW_EP_W_MAX_PACKET_SIZE[] and RATES_MAX_PACKET_SIZE * and CONTROL_RATE_XXX in control.h */ static const int rates_in_packet_size[] = { 228, 228, 420, 420, 404, 404 }; static const int rates_out_packet_size[] = { 228, 228, 420, 420, 604, 604 }; static const int rates[] = { 44100, 48000, 88200, 96000, 176400, 192000 }; static const int rates_alsaid[] = { SNDRV_PCM_RATE_44100, SNDRV_PCM_RATE_48000, SNDRV_PCM_RATE_88200, SNDRV_PCM_RATE_96000, SNDRV_PCM_RATE_176400, SNDRV_PCM_RATE_192000 }; enum { /* settings for pcm */ OUT_EP = 6, IN_EP = 2, MAX_BUFSIZE = 128 * 1024 }; enum { /* pcm streaming states */ STREAM_DISABLED, /* no pcm streaming */ STREAM_STARTING, /* pcm streaming requested, waiting to become ready */ STREAM_RUNNING, /* pcm streaming running */ STREAM_STOPPING }; static const struct snd_pcm_hardware pcm_hw = { .info = SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED | SNDRV_PCM_INFO_BLOCK_TRANSFER | SNDRV_PCM_INFO_MMAP_VALID | SNDRV_PCM_INFO_BATCH, .formats = SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE, .rates = SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 | SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_192000, .rate_min = 44100, .rate_max = 192000, .channels_min = 1, .channels_max = 0, /* set in pcm_open, depending on capture/playback */ .buffer_bytes_max = MAX_BUFSIZE, .period_bytes_min = PCM_N_PACKETS_PER_URB * (PCM_MAX_PACKET_SIZE - 4), .period_bytes_max = MAX_BUFSIZE, .periods_min = 2, .periods_max = 1024 }; static int usb6fire_pcm_set_rate(struct pcm_runtime *rt) { int ret; struct control_runtime *ctrl_rt = rt->chip->control; ctrl_rt->usb_streaming = false; ret = ctrl_rt->update_streaming(ctrl_rt); if (ret < 0) { dev_err(&rt->chip->dev->dev, "error stopping streaming while setting samplerate %d.\n", rates[rt->rate]); return ret; } ret = ctrl_rt->set_rate(ctrl_rt, rt->rate); if (ret < 0) { dev_err(&rt->chip->dev->dev, "error setting samplerate %d.\n", rates[rt->rate]); return ret; } ret = ctrl_rt->set_channels(ctrl_rt, OUT_N_CHANNELS, IN_N_CHANNELS, false, false); if (ret < 0) { dev_err(&rt->chip->dev->dev, "error initializing channels while setting samplerate %d.\n", rates[rt->rate]); return ret; } ctrl_rt->usb_streaming = true; ret = ctrl_rt->update_streaming(ctrl_rt); if (ret < 0) { dev_err(&rt->chip->dev->dev, "error starting streaming while setting samplerate %d.\n", rates[rt->rate]); return ret; } rt->in_n_analog = IN_N_CHANNELS; rt->out_n_analog = OUT_N_CHANNELS; rt->in_packet_size = rates_in_packet_size[rt->rate]; rt->out_packet_size = rates_out_packet_size[rt->rate]; return 0; } static struct pcm_substream *usb6fire_pcm_get_substream( struct snd_pcm_substream *alsa_sub) { struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub); if (alsa_sub->stream == SNDRV_PCM_STREAM_PLAYBACK) return &rt->playback; else if (alsa_sub->stream == SNDRV_PCM_STREAM_CAPTURE) return &rt->capture; dev_err(&rt->chip->dev->dev, "error getting pcm substream slot.\n"); return NULL; } /* call with stream_mutex locked */ static void usb6fire_pcm_stream_stop(struct pcm_runtime *rt) { int i; struct control_runtime *ctrl_rt = rt->chip->control; if (rt->stream_state != STREAM_DISABLED) { rt->stream_state = STREAM_STOPPING; for (i = 0; i < PCM_N_URBS; i++) { usb_kill_urb(&rt->in_urbs[i].instance); usb_kill_urb(&rt->out_urbs[i].instance); } ctrl_rt->usb_streaming = false; ctrl_rt->update_streaming(ctrl_rt); rt->stream_state = STREAM_DISABLED; } } /* call with stream_mutex locked */ static int usb6fire_pcm_stream_start(struct pcm_runtime *rt) { int ret; int i; int k; struct usb_iso_packet_descriptor *packet; if (rt->stream_state == STREAM_DISABLED) { /* submit our in urbs */ rt->stream_wait_cond = false; rt->stream_state = STREAM_STARTING; for (i = 0; i < PCM_N_URBS; i++) { for (k = 0; k < PCM_N_PACKETS_PER_URB; k++) { packet = &rt->in_urbs[i].packets[k]; packet->offset = k * rt->in_packet_size; packet->length = rt->in_packet_size; packet->actual_length = 0; packet->status = 0; } ret = usb_submit_urb(&rt->in_urbs[i].instance, GFP_ATOMIC); if (ret) { usb6fire_pcm_stream_stop(rt); return ret; } } /* wait for first out urb to return (sent in in urb handler) */ wait_event_timeout(rt->stream_wait_queue, rt->stream_wait_cond, HZ); if (rt->stream_wait_cond) rt->stream_state = STREAM_RUNNING; else { usb6fire_pcm_stream_stop(rt); return -EIO; } } return 0; } /* call with substream locked */ static void usb6fire_pcm_capture(struct pcm_substream *sub, struct pcm_urb *urb) { int i; int frame; int frame_count; unsigned int total_length = 0; struct pcm_runtime *rt = snd_pcm_substream_chip(sub->instance); struct snd_pcm_runtime *alsa_rt = sub->instance->runtime; u32 *src = NULL; u32 *dest = (u32 *) (alsa_rt->dma_area + sub->dma_off * (alsa_rt->frame_bits >> 3)); u32 *dest_end = (u32 *) (alsa_rt->dma_area + alsa_rt->buffer_size * (alsa_rt->frame_bits >> 3)); int bytes_per_frame = alsa_rt->channels << 2; for (i = 0; i < PCM_N_PACKETS_PER_URB; i++) { /* at least 4 header bytes for valid packet. * after that: 32 bits per sample for analog channels */ if (urb->packets[i].actual_length > 4) frame_count = (urb->packets[i].actual_length - 4) / (rt->in_n_analog << 2); else frame_count = 0; if (alsa_rt->format == SNDRV_PCM_FORMAT_S24_LE) src = (u32 *) (urb->buffer + total_length); else if (alsa_rt->format == SNDRV_PCM_FORMAT_S32_LE) src = (u32 *) (urb->buffer - 1 + total_length); else return; src++; /* skip leading 4 bytes of every packet */ total_length += urb->packets[i].length; for (frame = 0; frame < frame_count; frame++) { memcpy(dest, src, bytes_per_frame); dest += alsa_rt->channels; src += rt->in_n_analog; sub->dma_off++; sub->period_off++; if (dest == dest_end) { sub->dma_off = 0; dest = (u32 *) alsa_rt->dma_area; } } } } /* call with substream locked */ static void usb6fire_pcm_playback(struct pcm_substream *sub, struct pcm_urb *urb) { int i; int frame; int frame_count; struct pcm_runtime *rt = snd_pcm_substream_chip(sub->instance); struct snd_pcm_runtime *alsa_rt = sub->instance->runtime; u32 *src = (u32 *) (alsa_rt->dma_area + sub->dma_off * (alsa_rt->frame_bits >> 3)); u32 *src_end = (u32 *) (alsa_rt->dma_area + alsa_rt->buffer_size * (alsa_rt->frame_bits >> 3)); u32 *dest; int bytes_per_frame = alsa_rt->channels << 2; if (alsa_rt->format == SNDRV_PCM_FORMAT_S32_LE) dest = (u32 *) (urb->buffer - 1); else if (alsa_rt->format == SNDRV_PCM_FORMAT_S24_LE) dest = (u32 *) (urb->buffer); else { dev_err(&rt->chip->dev->dev, "Unknown sample format."); return; } for (i = 0; i < PCM_N_PACKETS_PER_URB; i++) { /* at least 4 header bytes for valid packet. * after that: 32 bits per sample for analog channels */ if (urb->packets[i].length > 4) frame_count = (urb->packets[i].length - 4) / (rt->out_n_analog << 2); else frame_count = 0; dest++; /* skip leading 4 bytes of every frame */ for (frame = 0; frame < frame_count; frame++) { memcpy(dest, src, bytes_per_frame); src += alsa_rt->channels; dest += rt->out_n_analog; sub->dma_off++; sub->period_off++; if (src == src_end) { src = (u32 *) alsa_rt->dma_area; sub->dma_off = 0; } } } } static void usb6fire_pcm_in_urb_handler(struct urb *usb_urb) { struct pcm_urb *in_urb = usb_urb->context; struct pcm_urb *out_urb = in_urb->peer; struct pcm_runtime *rt = in_urb->chip->pcm; struct pcm_substream *sub; unsigned long flags; int total_length = 0; int frame_count; int frame; int channel; int i; u8 *dest; if (usb_urb->status || rt->panic || rt->stream_state == STREAM_STOPPING) return; for (i = 0; i < PCM_N_PACKETS_PER_URB; i++) if (in_urb->packets[i].status) { rt->panic = true; return; } if (rt->stream_state == STREAM_DISABLED) { dev_err(&rt->chip->dev->dev, "internal error: stream disabled in in-urb handler.\n"); return; } /* receive our capture data */ sub = &rt->capture; spin_lock_irqsave(&sub->lock, flags); if (sub->active) { usb6fire_pcm_capture(sub, in_urb); if (sub->period_off >= sub->instance->runtime->period_size) { sub->period_off %= sub->instance->runtime->period_size; spin_unlock_irqrestore(&sub->lock, flags); snd_pcm_period_elapsed(sub->instance); } else spin_unlock_irqrestore(&sub->lock, flags); } else spin_unlock_irqrestore(&sub->lock, flags); /* setup out urb structure */ for (i = 0; i < PCM_N_PACKETS_PER_URB; i++) { out_urb->packets[i].offset = total_length; out_urb->packets[i].length = (in_urb->packets[i].actual_length - 4) / (rt->in_n_analog << 2) * (rt->out_n_analog << 2) + 4; out_urb->packets[i].status = 0; total_length += out_urb->packets[i].length; } memset(out_urb->buffer, 0, total_length); /* now send our playback data (if a free out urb was found) */ sub = &rt->playback; spin_lock_irqsave(&sub->lock, flags); if (sub->active) { usb6fire_pcm_playback(sub, out_urb); if (sub->period_off >= sub->instance->runtime->period_size) { sub->period_off %= sub->instance->runtime->period_size; spin_unlock_irqrestore(&sub->lock, flags); snd_pcm_period_elapsed(sub->instance); } else spin_unlock_irqrestore(&sub->lock, flags); } else spin_unlock_irqrestore(&sub->lock, flags); /* setup the 4th byte of each sample (0x40 for analog channels) */ dest = out_urb->buffer; for (i = 0; i < PCM_N_PACKETS_PER_URB; i++) if (out_urb->packets[i].length >= 4) { frame_count = (out_urb->packets[i].length - 4) / (rt->out_n_analog << 2); *(dest++) = 0xaa; *(dest++) = 0xaa; *(dest++) = frame_count; *(dest++) = 0x00; for (frame = 0; frame < frame_count; frame++) for (channel = 0; channel < rt->out_n_analog; channel++) { dest += 3; /* skip sample data */ *(dest++) = 0x40; } } usb_submit_urb(&out_urb->instance, GFP_ATOMIC); usb_submit_urb(&in_urb->instance, GFP_ATOMIC); } static void usb6fire_pcm_out_urb_handler(struct urb *usb_urb) { struct pcm_urb *urb = usb_urb->context; struct pcm_runtime *rt = urb->chip->pcm; if (rt->stream_state == STREAM_STARTING) { rt->stream_wait_cond = true; wake_up(&rt->stream_wait_queue); } } static int usb6fire_pcm_open(struct snd_pcm_substream *alsa_sub) { struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub); struct pcm_substream *sub = NULL; struct snd_pcm_runtime *alsa_rt = alsa_sub->runtime; if (rt->panic) return -EPIPE; mutex_lock(&rt->stream_mutex); alsa_rt->hw = pcm_hw; if (alsa_sub->stream == SNDRV_PCM_STREAM_PLAYBACK) { if (rt->rate < ARRAY_SIZE(rates)) alsa_rt->hw.rates = rates_alsaid[rt->rate]; alsa_rt->hw.channels_max = OUT_N_CHANNELS; sub = &rt->playback; } else if (alsa_sub->stream == SNDRV_PCM_STREAM_CAPTURE) { if (rt->rate < ARRAY_SIZE(rates)) alsa_rt->hw.rates = rates_alsaid[rt->rate]; alsa_rt->hw.channels_max = IN_N_CHANNELS; sub = &rt->capture; } if (!sub) { mutex_unlock(&rt->stream_mutex); dev_err(&rt->chip->dev->dev, "invalid stream type.\n"); return -EINVAL; } sub->instance = alsa_sub; sub->active = false; mutex_unlock(&rt->stream_mutex); return 0; } static int usb6fire_pcm_close(struct snd_pcm_substream *alsa_sub) { struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub); struct pcm_substream *sub = usb6fire_pcm_get_substream(alsa_sub); unsigned long flags; if (rt->panic) return 0; mutex_lock(&rt->stream_mutex); if (sub) { /* deactivate substream */ spin_lock_irqsave(&sub->lock, flags); sub->instance = NULL; sub->active = false; spin_unlock_irqrestore(&sub->lock, flags); /* all substreams closed? if so, stop streaming */ if (!rt->playback.instance && !rt->capture.instance) { usb6fire_pcm_stream_stop(rt); rt->rate = ARRAY_SIZE(rates); } } mutex_unlock(&rt->stream_mutex); return 0; } static int usb6fire_pcm_hw_params(struct snd_pcm_substream *alsa_sub, struct snd_pcm_hw_params *hw_params) { return snd_pcm_lib_alloc_vmalloc_buffer(alsa_sub, params_buffer_bytes(hw_params)); } static int usb6fire_pcm_hw_free(struct snd_pcm_substream *alsa_sub) { return snd_pcm_lib_free_vmalloc_buffer(alsa_sub); } static int usb6fire_pcm_prepare(struct snd_pcm_substream *alsa_sub) { struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub); struct pcm_substream *sub = usb6fire_pcm_get_substream(alsa_sub); struct snd_pcm_runtime *alsa_rt = alsa_sub->runtime; int ret; if (rt->panic) return -EPIPE; if (!sub) return -ENODEV; mutex_lock(&rt->stream_mutex); sub->dma_off = 0; sub->period_off = 0; if (rt->stream_state == STREAM_DISABLED) { for (rt->rate = 0; rt->rate < ARRAY_SIZE(rates); rt->rate++) if (alsa_rt->rate == rates[rt->rate]) break; if (rt->rate == ARRAY_SIZE(rates)) { mutex_unlock(&rt->stream_mutex); dev_err(&rt->chip->dev->dev, "invalid rate %d in prepare.\n", alsa_rt->rate); return -EINVAL; } ret = usb6fire_pcm_set_rate(rt); if (ret) { mutex_unlock(&rt->stream_mutex); return ret; } ret = usb6fire_pcm_stream_start(rt); if (ret) { mutex_unlock(&rt->stream_mutex); dev_err(&rt->chip->dev->dev, "could not start pcm stream.\n"); return ret; } } mutex_unlock(&rt->stream_mutex); return 0; } static int usb6fire_pcm_trigger(struct snd_pcm_substream *alsa_sub, int cmd) { struct pcm_substream *sub = usb6fire_pcm_get_substream(alsa_sub); struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub); unsigned long flags; if (rt->panic) return -EPIPE; if (!sub) return -ENODEV; switch (cmd) { case SNDRV_PCM_TRIGGER_START: case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: spin_lock_irqsave(&sub->lock, flags); sub->active = true; spin_unlock_irqrestore(&sub->lock, flags); return 0; case SNDRV_PCM_TRIGGER_STOP: case SNDRV_PCM_TRIGGER_PAUSE_PUSH: spin_lock_irqsave(&sub->lock, flags); sub->active = false; spin_unlock_irqrestore(&sub->lock, flags); return 0; default: return -EINVAL; } } static snd_pcm_uframes_t usb6fire_pcm_pointer( struct snd_pcm_substream *alsa_sub) { struct pcm_substream *sub = usb6fire_pcm_get_substream(alsa_sub); struct pcm_runtime *rt = snd_pcm_substream_chip(alsa_sub); unsigned long flags; snd_pcm_uframes_t ret; if (rt->panic || !sub) return SNDRV_PCM_POS_XRUN; spin_lock_irqsave(&sub->lock, flags); ret = sub->dma_off; spin_unlock_irqrestore(&sub->lock, flags); return ret; } static struct snd_pcm_ops pcm_ops = { .open = usb6fire_pcm_open, .close = usb6fire_pcm_close, .ioctl = snd_pcm_lib_ioctl, .hw_params = usb6fire_pcm_hw_params, .hw_free = usb6fire_pcm_hw_free, .prepare = usb6fire_pcm_prepare, .trigger = usb6fire_pcm_trigger, .pointer = usb6fire_pcm_pointer, .page = snd_pcm_lib_get_vmalloc_page, .mmap = snd_pcm_lib_mmap_vmalloc, }; static void usb6fire_pcm_init_urb(struct pcm_urb *urb, struct sfire_chip *chip, bool in, int ep, void (*handler)(struct urb *)) { urb->chip = chip; usb_init_urb(&urb->instance); urb->instance.transfer_buffer = urb->buffer; urb->instance.transfer_buffer_length = PCM_N_PACKETS_PER_URB * PCM_MAX_PACKET_SIZE; urb->instance.dev = chip->dev; urb->instance.pipe = in ? usb_rcvisocpipe(chip->dev, ep) : usb_sndisocpipe(chip->dev, ep); urb->instance.interval = 1; urb->instance.complete = handler; urb->instance.context = urb; urb->instance.number_of_packets = PCM_N_PACKETS_PER_URB; } static int usb6fire_pcm_buffers_init(struct pcm_runtime *rt) { int i; for (i = 0; i < PCM_N_URBS; i++) { rt->out_urbs[i].buffer = kzalloc(PCM_N_PACKETS_PER_URB * PCM_MAX_PACKET_SIZE, GFP_KERNEL); if (!rt->out_urbs[i].buffer) return -ENOMEM; rt->in_urbs[i].buffer = kzalloc(PCM_N_PACKETS_PER_URB * PCM_MAX_PACKET_SIZE, GFP_KERNEL); if (!rt->in_urbs[i].buffer) return -ENOMEM; } return 0; } static void usb6fire_pcm_buffers_destroy(struct pcm_runtime *rt) { int i; for (i = 0; i < PCM_N_URBS; i++) { kfree(rt->out_urbs[i].buffer); kfree(rt->in_urbs[i].buffer); } } int usb6fire_pcm_init(struct sfire_chip *chip) { int i; int ret; struct snd_pcm *pcm; struct pcm_runtime *rt = kzalloc(sizeof(struct pcm_runtime), GFP_KERNEL); if (!rt) return -ENOMEM; ret = usb6fire_pcm_buffers_init(rt); if (ret) { usb6fire_pcm_buffers_destroy(rt); kfree(rt); return ret; } rt->chip = chip; rt->stream_state = STREAM_DISABLED; rt->rate = ARRAY_SIZE(rates); init_waitqueue_head(&rt->stream_wait_queue); mutex_init(&rt->stream_mutex); spin_lock_init(&rt->playback.lock); spin_lock_init(&rt->capture.lock); for (i = 0; i < PCM_N_URBS; i++) { usb6fire_pcm_init_urb(&rt->in_urbs[i], chip, true, IN_EP, usb6fire_pcm_in_urb_handler); usb6fire_pcm_init_urb(&rt->out_urbs[i], chip, false, OUT_EP, usb6fire_pcm_out_urb_handler); rt->in_urbs[i].peer = &rt->out_urbs[i]; rt->out_urbs[i].peer = &rt->in_urbs[i]; } ret = snd_pcm_new(chip->card, "DMX6FireUSB", 0, 1, 1, &pcm); if (ret < 0) { usb6fire_pcm_buffers_destroy(rt); kfree(rt); dev_err(&chip->dev->dev, "cannot create pcm instance.\n"); return ret; } pcm->private_data = rt; strcpy(pcm->name, "DMX 6Fire USB"); snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &pcm_ops); snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &pcm_ops); if (ret) { usb6fire_pcm_buffers_destroy(rt); kfree(rt); dev_err(&chip->dev->dev, "error preallocating pcm buffers.\n"); return ret; } rt->instance = pcm; chip->pcm = rt; return 0; } void usb6fire_pcm_abort(struct sfire_chip *chip) { struct pcm_runtime *rt = chip->pcm; int i; if (rt) { rt->panic = true; if (rt->playback.instance) snd_pcm_stop_xrun(rt->playback.instance); if (rt->capture.instance) snd_pcm_stop_xrun(rt->capture.instance); for (i = 0; i < PCM_N_URBS; i++) { usb_poison_urb(&rt->in_urbs[i].instance); usb_poison_urb(&rt->out_urbs[i].instance); } } } void usb6fire_pcm_destroy(struct sfire_chip *chip) { struct pcm_runtime *rt = chip->pcm; usb6fire_pcm_buffers_destroy(rt); kfree(rt); chip->pcm = NULL; }