1 files changed, 513 insertions, 0 deletions

diff --git a/drivers/media/video/tm6000/tm6000-alsa.c b/drivers/media/video/tm6000/tm6000-alsa.c
new file mode 100644
index 000000000000..7d675c72fd47
--- /dev/null
+++ b/drivers/media/video/tm6000/tm6000-alsa.c
@@ -0,0 +1,513 @@
+/*
+ *
+ *  Support for audio capture for tm5600/6000/6010
+ *    (c) 2007-2008 Mauro Carvalho Chehab <mchehab@redhat.com>
+ *
+ *  Based on cx88-alsa.c
+ *
+ *  This program is free software; you can redistribute it and/or modify
+ *  it under the terms of the GNU General Public License version 2 as
+ *  published by the Free Software Foundation.
+ */
+
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/device.h>
+#include <linux/interrupt.h>
+#include <linux/usb.h>
+#include <linux/slab.h>
+#include <linux/vmalloc.h>
+
+#include <linux/delay.h>
+#include <sound/core.h>
+#include <sound/pcm.h>
+#include <sound/pcm_params.h>
+#include <sound/control.h>
+#include <sound/initval.h>
+
+
+#include "tm6000.h"
+#include "tm6000-regs.h"
+
+#undef dprintk
+
+#define dprintk(level, fmt, arg...) do {                                   \
+        if (debug >= level)                                                \
+                printk(KERN_INFO "%s/1: " fmt, chip->core->name , ## arg); \
+        } while (0)
+
+/****************************************************************************
+                        Module global static vars
+ ****************************************************************************/
+
+static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;      /* Index 0-MAX */
+
+static int enable[SNDRV_CARDS] = {1, [1 ... (SNDRV_CARDS - 1)] = 1};
+
+module_param_array(enable, bool, NULL, 0444);
+MODULE_PARM_DESC(enable, "Enable tm6000x soundcard. default enabled.");
+
+module_param_array(index, int, NULL, 0444);
+MODULE_PARM_DESC(index, "Index value for tm6000x capture interface(s).");
+
+
+/****************************************************************************
+                                Module macros
+ ****************************************************************************/
+
+MODULE_DESCRIPTION("ALSA driver module for tm5600/tm6000/tm6010 based TV cards");
+MODULE_AUTHOR("Mauro Carvalho Chehab <mchehab@redhat.com>");
+MODULE_LICENSE("GPL");
+MODULE_SUPPORTED_DEVICE("{{Trident,tm5600},"
+                        "{{Trident,tm6000},"
+                        "{{Trident,tm6010}");
+static unsigned int debug;
+module_param(debug, int, 0644);
+MODULE_PARM_DESC(debug, "enable debug messages");
+
+/****************************************************************************
+                        Module specific funtions
+ ****************************************************************************/
+
+/*
+ * BOARD Specific: Sets audio DMA
+ */
+
+static int _tm6000_start_audio_dma(struct snd_tm6000_card *chip)
+{
+        struct tm6000_core *core = chip->core;
+
+        dprintk(1, "Starting audio DMA\n");
+
+        /* Enables audio */
+        tm6000_set_reg_mask(core, TM6010_REQ07_RCC_ACTIVE_IF, 0x40, 0x40);
+
+        tm6000_set_audio_bitrate(core, 48000);
+
+        return 0;
+}
+
+/*
+ * BOARD Specific: Resets audio DMA
+ */
+static int _tm6000_stop_audio_dma(struct snd_tm6000_card *chip)
+{
+        struct tm6000_core *core = chip->core;
+
+        dprintk(1, "Stopping audio DMA\n");
+
+        /* Disables audio */
+        tm6000_set_reg_mask(core, TM6010_REQ07_RCC_ACTIVE_IF, 0x00, 0x40);
+
+        return 0;
+}
+
+static void dsp_buffer_free(struct snd_pcm_substream *substream)
+{
+        struct snd_tm6000_card *chip = snd_pcm_substream_chip(substream);
+
+        dprintk(2, "Freeing buffer\n");
+
+        vfree(substream->runtime->dma_area);
+        substream->runtime->dma_area = NULL;
+        substream->runtime->dma_bytes = 0;
+}
+
+static int dsp_buffer_alloc(struct snd_pcm_substream *substream, int size)
+{
+        struct snd_tm6000_card *chip = snd_pcm_substream_chip(substream);
+
+        dprintk(2, "Allocating buffer\n");
+
+        if (substream->runtime->dma_area) {
+                if (substream->runtime->dma_bytes > size)
+                        return 0;
+
+                dsp_buffer_free(substream);
+        }
+
+        substream->runtime->dma_area = vmalloc(size);
+        if (!substream->runtime->dma_area)
+                return -ENOMEM;
+
+        substream->runtime->dma_bytes = size;
+
+        return 0;
+}
+
+
+/****************************************************************************
+                                ALSA PCM Interface
+ ****************************************************************************/
+
+/*
+ * Digital hardware definition
+ */
+#define DEFAULT_FIFO_SIZE       4096
+
+static struct snd_pcm_hardware snd_tm6000_digital_hw = {
+        .info = SNDRV_PCM_INFO_MMAP |
+                SNDRV_PCM_INFO_INTERLEAVED |
+                SNDRV_PCM_INFO_BLOCK_TRANSFER |
+                SNDRV_PCM_INFO_MMAP_VALID,
+        .formats = SNDRV_PCM_FMTBIT_S16_LE,
+
+        .rates = SNDRV_PCM_RATE_CONTINUOUS,
+        .rate_min = 48000,
+        .rate_max = 48000,
+        .channels_min = 2,
+        .channels_max = 2,
+        .period_bytes_min = 64,
+        .period_bytes_max = 12544,
+        .periods_min = 1,
+        .periods_max = 98,
+        .buffer_bytes_max = 62720 * 8,
+};
+
+/*
+ * audio pcm capture open callback
+ */
+static int snd_tm6000_pcm_open(struct snd_pcm_substream *substream)
+{
+        struct snd_tm6000_card *chip = snd_pcm_substream_chip(substream);
+        struct snd_pcm_runtime *runtime = substream->runtime;
+        int err;
+
+        err = snd_pcm_hw_constraint_pow2(runtime, 0,
+                                         SNDRV_PCM_HW_PARAM_PERIODS);
+        if (err < 0)
+                goto _error;
+
+        chip->substream = substream;
+
+        runtime->hw = snd_tm6000_digital_hw;
+
+        return 0;
+_error:
+        dprintk(1, "Error opening PCM!\n");
+        return err;
+}
+
+/*
+ * audio close callback
+ */
+static int snd_tm6000_close(struct snd_pcm_substream *substream)
+{
+        struct snd_tm6000_card *chip = snd_pcm_substream_chip(substream);
+        struct tm6000_core *core = chip->core;
+
+        if (atomic_read(&core->stream_started) > 0) {
+                atomic_set(&core->stream_started, 0);
+                schedule_work(&core->wq_trigger);
+        }
+
+        return 0;
+}
+
+static int tm6000_fillbuf(struct tm6000_core *core, char *buf, int size)
+{
+        struct snd_tm6000_card *chip = core->adev;
+        struct snd_pcm_substream *substream = chip->substream;
+        struct snd_pcm_runtime *runtime;
+        int period_elapsed = 0;
+        unsigned int stride, buf_pos;
+        int length;
+
+        if (atomic_read(&core->stream_started) == 0)
+                return 0;
+
+        if (!size || !substream) {
+                dprintk(1, "substream was NULL\n");
+                return -EINVAL;
+        }
+
+        runtime = substream->runtime;
+        if (!runtime || !runtime->dma_area) {
+                dprintk(1, "runtime was NULL\n");
+                return -EINVAL;
+        }
+
+        buf_pos = chip->buf_pos;
+        stride = runtime->frame_bits >> 3;
+
+        if (stride == 0) {
+                dprintk(1, "stride is zero\n");
+                return -EINVAL;
+        }
+
+        length = size / stride;
+        if (length == 0) {
+                dprintk(1, "%s: length was zero\n", __func__);
+                return -EINVAL;
+        }
+
+        dprintk(1, "Copying %d bytes at %p[%d] - buf size=%d x %d\n", size,
+                runtime->dma_area, buf_pos,
+                (unsigned int)runtime->buffer_size, stride);
+
+        if (buf_pos + length >= runtime->buffer_size) {
+                unsigned int cnt = runtime->buffer_size - buf_pos;
+                memcpy(runtime->dma_area + buf_pos * stride, buf, cnt * stride);
+                memcpy(runtime->dma_area, buf + cnt * stride,
+                        length * stride - cnt * stride);
+        } else
+                memcpy(runtime->dma_area + buf_pos * stride, buf,
+                        length * stride);
+
+        snd_pcm_stream_lock(substream);
+
+        chip->buf_pos += length;
+        if (chip->buf_pos >= runtime->buffer_size)
+                chip->buf_pos -= runtime->buffer_size;
+
+        chip->period_pos += length;
+        if (chip->period_pos >= runtime->period_size) {
+                chip->period_pos -= runtime->period_size;
+                period_elapsed = 1;
+        }
+
+        snd_pcm_stream_unlock(substream);
+
+        if (period_elapsed)
+                snd_pcm_period_elapsed(substream);
+
+        return 0;
+}
+
+/*
+ * hw_params callback
+ */
+static int snd_tm6000_hw_params(struct snd_pcm_substream *substream,
+                              struct snd_pcm_hw_params *hw_params)
+{
+        int size, rc;
+
+        size = params_period_bytes(hw_params) * params_periods(hw_params);
+
+        rc = dsp_buffer_alloc(substream, size);
+        if (rc < 0)
+                return rc;
+
+        return 0;
+}
+
+/*
+ * hw free callback
+ */
+static int snd_tm6000_hw_free(struct snd_pcm_substream *substream)
+{
+        struct snd_tm6000_card *chip = snd_pcm_substream_chip(substream);
+        struct tm6000_core *core = chip->core;
+
+        if (atomic_read(&core->stream_started) > 0) {
+                atomic_set(&core->stream_started, 0);
+                schedule_work(&core->wq_trigger);
+        }
+
+        dsp_buffer_free(substream);
+        return 0;
+}
+
+/*
+ * prepare callback
+ */
+static int snd_tm6000_prepare(struct snd_pcm_substream *substream)
+{
+        struct snd_tm6000_card *chip = snd_pcm_substream_chip(substream);
+
+        chip->buf_pos = 0;
+        chip->period_pos = 0;
+
+        return 0;
+}
+
+
+/*
+ * trigger callback
+ */
+static void audio_trigger(struct work_struct *work)
+{
+        struct tm6000_core *core = container_of(work, struct tm6000_core,
+                                                wq_trigger);
+        struct snd_tm6000_card *chip = core->adev;
+
+        if (atomic_read(&core->stream_started)) {
+                dprintk(1, "starting capture");
+                _tm6000_start_audio_dma(chip);
+        } else {
+                dprintk(1, "stopping capture");
+                _tm6000_stop_audio_dma(chip);
+        }
+}
+
+static int snd_tm6000_card_trigger(struct snd_pcm_substream *substream, int cmd)
+{
+        struct snd_tm6000_card *chip = snd_pcm_substream_chip(substream);
+        struct tm6000_core *core = chip->core;
+        int err = 0;
+
+        switch (cmd) {
+        case SNDRV_PCM_TRIGGER_START:
+                atomic_set(&core->stream_started, 1);
+                break;
+        case SNDRV_PCM_TRIGGER_STOP:
+                atomic_set(&core->stream_started, 0);
+                break;
+        default:
+                err = -EINVAL;
+                break;
+        }
+        schedule_work(&core->wq_trigger);
+
+        return err;
+}
+/*
+ * pointer callback
+ */
+static snd_pcm_uframes_t snd_tm6000_pointer(struct snd_pcm_substream *substream)
+{
+        struct snd_tm6000_card *chip = snd_pcm_substream_chip(substream);
+
+        return chip->buf_pos;
+}
+
+/*
+ * operators
+ */
+static struct snd_pcm_ops snd_tm6000_pcm_ops = {
+        .open = snd_tm6000_pcm_open,
+        .close = snd_tm6000_close,
+        .ioctl = snd_pcm_lib_ioctl,
+        .hw_params = snd_tm6000_hw_params,
+        .hw_free = snd_tm6000_hw_free,
+        .prepare = snd_tm6000_prepare,
+        .trigger = snd_tm6000_card_trigger,
+        .pointer = snd_tm6000_pointer,
+};
+
+/*
+ * create a PCM device
+ */
+
+/* FIXME: Control interface - How to control volume/mute? */
+
+/****************************************************************************
+                        Basic Flow for Sound Devices
+ ****************************************************************************/
+
+/*
+ * Alsa Constructor - Component probe
+ */
+static int tm6000_audio_init(struct tm6000_core *dev)
+{
+        struct snd_card         *card;
+        struct snd_tm6000_card  *chip;
+        int                     rc;
+        static int              devnr;
+        char                    component[14];
+        struct snd_pcm          *pcm;
+
+        if (!dev)
+                return 0;
+
+        if (devnr >= SNDRV_CARDS)
+                return -ENODEV;
+
+        if (!enable[devnr])
+                return -ENOENT;
+
+        rc = snd_card_create(index[devnr], "tm6000", THIS_MODULE, 0, &card);
+        if (rc < 0) {
+                snd_printk(KERN_ERR "cannot create card instance %d\n", devnr);
+                return rc;
+        }
+        strcpy(card->driver, "tm6000-alsa");
+        strcpy(card->shortname, "TM5600/60x0");
+        sprintf(card->longname, "TM5600/60x0 Audio at bus %d device %d",
+                dev->udev->bus->busnum, dev->udev->devnum);
+
+        sprintf(component, "USB%04x:%04x",
+                le16_to_cpu(dev->udev->descriptor.idVendor),
+                le16_to_cpu(dev->udev->descriptor.idProduct));
+        snd_component_add(card, component);
+        snd_card_set_dev(card, &dev->udev->dev);
+
+        chip = kzalloc(sizeof(struct snd_tm6000_card), GFP_KERNEL);
+        if (!chip) {
+                rc = -ENOMEM;
+                goto error;
+        }
+
+        chip->core = dev;
+        chip->card = card;
+        dev->adev = chip;
+        spin_lock_init(&chip->reg_lock);
+
+        rc = snd_pcm_new(card, "TM6000 Audio", 0, 0, 1, &pcm);
+        if (rc < 0)
+                goto error_chip;
+
+        pcm->info_flags = 0;
+        pcm->private_data = chip;
+        strcpy(pcm->name, "Trident TM5600/60x0");
+
+        snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_tm6000_pcm_ops);
+
+        INIT_WORK(&dev->wq_trigger, audio_trigger);
+        rc = snd_card_register(card);
+        if (rc < 0)
+                goto error_chip;
+
+        dprintk(1, "Registered audio driver for %s\n", card->longname);
+
+        return 0;
+
+error_chip:
+        kfree(chip);
+        dev->adev = NULL;
+error:
+        snd_card_free(card);
+        return rc;
+}
+
+static int tm6000_audio_fini(struct tm6000_core *dev)
+{
+        struct snd_tm6000_card  *chip = dev->adev;
+
+        if (!dev)
+                return 0;
+
+        if (!chip)
+                return 0;
+
+        if (!chip->card)
+                return 0;
+
+        snd_card_free(chip->card);
+        chip->card = NULL;
+        kfree(chip);
+        dev->adev = NULL;
+
+        return 0;
+}
+
+static struct tm6000_ops audio_ops = {
+        .type   = TM6000_AUDIO,
+        .name   = "TM6000 Audio Extension",
+        .init   = tm6000_audio_init,
+        .fini   = tm6000_audio_fini,
+        .fillbuf = tm6000_fillbuf,
+};
+
+static int __init tm6000_alsa_register(void)
+{
+        return tm6000_register_extension(&audio_ops);
+}
+
+static void __exit tm6000_alsa_unregister(void)
+{
+        tm6000_unregister_extension(&audio_ops);
+}
+
+module_init(tm6000_alsa_register);
+module_exit(tm6000_alsa_unregister);