Initial Contribution
msm-2.6.38: tag AU_LINUX_ANDROID_GINGERBREAD.02.03.04.00.142
Signed-off-by: Bryan Huntsman <bryanh@codeaurora.org>
diff --git a/sound/soc/msm/msm8660-dma.c b/sound/soc/msm/msm8660-dma.c
new file mode 100644
index 0000000..8ab429a
--- /dev/null
+++ b/sound/soc/msm/msm8660-dma.c
@@ -0,0 +1,432 @@
+/* Copyright (c) 2010-2011, Code Aurora Forum. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program 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.
+ */
+
+#include <linux/module.h>
+#include <linux/platform_device.h>
+#include <linux/dma-mapping.h>
+#include <linux/debugfs.h>
+#include <linux/delay.h>
+#include <linux/uaccess.h>
+#include <linux/android_pmem.h>
+#include <linux/irq.h>
+#include <linux/interrupt.h>
+#include <linux/spinlock.h>
+#include <linux/slab.h>
+#include <linux/msm_audio.h>
+#include <linux/clk.h>
+#include <sound/core.h>
+#include <sound/pcm.h>
+#include <sound/soc.h>
+#include <mach/msm_iomap-8x60.h>
+#include <mach/audio_dma_msm8k.h>
+#include <sound/dai.h>
+#include "msm8660-pcm.h"
+
+struct dai_baseinfo {
+ void __iomem *base;
+};
+
+static struct dai_baseinfo dai_info;
+
+struct dai_drv {
+ u8 *buffer;
+ u32 buffer_phys;
+ int channels;
+ irqreturn_t (*callback) (int intrsrc, void *private_data);
+ void *private_data;
+ int in_use;
+ u32 buffer_len;
+ u32 period_len;
+ u32 master_mode;
+};
+
+static struct dai_drv *dai[MAX_CHANNELS];
+static spinlock_t dai_lock;
+
+static int dai_find_dma_channel(uint32_t intrsrc)
+{
+ int i, dma_channel = 0;
+ pr_debug("%s\n", __func__);
+
+ for (i = 0; i <= 27; i += 3) {
+ if (intrsrc & (1 << i)) {
+ dma_channel = i / 3;
+ break;
+ }
+ }
+ return dma_channel;
+}
+
+void register_dma_irq_handler(int dma_ch,
+ irqreturn_t (*callback) (int intrsrc, void *private_data),
+ void *private_data)
+{
+ pr_debug("%s\n", __func__);
+ dai[dma_ch]->callback = callback;
+ dai[dma_ch]->private_data = private_data;
+}
+
+void unregister_dma_irq_handler(int dma_ch)
+{
+ pr_debug("%s\n", __func__);
+ dai[dma_ch]->callback = NULL;
+ dai[dma_ch]->private_data = NULL;
+}
+
+static irqreturn_t dai_irq_handler(int irq, void *data)
+{
+ unsigned long flag;
+ uint32_t intrsrc;
+ uint32_t dma_ch = 0;
+ irqreturn_t ret = IRQ_HANDLED;
+
+ pr_debug("%s\n", __func__);
+ spin_lock_irqsave(&dai_lock, flag);
+ intrsrc = readl(dai_info.base + LPAIF_IRQ_STAT(0));
+ writel(intrsrc, dai_info.base + LPAIF_IRQ_CLEAR(0));
+ while (intrsrc) {
+ dma_ch = dai_find_dma_channel(intrsrc);
+
+ if (!dai[dma_ch]->callback)
+ goto handled;
+ if (!dai[dma_ch]->private_data)
+ goto handled;
+ ret = dai[dma_ch]->callback(intrsrc,
+ dai[dma_ch]->private_data);
+ intrsrc &= ~(0x7 << (dma_ch * 3));
+ }
+handled:
+ spin_unlock_irqrestore(&dai_lock, flag);
+ return ret;
+}
+
+void dai_print_state(uint32_t dma_ch)
+{
+ int i = 0;
+ unsigned long *ptrmem = (unsigned long *)dai_info.base;
+
+ for (i = 0; i < 4; i++, ++ptrmem)
+ pr_debug("[0x%08x]=0x%08x\n", (unsigned int)ptrmem,
+ (unsigned int)*ptrmem);
+
+ ptrmem = (unsigned long *)(dai_info.base
+ + DMA_CH_CTL_BASE + DMA_CH_INDEX(dma_ch));
+ for (i = 0; i < 10; i++, ++ptrmem)
+ pr_debug("[0x%08x]=0x%08x\n", (unsigned int)ptrmem,
+ (unsigned int) *ptrmem);
+}
+
+static int dai_enable_irq(uint32_t dma_ch)
+{
+ int ret;
+ pr_debug("%s\n", __func__);
+ ret = request_irq(LPASS_SCSS_AUDIO_IF_OUT0_IRQ, dai_irq_handler,
+ IRQF_TRIGGER_RISING | IRQF_SHARED, "msm-i2s",
+ (void *) (dma_ch+1));
+ if (ret < 0) {
+ pr_debug("Request Irq Failed err = %d\n", ret);
+ return ret;
+ }
+ return ret;
+}
+
+static void dai_config_dma(uint32_t dma_ch)
+{
+ pr_debug("%s dma_ch = %u\n", __func__, dma_ch);
+
+ writel(dai[dma_ch]->buffer_phys,
+ dai_info.base + LPAIF_DMA_BASE(dma_ch));
+ writel(((dai[dma_ch]->buffer_len >> 2) - 1),
+ dai_info.base + LPAIF_DMA_BUFF_LEN(dma_ch));
+ writel(((dai[dma_ch]->period_len >> 2) - 1),
+ dai_info.base + LPAIF_DMA_PER_LEN(dma_ch));
+}
+
+static void dai_enable_codec(uint32_t dma_ch, int codec)
+{
+ uint32_t intrVal;
+ uint32_t i2sctl;
+ pr_debug("%s\n", __func__);
+
+ intrVal = readl(dai_info.base + LPAIF_IRQ_EN(0));
+ intrVal = intrVal | (7 << (dma_ch * 3));
+ writel(intrVal, dai_info.base + LPAIF_IRQ_EN(0));
+ if (codec == DAI_SPKR) {
+ writel(0x0813, dai_info.base + LPAIF_DMA_CTL(dma_ch));
+ i2sctl = 0x4400;
+ i2sctl |= (dai[dma_ch]->master_mode ? WS_SRC_INT : WS_SRC_EXT);
+ writel(i2sctl, dai_info.base + LPAIF_I2S_CTL_OFFSET(DAI_SPKR));
+ } else if (codec == DAI_MIC) {
+ writel(0x81b, dai_info.base + LPAIF_DMA_CTL(dma_ch));
+ i2sctl = 0x0110;
+ i2sctl |= (dai[dma_ch]->master_mode ? WS_SRC_INT : WS_SRC_EXT);
+ writel(i2sctl, dai_info.base + LPAIF_I2S_CTL_OFFSET(DAI_MIC));
+ }
+}
+
+static void dai_disable_codec(uint32_t dma_ch, int codec)
+{
+ uint32_t intrVal = 0;
+ uint32_t intrVal1 = 0;
+ unsigned long flag = 0x0;
+
+ pr_debug("%s\n", __func__);
+ spin_lock_irqsave(&dai_lock, flag);
+
+ intrVal1 = readl(dai_info.base + LPAIF_I2S_CTL_OFFSET(codec));
+
+ if (codec == DAI_SPKR)
+ intrVal1 = intrVal1 & ~(1 << 14);
+ else if (codec == DAI_MIC)
+ intrVal1 = intrVal1 & ~(1 << 8);
+
+ writel(intrVal1, dai_info.base + LPAIF_I2S_CTL_OFFSET(codec));
+ intrVal = 0x0;
+ writel(intrVal, dai_info.base + LPAIF_DMA_CTL(dma_ch));
+
+ spin_unlock_irqrestore(&dai_lock, flag);
+}
+
+int dai_open(uint32_t dma_ch)
+{
+
+ pr_debug("%s\n", __func__);
+ if (!dai_info.base) {
+ pr_debug("%s failed as no msm-dai device\n", __func__);
+ return -ENODEV;
+ }
+ if (dma_ch >= MAX_CHANNELS) {
+ pr_debug("%s over max channesl %d\n", __func__, dma_ch);
+ return -ENODEV;
+ }
+ return 0;
+}
+
+void dai_close(uint32_t dma_ch)
+{
+ pr_debug("%s\n", __func__);
+ if ((dma_ch >= 0) && (dma_ch < 5))
+ dai_disable_codec(dma_ch, DAI_SPKR);
+ else
+ dai_disable_codec(dma_ch, DAI_MIC);
+ free_irq(LPASS_SCSS_AUDIO_IF_OUT0_IRQ, (void *) (dma_ch + 1));
+}
+
+void dai_set_master_mode(uint32_t dma_ch, int mode)
+{
+ if (dma_ch < MAX_CHANNELS)
+ dai[dma_ch]->master_mode = mode;
+ else
+ pr_err("%s: invalid dma channel\n", __func__);
+}
+
+int dai_set_params(uint32_t dma_ch, struct dai_dma_params *params)
+{
+ pr_debug("%s\n", __func__);
+ dai[dma_ch]->buffer = params->buffer;
+ dai[dma_ch]->buffer_phys = params->src_start;
+ dai[dma_ch]->channels = params->channels;
+ dai[dma_ch]->buffer_len = params->buffer_size;
+ dai[dma_ch]->period_len = params->period_size;
+ dai_config_dma(dma_ch);
+ return dma_ch;
+}
+
+int dai_start(uint32_t dma_ch)
+{
+ unsigned long flag = 0x0;
+
+ spin_lock_irqsave(&dai_lock, flag);
+ dai_enable_irq(dma_ch);
+ if ((dma_ch >= 0) && (dma_ch < 5))
+ dai_enable_codec(dma_ch, DAI_SPKR);
+ else
+ dai_enable_codec(dma_ch, DAI_MIC);
+ spin_unlock_irqrestore(&dai_lock, flag);
+ dai_print_state(dma_ch);
+ return 0;
+}
+
+#define HDMI_BURST_INCR4 (1 << 11)
+#define HDMI_WPSCNT (1 << 8)
+#define HDMI_AUDIO_INTF (5 << 4)
+#define HDMI_FIFO_WATER_MARK (7 << 1)
+#define HDMI_ENABLE (1)
+
+int dai_start_hdmi(uint32_t dma_ch)
+{
+ unsigned long flag = 0x0;
+ uint32_t val;
+
+ pr_debug("%s dma_ch = %u\n", __func__, dma_ch);
+
+ spin_lock_irqsave(&dai_lock, flag);
+
+ dai_enable_irq(dma_ch);
+
+ if ((dma_ch >= 0) && (dma_ch < 5)) {
+
+ val = readl(dai_info.base + LPAIF_IRQ_EN(0));
+ val = val | (7 << (dma_ch * 3));
+ writel(val, dai_info.base + LPAIF_IRQ_EN(0));
+
+
+ val = (HDMI_BURST_INCR4 | HDMI_WPSCNT | HDMI_AUDIO_INTF |
+ HDMI_FIFO_WATER_MARK | HDMI_ENABLE);
+
+ writel(val, dai_info.base + LPAIF_DMA_CTL(dma_ch));
+ }
+ spin_unlock_irqrestore(&dai_lock, flag);
+
+ dai_print_state(dma_ch);
+ return 0;
+}
+
+void dai_stop_hdmi(uint32_t dma_ch)
+{
+ unsigned long flag = 0x0;
+ uint32_t intrVal;
+ uint32_t int_mask = 0x00000007;
+
+ pr_debug("%s dma_ch %u\n", __func__, dma_ch);
+
+ spin_lock_irqsave(&dai_lock, flag);
+
+ free_irq(LPASS_SCSS_AUDIO_IF_OUT0_IRQ, (void *) (dma_ch + 1));
+
+
+ intrVal = 0x0;
+ writel(intrVal, dai_info.base + LPAIF_DMA_CTL(dma_ch));
+
+ intrVal = readl(dai_info.base + LPAIF_IRQ_EN(0));
+
+ int_mask = ((int_mask) << (dma_ch * 3));
+ int_mask = ~int_mask;
+
+ intrVal = intrVal && int_mask;
+ writel(intrVal, dai_info.base + LPAIF_IRQ_EN(0));
+
+ spin_unlock_irqrestore(&dai_lock, flag);
+}
+
+int dai_stop(uint32_t dma_ch)
+{
+ pr_debug("%s\n", __func__);
+ return 0;
+}
+
+
+uint32_t dai_get_dma_pos(uint32_t dma_ch)
+{
+
+ uint32_t addr;
+
+ pr_debug("%s\n", __func__);
+ addr = readl(dai_info.base + LPAIF_DMA_CURR_ADDR(dma_ch));
+
+ return addr;
+}
+
+static int __devinit dai_probe(struct platform_device *pdev)
+{
+ int rc = 0;
+ int i = 0;
+ struct resource *src;
+ src = platform_get_resource_byname(pdev, IORESOURCE_MEM, "msm-dai");
+ if (!src) {
+ rc = -ENODEV;
+ pr_debug("%s Error rc=%d\n", __func__, rc);
+ goto error;
+ }
+ for (i = 0; i <= MAX_CHANNELS; i++) {
+ dai[i] = kzalloc(sizeof(struct dai_drv), GFP_KERNEL);
+ if (!dai[0]) {
+ pr_debug("Allocation failed for dma_channel = 0\n");
+ return -ENODEV;
+ }
+ }
+ dai_info.base = ioremap(src->start, (src->end - src->start) + 1);
+ pr_debug("%s: msm-dai: 0x%08x\n", __func__,
+ (unsigned int)dai_info.base);
+ spin_lock_init(&dai_lock);
+error:
+ return rc;
+}
+
+static int dai_remove(struct platform_device *pdev)
+{
+ iounmap(dai_info.base);
+ return 0;
+}
+
+static struct platform_driver dai_driver = {
+ .probe = dai_probe,
+ .remove = dai_remove,
+ .driver = {
+ .name = "msm-dai",
+ .owner = THIS_MODULE
+ },
+};
+
+static struct resource msm_lpa_resources[] = {
+ {
+ .start = MSM_LPA_PHYS,
+ .end = MSM_LPA_END,
+ .flags = IORESOURCE_MEM,
+ .name = "msm-dai",
+ },
+};
+
+static struct platform_device *codec_device;
+
+static int msm_dai_dev_register(const char *name)
+{
+ int ret = 0;
+
+ pr_debug("%s : called\n", __func__);
+ codec_device = platform_device_alloc(name, -1);
+ if (codec_device == NULL) {
+ pr_debug("Failed to allocate %s\n", name);
+ return -ENODEV;
+ }
+
+ platform_set_drvdata(codec_device, (void *)&dai_info);
+ platform_device_add_resources(codec_device, &msm_lpa_resources[0],
+ ARRAY_SIZE(msm_lpa_resources));
+ ret = platform_device_add(codec_device);
+ if (ret != 0) {
+ pr_debug("Failed to register %s: %d\n", name, ret);
+ platform_device_put(codec_device);
+ }
+ return ret;
+}
+
+static int __init dai_init(void)
+{
+ if (msm_dai_dev_register("msm-dai")) {
+ pr_notice("dai_init: msm-dai Failed");
+ return -ENODEV;
+ }
+ return platform_driver_register(&dai_driver);
+}
+
+static void __exit dai_exit(void)
+{
+ platform_driver_unregister(&dai_driver);
+ platform_device_put(codec_device);
+}
+
+module_init(dai_init);
+module_exit(dai_exit);
+
+MODULE_DESCRIPTION("MSM I2S driver");
+MODULE_LICENSE("GPL v2");