aboutsummaryrefslogtreecommitdiffstats
path: root/target/linux/ubicom32/files/sound/ubicom32/ubi32-pcm.c
diff options
context:
space:
mode:
Diffstat (limited to 'target/linux/ubicom32/files/sound/ubicom32/ubi32-pcm.c')
-rw-r--r--target/linux/ubicom32/files/sound/ubicom32/ubi32-pcm.c711
1 files changed, 711 insertions, 0 deletions
diff --git a/target/linux/ubicom32/files/sound/ubicom32/ubi32-pcm.c b/target/linux/ubicom32/files/sound/ubicom32/ubi32-pcm.c
new file mode 100644
index 000000000..2bc300b85
--- /dev/null
+++ b/target/linux/ubicom32/files/sound/ubicom32/ubi32-pcm.c
@@ -0,0 +1,711 @@
+/*
+ * sound/ubicom32/ubi32-pcm.c
+ * Interface to ubicom32 virtual audio peripheral
+ *
+ * (C) Copyright 2009, Ubicom, Inc.
+ *
+ * This file is part of the Ubicom32 Linux Kernel Port.
+ *
+ * The Ubicom32 Linux Kernel Port 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.
+ *
+ * The Ubicom32 Linux Kernel Port is distributed in the hope that it
+ * will be useful, but WITHOUT ANY WARRANTY; without even the implied
+ * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See
+ * the GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with the Ubicom32 Linux Kernel Port. If not,
+ * see <http://www.gnu.org/licenses/>.
+ *
+ * Ubicom32 implementation derived from (with many thanks):
+ * arch/m68knommu
+ * arch/blackfin
+ * arch/parisc
+ */
+
+#include <linux/interrupt.h>
+#include <sound/core.h>
+#include <sound/pcm.h>
+#include <sound/pcm_params.h>
+#include <asm/ip5000.h>
+#include <asm/ubi32-pcm.h>
+#include <linux/dma-mapping.h>
+#include <linux/delay.h>
+#include "ubi32.h"
+
+struct ubi32_snd_runtime_data {
+ dma_addr_t dma_buffer; /* Physical address of DMA buffer */
+ dma_addr_t dma_buffer_end; /* First address beyond end of DMA buffer */
+ size_t period_size;
+ dma_addr_t period_ptr; /* Physical address of next period */
+ unsigned int flags;
+};
+
+static void snd_ubi32_vp_int_set(struct snd_pcm *pcm)
+{
+ struct ubi32_snd_priv *ubi32_priv = pcm->private_data;
+ ubi32_priv->ar->int_req |= (1 << ubi32_priv->irq_idx);
+ ubicom32_set_interrupt(ubi32_priv->tx_irq);
+}
+
+static snd_pcm_uframes_t snd_ubi32_pcm_pointer(struct snd_pcm_substream *substream)
+{
+
+ struct ubi32_snd_priv *ubi32_priv = snd_pcm_substream_chip(substream);
+ struct audio_dev_regs *adr = ubi32_priv->adr;
+ struct snd_pcm_runtime *runtime = substream->runtime;
+ struct ubi32_snd_runtime_data *ubi32_rd = substream->runtime->private_data;
+
+ dma_addr_t read_pos;
+
+ snd_pcm_uframes_t frames;
+ if (!adr->primary_os_buffer_ptr) {
+ /*
+ * If primary_os_buffer_ptr is NULL (e.g. right after the HW is started or
+ * when the HW is stopped), then handle this case separately.
+ */
+ return 0;
+ }
+
+ read_pos = (dma_addr_t)adr->primary_os_buffer_ptr;
+ frames = bytes_to_frames(runtime, read_pos - ubi32_rd->dma_buffer);
+ if (frames == runtime->buffer_size) {
+ frames = 0;
+ }
+ return frames;
+}
+
+/*
+ * Audio trigger
+ */
+static int snd_ubi32_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
+{
+ struct ubi32_snd_priv *ubi32_priv = substream->pcm->private_data;
+ struct audio_dev_regs *adr = ubi32_priv->adr;
+ struct ubi32_snd_runtime_data *ubi32_rd = substream->runtime->private_data;
+ int ret = 0;
+
+#ifdef CONFIG_SND_DEBUG
+ snd_printk(KERN_INFO "snd_ubi32_pcm_trigger cmd=%d=", cmd);
+#endif
+
+ if (adr->command != AUDIO_CMD_NONE) {
+ snd_printk(KERN_WARNING "Can't send command to audio device at this time\n");
+ // Set a timer to call this function back later. How to do this?
+ return 0;
+ }
+
+ /*
+ * Set interrupt flag to indicate that we interrupted audio device
+ * to send a command
+ */
+
+ switch (cmd) {
+ case SNDRV_PCM_TRIGGER_START:
+
+#ifdef CONFIG_SND_DEBUG
+ snd_printk(KERN_INFO "START\n");
+#endif
+ /*
+ * Ready the DMA transfer
+ */
+ ubi32_rd->period_ptr = ubi32_rd->dma_buffer;
+
+#ifdef CONFIG_SND_DEBUG
+ snd_printk(KERN_INFO "trigger period_ptr=%lx\n", (unsigned long)ubi32_rd->period_ptr);
+#endif
+ adr->dma_xfer_requests[0].ptr = (void *)ubi32_rd->period_ptr;
+ adr->dma_xfer_requests[0].ctr = ubi32_rd->period_size;
+ adr->dma_xfer_requests[0].active = 1;
+
+#ifdef CONFIG_SND_DEBUG
+ snd_printk(KERN_INFO "xfer_request 0 ptr=0x%x ctr=%u\n", ubi32_rd->period_ptr, ubi32_rd->period_size);
+#endif
+
+ ubi32_rd->period_ptr += ubi32_rd->period_size;
+ adr->dma_xfer_requests[1].ptr = (void *)ubi32_rd->period_ptr;
+ adr->dma_xfer_requests[1].ctr = ubi32_rd->period_size;
+ adr->dma_xfer_requests[1].active = 1;
+
+#ifdef CONFIG_SND_DEBUG
+ snd_printk(KERN_INFO "xfer_request 1 ptr=0x%x ctr=%u\n", ubi32_rd->period_ptr, ubi32_rd->period_size);
+#endif
+
+ /*
+ * Tell the VP that we want to begin playback by filling in the
+ * command field and then interrupting the audio VP
+ */
+ adr->int_flags |= AUDIO_INT_FLAG_COMMAND;
+ adr->command = AUDIO_CMD_START;
+ snd_ubi32_vp_int_set(substream->pcm);
+ break;
+
+ case SNDRV_PCM_TRIGGER_STOP:
+
+#ifdef CONFIG_SND_DEBUG
+ snd_printk(KERN_INFO "STOP\n");
+#endif
+
+ /*
+ * Tell the VP that we want to stop playback by filling in the
+ * command field and then interrupting the audio VP
+ */
+ adr->int_flags |= AUDIO_INT_FLAG_COMMAND;
+ adr->command = AUDIO_CMD_STOP;
+ snd_ubi32_vp_int_set(substream->pcm);
+ break;
+
+ case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
+
+#ifdef CONFIG_SND_DEBUG
+ snd_printk(KERN_INFO "PAUSE_PUSH\n");
+#endif
+
+ /*
+ * Tell the VP that we want to pause playback by filling in the
+ * command field and then interrupting the audio VP
+ */
+ adr->int_flags |= AUDIO_INT_FLAG_COMMAND;
+ adr->command = AUDIO_CMD_PAUSE;
+ snd_ubi32_vp_int_set(substream->pcm);
+ break;
+
+ case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
+
+#ifdef CONFIG_SND_DEBUG
+ snd_printk(KERN_INFO "PAUSE_RELEASE\n");
+#endif
+ /*
+ * Tell the VP that we want to resume paused playback by filling
+ * in the command field and then interrupting the audio VP
+ */
+ adr->int_flags |= AUDIO_INT_FLAG_COMMAND;
+ adr->command = AUDIO_CMD_RESUME;
+ snd_ubi32_vp_int_set(substream->pcm);
+ break;
+
+ default:
+ snd_printk(KERN_WARNING "Unhandled trigger\n");
+ ret = -EINVAL;
+ break;
+ }
+
+ return ret;
+}
+
+/*
+ * Prepare to transfer an audio stream to the codec
+ */
+static int snd_ubi32_pcm_prepare(struct snd_pcm_substream *substream)
+{
+ /*
+ * Configure registers and setup the runtime instance for DMA transfers
+ */
+ struct ubi32_snd_priv *ubi32_priv = substream->pcm->private_data;
+ struct audio_dev_regs *adr = ubi32_priv->adr;
+
+#ifdef CONFIG_SND_DEBUG
+ snd_printk(KERN_INFO "snd_ubi32_pcm_prepare: sending STOP command to audio device\n");
+#endif
+
+ /*
+ * Make sure the audio device is stopped
+ */
+
+ /*
+ * Set interrupt flag to indicate that we interrupted audio device
+ * to send a command
+ */
+ adr->int_flags |= AUDIO_INT_FLAG_COMMAND;
+ adr->command = AUDIO_CMD_STOP;
+ snd_ubi32_vp_int_set(substream->pcm);
+
+ return 0;
+}
+
+/*
+ * Allocate DMA buffers from preallocated memory.
+ * Preallocation was done in snd_ubi32_pcm_new()
+ */
+static int snd_ubi32_pcm_hw_params(struct snd_pcm_substream *substream,
+ struct snd_pcm_hw_params *hw_params)
+{
+ struct snd_pcm_runtime *runtime = substream->runtime;
+ struct ubi32_snd_priv *ubi32_priv = substream->pcm->private_data;
+ struct audio_dev_regs *adr = ubi32_priv->adr;
+ struct ubi32_snd_runtime_data *ubi32_rd = substream->runtime->private_data;
+
+ /*
+ * Use pre-allocated memory from ubi32_snd_pcm_new() to satisfy
+ * this memory request.
+ */
+ int ret = snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(hw_params));
+ if (ret < 0) {
+ return ret;
+ }
+
+#ifdef CONFIG_SND_DEBUG
+ snd_printk(KERN_INFO "snd_ubi32_pcm_hw_params\n");
+#endif
+
+ if (!(adr->channel_mask & (1 << params_channels(hw_params)))) {
+ snd_printk(KERN_INFO "snd_ubi32_pcm_hw_params unsupported number of channels %d mask %08x\n", params_channels(hw_params), adr->channel_mask);
+ return -EINVAL;
+ }
+
+ if (ubi32_priv->set_channels) {
+ int ret = ubi32_priv->set_channels(ubi32_priv, params_channels(hw_params));
+ if (ret) {
+ snd_printk(KERN_WARNING "Unable to set channels to %d, ret=%d\n", params_channels(hw_params), ret);
+ return ret;
+ }
+ }
+
+ if (ubi32_priv->set_rate) {
+ int ret = ubi32_priv->set_rate(ubi32_priv, params_rate(hw_params));
+ if (ret) {
+ snd_printk(KERN_WARNING "Unable to set rate to %d, ret=%d\n", params_rate(hw_params), ret);
+ return ret;
+ }
+ }
+
+ if (ubi32_priv->pdata->set_rate) {
+ int ret = ubi32_priv->pdata->set_rate(ubi32_priv->pdata->appdata, params_rate(hw_params));
+ if (ret) {
+ snd_printk(KERN_WARNING "Unable to set rate to %d, ret=%d\n", params_rate(hw_params), ret);
+ return ret;
+ }
+ }
+
+ if (adr->command != AUDIO_CMD_NONE) {
+ snd_printk(KERN_WARNING "snd_ubi32_pcm_hw_params: tio busy\n");
+ return -EAGAIN;
+ }
+
+ if (params_format(hw_params) == SNDRV_PCM_FORMAT_S16_LE) {
+ adr->flags |= CMD_START_FLAG_LE;
+ } else {
+ adr->flags &= ~CMD_START_FLAG_LE;
+ }
+ adr->channels = params_channels(hw_params);
+ adr->sample_rate = params_rate(hw_params);
+ adr->command = AUDIO_CMD_SETUP;
+ adr->int_flags |= AUDIO_INT_FLAG_COMMAND;
+ snd_ubi32_vp_int_set(substream->pcm);
+
+ /*
+ * Wait for the command to complete
+ */
+ while (adr->command != AUDIO_CMD_NONE) {
+ udelay(1);
+ }
+
+ /*
+ * Put the DMA info into the DMA descriptor that we will
+ * use to do transfers to our audio VP "hardware"
+ */
+
+ /*
+ * Mark both DMA transfers as not ready/inactive
+ */
+ adr->dma_xfer_requests[0].active = 0;
+ adr->dma_xfer_requests[1].active = 0;
+
+ /*
+ * Put the location of the buffer into the runtime data instance
+ */
+ ubi32_rd->dma_buffer = (dma_addr_t)runtime->dma_area;
+ ubi32_rd->dma_buffer_end = (dma_addr_t)(runtime->dma_area + runtime->dma_bytes);
+
+ /*
+ * Get the period size
+ */
+ ubi32_rd->period_size = params_period_bytes(hw_params);
+
+#ifdef CONFIG_SND_DEBUG
+ snd_printk(KERN_INFO "DMA for ubi32 audio initialized dma_area=0x%x dma_bytes=%d, period_size=%d\n", (unsigned int)runtime->dma_area, (unsigned int)runtime->dma_bytes, ubi32_rd->period_size);
+ snd_printk(KERN_INFO "Private buffer ubi32_rd: dma_buffer=0x%x dma_buffer_end=0x%x ret=%d\n", ubi32_rd->dma_buffer, ubi32_rd->dma_buffer_end, ret);
+#endif
+
+ return ret;
+}
+
+/*
+ * This is the reverse of snd_ubi32_pcm_hw_params
+ */
+static int snd_ubi32_pcm_hw_free(struct snd_pcm_substream *substream)
+{
+#ifdef CONFIG_SND_DEBUG
+ snd_printk(KERN_INFO "snd_ubi32_pcm_hw_free\n");
+#endif
+ return snd_pcm_lib_free_pages(substream);
+}
+
+/*
+ * Audio virtual peripheral capabilities (capture and playback are identical)
+ */
+static struct snd_pcm_hardware snd_ubi32_pcm_hw =
+{
+ .info = (SNDRV_PCM_INFO_INTERLEAVED | SNDRV_PCM_INFO_BLOCK_TRANSFER |
+ SNDRV_PCM_INFO_PAUSE | SNDRV_PCM_INFO_RESUME),
+ .buffer_bytes_max = (64*1024),
+ .period_bytes_min = 64,
+ .period_bytes_max = 8184,//8184,//8176,
+ .periods_min = 2,
+ .periods_max = 255,
+ .fifo_size = 0, // THIS IS IGNORED BY ALSA
+};
+
+/*
+ * We fill this in later
+ */
+static struct snd_pcm_hw_constraint_list ubi32_pcm_rates;
+
+/*
+ * snd_ubi32_pcm_close
+ */
+static int snd_ubi32_pcm_close(struct snd_pcm_substream *substream)
+{
+ /* Disable codec, stop DMA, free private data structures */
+ //struct ubi32_snd_priv *ubi32_priv = snd_pcm_substream_chip(substream);
+ struct ubi32_snd_runtime_data *ubi32_rd = substream->runtime->private_data;
+
+#ifdef CONFIG_SND_DEBUG
+ snd_printk(KERN_INFO "snd_ubi32_pcm_close\n");
+#endif
+
+ substream->runtime->private_data = NULL;
+
+ kfree(ubi32_rd);
+
+ return 0;
+}
+
+/*
+ * snd_ubi32_pcm_open
+ */
+static int snd_ubi32_pcm_open(struct snd_pcm_substream *substream)
+{
+ struct snd_pcm_runtime *runtime = substream->runtime;
+ struct ubi32_snd_runtime_data *ubi32_rd;
+ int ret = 0;
+
+#ifdef CONFIG_SND_DEBUG
+ snd_printk(KERN_INFO "ubi32 pcm open\n");
+#endif
+
+ /* Associate capabilities with component */
+ runtime->hw = snd_ubi32_pcm_hw;
+
+ /*
+ * Inform ALSA about constraints of the audio device
+ */
+ ret = snd_pcm_hw_constraint_list(runtime, 0, SNDRV_PCM_HW_PARAM_RATE, &ubi32_pcm_rates);
+ if (ret < 0) {
+ snd_printk(KERN_INFO "invalid rate\n");
+ goto out;
+ }
+
+ /* Force the buffer size to be an integer multiple of period size */
+ ret = snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS);
+ if (ret < 0) {
+ snd_printk(KERN_INFO "invalid period\n");
+ goto out;
+ }
+ /* Initialize structures/registers */
+ ubi32_rd = kzalloc(sizeof(struct ubi32_snd_runtime_data), GFP_KERNEL);
+ if (ubi32_rd == NULL) {
+ ret = -ENOMEM;
+ goto out;
+ }
+
+ runtime->private_data = ubi32_rd;
+
+#ifdef CONFIG_SND_DEBUG
+ snd_printk(KERN_INFO "snd_ubi32_pcm_open returned 0\n");
+#endif
+
+ return 0;
+out:
+#ifdef CONFIG_SND_DEBUG
+ snd_printk(KERN_INFO "snd_ubi32_pcm_open returned %d\n", ret);
+#endif
+
+ return ret;
+}
+
+static struct snd_pcm_ops snd_ubi32_pcm_ops = {
+ .open = snd_ubi32_pcm_open, /* Open */
+ .close = snd_ubi32_pcm_close, /* Close */
+ .ioctl = snd_pcm_lib_ioctl, /* Generic IOCTL handler */
+ .hw_params = snd_ubi32_pcm_hw_params, /* Hardware parameters/capabilities */
+ .hw_free = snd_ubi32_pcm_hw_free, /* Free function for hw_params */
+ .prepare = snd_ubi32_pcm_prepare,
+ .trigger = snd_ubi32_pcm_trigger,
+ .pointer = snd_ubi32_pcm_pointer,
+};
+
+/*
+ * Interrupt handler that gets called when the audio device
+ * interrupts Linux
+ */
+static irqreturn_t snd_ubi32_pcm_interrupt(int irq, void *appdata)
+{
+ struct snd_pcm *pcm = (struct snd_pcm *)appdata;
+ struct ubi32_snd_priv *ubi32_priv = pcm->private_data;
+ struct audio_dev_regs *adr = ubi32_priv->adr;
+ struct snd_pcm_substream *substream;
+ struct ubi32_snd_runtime_data *ubi32_rd;
+ int dma_to_fill = 0;
+
+ /*
+ * Check to see if the interrupt is for us
+ */
+ if (!(ubi32_priv->ar->int_status & (1 << ubi32_priv->irq_idx))) {
+ return IRQ_NONE;
+ }
+
+ /*
+ * Clear the interrupt
+ */
+ ubi32_priv->ar->int_status &= ~(1 << ubi32_priv->irq_idx);
+
+ /*
+ * We only have one stream since we don't mix. Therefore
+ * we don't need to search through substreams.
+ */
+ if (ubi32_priv->is_capture) {
+ substream = pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream;
+ } else {
+ substream = pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream;
+ }
+
+ if (!substream->runtime) {
+ snd_printk(KERN_WARNING "No runtime data\n");
+ return IRQ_NONE;
+ }
+
+ ubi32_rd = substream->runtime->private_data;
+
+#ifdef CONFIG_SND_DEBUG
+ snd_printk(KERN_INFO "Ubi32 ALSA interrupt\n");
+#endif
+
+ if (ubi32_rd == NULL) {
+ snd_printk(KERN_WARNING "No private data\n");
+ return IRQ_NONE;
+ }
+
+ // Check interrupt cause
+ if (0) {
+ // Handle the underflow case
+ } else if ((adr->status & AUDIO_STATUS_PLAY_DMA0_REQUEST) ||
+ (adr->status & AUDIO_STATUS_PLAY_DMA1_REQUEST)) {
+ if (adr->status & AUDIO_STATUS_PLAY_DMA0_REQUEST) {
+ dma_to_fill = 0;
+ adr->status &= ~AUDIO_STATUS_PLAY_DMA0_REQUEST;
+ } else if (adr->status & AUDIO_STATUS_PLAY_DMA1_REQUEST) {
+ dma_to_fill = 1;
+ adr->status &= ~AUDIO_STATUS_PLAY_DMA1_REQUEST;
+ }
+ ubi32_rd->period_ptr += ubi32_rd->period_size;
+ if (ubi32_rd->period_ptr >= ubi32_rd->dma_buffer_end) {
+ ubi32_rd->period_ptr = ubi32_rd->dma_buffer;
+ }
+ adr->dma_xfer_requests[dma_to_fill].ptr = (void *)ubi32_rd->period_ptr;
+ adr->dma_xfer_requests[dma_to_fill].ctr = ubi32_rd->period_size;
+ adr->dma_xfer_requests[dma_to_fill].active = 1;
+#ifdef CONFIG_SND_DEBUG
+ snd_printk(KERN_INFO "xfer_request %d ptr=0x%x ctr=%u\n", dma_to_fill, ubi32_rd->period_ptr, ubi32_rd->period_size);
+#endif
+ adr->int_flags |= AUDIO_INT_FLAG_MORE_SAMPLES;
+ snd_ubi32_vp_int_set(substream->pcm);
+ }
+ // If we are interrupted by the VP, that means we completed
+ // processing one period of audio. We need to inform the upper
+ // layers of ALSA of this.
+ snd_pcm_period_elapsed(substream);
+
+ return IRQ_HANDLED;
+}
+
+void __devexit snd_ubi32_pcm_remove(struct ubi32_snd_priv *ubi32_priv)
+{
+ struct snd_pcm *pcm = ubi32_priv->pcm;
+ free_irq(ubi32_priv->rx_irq, pcm);
+}
+
+#if SNDRV_PCM_RATE_5512 != 1 << 0 || SNDRV_PCM_RATE_192000 != 1 << 12
+#error "Change this table to match pcm.h"
+#endif
+static unsigned int rates[] __initdata = {5512, 8000, 11025, 16000, 22050,
+ 32000, 44100, 48000, 64000, 88200,
+ 96000, 176400, 192000};
+
+/*
+ * snd_ubi32_pcm_probe
+ */
+int __devinit snd_ubi32_pcm_probe(struct ubi32_snd_priv *ubi32_priv, struct platform_device *pdev)
+{
+ struct snd_pcm *pcm;
+ int ret, err;
+ int i;
+ int j;
+ int nrates;
+ unsigned int rate_max = 0;
+ unsigned int rate_min = 0xFFFFFFFF;
+ unsigned int rate_mask = 0;
+ struct audio_dev_regs *adr;
+ struct resource *res_adr;
+ struct resource *res_irq_tx;
+ struct resource *res_irq_rx;
+ struct ubi32pcm_platform_data *pdata;
+
+ pdata = pdev->dev.platform_data;
+ if (!pdata) {
+ return -ENODEV;
+ }
+
+ /*
+ * Get our resources, adr is the hardware driver base address
+ * and the tx and rx irqs are used to communicate with the
+ * hardware driver.
+ */
+ res_adr = platform_get_resource(pdev, IORESOURCE_MEM, AUDIO_MEM_RESOURCE);
+ res_irq_tx = platform_get_resource(pdev, IORESOURCE_IRQ, AUDIO_TX_IRQ_RESOURCE);
+ res_irq_rx = platform_get_resource(pdev, IORESOURCE_IRQ, AUDIO_RX_IRQ_RESOURCE);
+ if (!res_adr || !res_irq_tx || !res_irq_rx) {
+ snd_printk(KERN_WARNING "Could not get resources");
+ return -ENODEV;
+ }
+
+ ubi32_priv->ar = (struct audio_regs *)res_adr->start;
+ ubi32_priv->tx_irq = res_irq_tx->start;
+ ubi32_priv->rx_irq = res_irq_rx->start;
+ ubi32_priv->irq_idx = pdata->inst_num;
+ ubi32_priv->adr = &(ubi32_priv->ar->adr[pdata->inst_num]);
+
+ /*
+ * Check the version
+ */
+ adr = ubi32_priv->adr;
+ if (adr->version != AUDIO_DEV_REGS_VERSION) {
+ snd_printk(KERN_WARNING "This audio_dev_reg is not compatible with this driver\n");
+ return -ENODEV;
+ }
+
+ /*
+ * Find out the standard rates, also find max and min rates
+ */
+ for (i = 0; i < ARRAY_SIZE(rates); i++) {
+ int found = 0;
+ for (j = 0; j < adr->n_sample_rates; j++) {
+ if (rates[i] == adr->sample_rates[j]) {
+ /*
+ * Check to see if it is supported by the dac
+ */
+ if ((rates[i] >= ubi32_priv->min_sample_rate) &&
+ (!ubi32_priv->max_sample_rate ||
+ (ubi32_priv->max_sample_rate && (rates[i] <= ubi32_priv->max_sample_rate)))) {
+ found = 1;
+ rate_mask |= (1 << i);
+ nrates++;
+ if (rates[i] < rate_min) {
+ rate_min = rates[i];
+ }
+ if (rates[i] > rate_max) {
+ rate_max = rates[i];
+ }
+ break;
+ }
+ }
+ }
+ if (!found) {
+ rate_mask |= SNDRV_PCM_RATE_KNOT;
+ }
+ }
+
+ snd_ubi32_pcm_hw.rates = rate_mask;
+ snd_ubi32_pcm_hw.rate_min = rate_min;
+ snd_ubi32_pcm_hw.rate_max = rate_max;
+ ubi32_pcm_rates.count = adr->n_sample_rates;
+ ubi32_pcm_rates.list = (unsigned int *)adr->sample_rates;
+ ubi32_pcm_rates.mask = 0;
+
+ for (i = 0; i < 32; i++) {
+ if (adr->channel_mask & (1 << i)) {
+ if (!snd_ubi32_pcm_hw.channels_min) {
+ snd_ubi32_pcm_hw.channels_min = i;
+ }
+ snd_ubi32_pcm_hw.channels_max = i;
+ }
+ }
+ snd_printk(KERN_INFO "Ubi32PCM: channels_min:%u channels_max:%u\n",
+ snd_ubi32_pcm_hw.channels_min,
+ snd_ubi32_pcm_hw.channels_max);
+
+ if (adr->caps & AUDIONODE_CAP_BE) {
+ snd_ubi32_pcm_hw.formats |= SNDRV_PCM_FMTBIT_S16_BE;
+ }
+ if (adr->caps & AUDIONODE_CAP_LE) {
+ snd_ubi32_pcm_hw.formats |= SNDRV_PCM_FMTBIT_S16_LE;
+ }
+
+ snd_printk(KERN_INFO "Ubi32PCM: rates:%08x min:%u max:%u count:%d fmts:%016llx (%s)\n",
+ snd_ubi32_pcm_hw.rates,
+ snd_ubi32_pcm_hw.rate_min,
+ snd_ubi32_pcm_hw.rate_max,
+ ubi32_pcm_rates.count,
+ snd_ubi32_pcm_hw.formats,
+ ubi32_priv->is_capture ? "capture" : "playback");
+
+ if (ubi32_priv->is_capture) {
+ ret = snd_pcm_new(ubi32_priv->card, "Ubi32 PCM", 0, 0, 1, &pcm);
+ } else {
+ ret = snd_pcm_new(ubi32_priv->card, "Ubi32 PCM", 0, 1, 0, &pcm);
+ }
+
+ if (ret < 0) {
+ return ret;
+ }
+
+ pcm->private_data = ubi32_priv;
+ ubi32_priv->pcm = pcm;
+ ubi32_priv->pdata = pdata;
+
+ pcm->info_flags = 0;
+
+ strcpy(pcm->name, "Ubi32-PCM");
+
+ snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_CONTINUOUS,
+ snd_dma_continuous_data(GFP_KERNEL),
+ 45*1024, 64*1024);
+
+ if (ubi32_priv->is_capture) {
+ snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_ubi32_pcm_ops);
+ } else {
+ snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &snd_ubi32_pcm_ops);
+ }
+
+ /*
+ * Start up the audio device
+ */
+ adr->int_flags |= AUDIO_INT_FLAG_COMMAND;
+ adr->command = AUDIO_CMD_ENABLE;
+ snd_ubi32_vp_int_set(pcm);
+
+ /*
+ * Request IRQ
+ */
+ err = request_irq(ubi32_priv->rx_irq, snd_ubi32_pcm_interrupt, IRQF_SHARED | IRQF_DISABLED, pcm->name, pcm);
+ if (err) {
+ snd_printk(KERN_WARNING "request_irq failed: irq=%d err=%d\n", ubi32_priv->rx_irq, err);
+ return -ENODEV;
+ }
+
+ return ret;
+
+}