0001
0002
0003
0004
0005
0006
0007
0008
0009
0010 #include <linux/init.h>
0011 #include <linux/module.h>
0012 #include <linux/device.h>
0013 #include <linux/delay.h>
0014 #include <linux/slab.h>
0015 #include <linux/io.h>
0016 #include <linux/mfd/davinci_voicecodec.h>
0017
0018 #include <sound/core.h>
0019 #include <sound/pcm.h>
0020 #include <sound/pcm_params.h>
0021 #include <sound/initval.h>
0022 #include <sound/soc.h>
0023 #include <sound/dmaengine_pcm.h>
0024
0025 #include "edma-pcm.h"
0026 #include "davinci-i2s.h"
0027
0028 #define MOD_REG_BIT(val, mask, set) do { \
0029 if (set) { \
0030 val |= mask; \
0031 } else { \
0032 val &= ~mask; \
0033 } \
0034 } while (0)
0035
0036 struct davinci_vcif_dev {
0037 struct davinci_vc *davinci_vc;
0038 struct snd_dmaengine_dai_dma_data dma_data[2];
0039 int dma_request[2];
0040 };
0041
0042 static void davinci_vcif_start(struct snd_pcm_substream *substream)
0043 {
0044 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
0045 struct davinci_vcif_dev *davinci_vcif_dev =
0046 snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0));
0047 struct davinci_vc *davinci_vc = davinci_vcif_dev->davinci_vc;
0048 u32 w;
0049
0050
0051 w = readl(davinci_vc->base + DAVINCI_VC_CTRL);
0052
0053 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
0054 MOD_REG_BIT(w, DAVINCI_VC_CTRL_RSTDAC, 0);
0055 else
0056 MOD_REG_BIT(w, DAVINCI_VC_CTRL_RSTADC, 0);
0057
0058 writel(w, davinci_vc->base + DAVINCI_VC_CTRL);
0059 }
0060
0061 static void davinci_vcif_stop(struct snd_pcm_substream *substream)
0062 {
0063 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
0064 struct davinci_vcif_dev *davinci_vcif_dev =
0065 snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0));
0066 struct davinci_vc *davinci_vc = davinci_vcif_dev->davinci_vc;
0067 u32 w;
0068
0069
0070 w = readl(davinci_vc->base + DAVINCI_VC_CTRL);
0071 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
0072 MOD_REG_BIT(w, DAVINCI_VC_CTRL_RSTDAC, 1);
0073 else
0074 MOD_REG_BIT(w, DAVINCI_VC_CTRL_RSTADC, 1);
0075
0076 writel(w, davinci_vc->base + DAVINCI_VC_CTRL);
0077 }
0078
0079 static int davinci_vcif_hw_params(struct snd_pcm_substream *substream,
0080 struct snd_pcm_hw_params *params,
0081 struct snd_soc_dai *dai)
0082 {
0083 struct davinci_vcif_dev *davinci_vcif_dev = snd_soc_dai_get_drvdata(dai);
0084 struct davinci_vc *davinci_vc = davinci_vcif_dev->davinci_vc;
0085 u32 w;
0086
0087
0088 davinci_vcif_stop(substream);
0089 davinci_vcif_start(substream);
0090
0091
0092 writel(DAVINCI_VC_CTRL_MASK, davinci_vc->base + DAVINCI_VC_CTRL);
0093
0094 writel(DAVINCI_VC_INT_MASK, davinci_vc->base + DAVINCI_VC_INTCLR);
0095
0096 writel(DAVINCI_VC_INT_MASK, davinci_vc->base + DAVINCI_VC_INTEN);
0097
0098 w = readl(davinci_vc->base + DAVINCI_VC_CTRL);
0099
0100
0101 switch (params_format(params)) {
0102 case SNDRV_PCM_FORMAT_U8:
0103 MOD_REG_BIT(w, DAVINCI_VC_CTRL_RD_BITS_8 |
0104 DAVINCI_VC_CTRL_RD_UNSIGNED |
0105 DAVINCI_VC_CTRL_WD_BITS_8 |
0106 DAVINCI_VC_CTRL_WD_UNSIGNED, 1);
0107 break;
0108 case SNDRV_PCM_FORMAT_S8:
0109 MOD_REG_BIT(w, DAVINCI_VC_CTRL_RD_BITS_8 |
0110 DAVINCI_VC_CTRL_WD_BITS_8, 1);
0111
0112 MOD_REG_BIT(w, DAVINCI_VC_CTRL_RD_UNSIGNED |
0113 DAVINCI_VC_CTRL_WD_UNSIGNED, 0);
0114 break;
0115 case SNDRV_PCM_FORMAT_S16_LE:
0116 MOD_REG_BIT(w, DAVINCI_VC_CTRL_RD_BITS_8 |
0117 DAVINCI_VC_CTRL_RD_UNSIGNED |
0118 DAVINCI_VC_CTRL_WD_BITS_8 |
0119 DAVINCI_VC_CTRL_WD_UNSIGNED, 0);
0120 break;
0121 default:
0122 printk(KERN_WARNING "davinci-vcif: unsupported PCM format");
0123 return -EINVAL;
0124 }
0125
0126 writel(w, davinci_vc->base + DAVINCI_VC_CTRL);
0127
0128 return 0;
0129 }
0130
0131 static int davinci_vcif_trigger(struct snd_pcm_substream *substream, int cmd,
0132 struct snd_soc_dai *dai)
0133 {
0134 int ret = 0;
0135
0136 switch (cmd) {
0137 case SNDRV_PCM_TRIGGER_START:
0138 case SNDRV_PCM_TRIGGER_RESUME:
0139 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
0140 davinci_vcif_start(substream);
0141 break;
0142 case SNDRV_PCM_TRIGGER_STOP:
0143 case SNDRV_PCM_TRIGGER_SUSPEND:
0144 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
0145 davinci_vcif_stop(substream);
0146 break;
0147 default:
0148 ret = -EINVAL;
0149 }
0150
0151 return ret;
0152 }
0153
0154 #define DAVINCI_VCIF_RATES SNDRV_PCM_RATE_8000_48000
0155
0156 static const struct snd_soc_dai_ops davinci_vcif_dai_ops = {
0157 .trigger = davinci_vcif_trigger,
0158 .hw_params = davinci_vcif_hw_params,
0159 };
0160
0161 static int davinci_vcif_dai_probe(struct snd_soc_dai *dai)
0162 {
0163 struct davinci_vcif_dev *dev = snd_soc_dai_get_drvdata(dai);
0164
0165 dai->playback_dma_data = &dev->dma_data[SNDRV_PCM_STREAM_PLAYBACK];
0166 dai->capture_dma_data = &dev->dma_data[SNDRV_PCM_STREAM_CAPTURE];
0167
0168 return 0;
0169 }
0170
0171 static struct snd_soc_dai_driver davinci_vcif_dai = {
0172 .probe = davinci_vcif_dai_probe,
0173 .playback = {
0174 .channels_min = 1,
0175 .channels_max = 2,
0176 .rates = DAVINCI_VCIF_RATES,
0177 .formats = SNDRV_PCM_FMTBIT_S16_LE,},
0178 .capture = {
0179 .channels_min = 1,
0180 .channels_max = 2,
0181 .rates = DAVINCI_VCIF_RATES,
0182 .formats = SNDRV_PCM_FMTBIT_S16_LE,},
0183 .ops = &davinci_vcif_dai_ops,
0184
0185 };
0186
0187 static const struct snd_soc_component_driver davinci_vcif_component = {
0188 .name = "davinci-vcif",
0189 .legacy_dai_naming = 1,
0190 };
0191
0192 static int davinci_vcif_probe(struct platform_device *pdev)
0193 {
0194 struct davinci_vc *davinci_vc = pdev->dev.platform_data;
0195 struct davinci_vcif_dev *davinci_vcif_dev;
0196 int ret;
0197
0198 davinci_vcif_dev = devm_kzalloc(&pdev->dev,
0199 sizeof(struct davinci_vcif_dev),
0200 GFP_KERNEL);
0201 if (!davinci_vcif_dev)
0202 return -ENOMEM;
0203
0204
0205 davinci_vcif_dev->davinci_vc = davinci_vc;
0206 davinci_vcif_dev->dma_data[SNDRV_PCM_STREAM_PLAYBACK].filter_data =
0207 &davinci_vc->davinci_vcif.dma_tx_channel;
0208 davinci_vcif_dev->dma_data[SNDRV_PCM_STREAM_PLAYBACK].addr =
0209 davinci_vc->davinci_vcif.dma_tx_addr;
0210
0211
0212 davinci_vcif_dev->dma_data[SNDRV_PCM_STREAM_CAPTURE].filter_data =
0213 &davinci_vc->davinci_vcif.dma_rx_channel;
0214 davinci_vcif_dev->dma_data[SNDRV_PCM_STREAM_CAPTURE].addr =
0215 davinci_vc->davinci_vcif.dma_rx_addr;
0216
0217 dev_set_drvdata(&pdev->dev, davinci_vcif_dev);
0218
0219 ret = devm_snd_soc_register_component(&pdev->dev,
0220 &davinci_vcif_component,
0221 &davinci_vcif_dai, 1);
0222 if (ret != 0) {
0223 dev_err(&pdev->dev, "could not register dai\n");
0224 return ret;
0225 }
0226
0227 ret = edma_pcm_platform_register(&pdev->dev);
0228 if (ret) {
0229 dev_err(&pdev->dev, "register PCM failed: %d\n", ret);
0230 return ret;
0231 }
0232
0233 return 0;
0234 }
0235
0236 static struct platform_driver davinci_vcif_driver = {
0237 .probe = davinci_vcif_probe,
0238 .driver = {
0239 .name = "davinci-vcif",
0240 },
0241 };
0242
0243 module_platform_driver(davinci_vcif_driver);
0244
0245 MODULE_AUTHOR("Miguel Aguilar");
0246 MODULE_DESCRIPTION("Texas Instruments DaVinci ASoC Voice Codec Interface");
0247 MODULE_LICENSE("GPL");