Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 1 | /* |
| 2 | * ALSA SoC I2S (McBSP) Audio Layer for TI DAVINCI processor |
| 3 | * |
Vladimir Barinov | d6b5203 | 2008-09-29 23:14:11 +0400 | [diff] [blame] | 4 | * Author: Vladimir Barinov, <vbarinov@embeddedalley.com> |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 5 | * Copyright: (C) 2007 MontaVista Software, Inc., <source@mvista.com> |
| 6 | * |
| 7 | * This program is free software; you can redistribute it and/or modify |
| 8 | * it under the terms of the GNU General Public License version 2 as |
| 9 | * published by the Free Software Foundation. |
| 10 | */ |
| 11 | |
| 12 | #include <linux/init.h> |
| 13 | #include <linux/module.h> |
| 14 | #include <linux/device.h> |
| 15 | #include <linux/delay.h> |
| 16 | #include <linux/io.h> |
| 17 | #include <linux/clk.h> |
| 18 | |
| 19 | #include <sound/core.h> |
| 20 | #include <sound/pcm.h> |
| 21 | #include <sound/pcm_params.h> |
| 22 | #include <sound/initval.h> |
| 23 | #include <sound/soc.h> |
| 24 | |
| 25 | #include "davinci-pcm.h" |
| 26 | |
| 27 | #define DAVINCI_MCBSP_DRR_REG 0x00 |
| 28 | #define DAVINCI_MCBSP_DXR_REG 0x04 |
| 29 | #define DAVINCI_MCBSP_SPCR_REG 0x08 |
| 30 | #define DAVINCI_MCBSP_RCR_REG 0x0c |
| 31 | #define DAVINCI_MCBSP_XCR_REG 0x10 |
| 32 | #define DAVINCI_MCBSP_SRGR_REG 0x14 |
| 33 | #define DAVINCI_MCBSP_PCR_REG 0x24 |
| 34 | |
| 35 | #define DAVINCI_MCBSP_SPCR_RRST (1 << 0) |
| 36 | #define DAVINCI_MCBSP_SPCR_RINTM(v) ((v) << 4) |
| 37 | #define DAVINCI_MCBSP_SPCR_XRST (1 << 16) |
| 38 | #define DAVINCI_MCBSP_SPCR_XINTM(v) ((v) << 20) |
| 39 | #define DAVINCI_MCBSP_SPCR_GRST (1 << 22) |
| 40 | #define DAVINCI_MCBSP_SPCR_FRST (1 << 23) |
| 41 | #define DAVINCI_MCBSP_SPCR_FREE (1 << 25) |
| 42 | |
| 43 | #define DAVINCI_MCBSP_RCR_RWDLEN1(v) ((v) << 5) |
| 44 | #define DAVINCI_MCBSP_RCR_RFRLEN1(v) ((v) << 8) |
| 45 | #define DAVINCI_MCBSP_RCR_RDATDLY(v) ((v) << 16) |
| 46 | #define DAVINCI_MCBSP_RCR_RWDLEN2(v) ((v) << 21) |
| 47 | |
| 48 | #define DAVINCI_MCBSP_XCR_XWDLEN1(v) ((v) << 5) |
| 49 | #define DAVINCI_MCBSP_XCR_XFRLEN1(v) ((v) << 8) |
| 50 | #define DAVINCI_MCBSP_XCR_XDATDLY(v) ((v) << 16) |
| 51 | #define DAVINCI_MCBSP_XCR_XFIG (1 << 18) |
| 52 | #define DAVINCI_MCBSP_XCR_XWDLEN2(v) ((v) << 21) |
| 53 | |
| 54 | #define DAVINCI_MCBSP_SRGR_FWID(v) ((v) << 8) |
| 55 | #define DAVINCI_MCBSP_SRGR_FPER(v) ((v) << 16) |
| 56 | #define DAVINCI_MCBSP_SRGR_FSGM (1 << 28) |
| 57 | |
| 58 | #define DAVINCI_MCBSP_PCR_CLKRP (1 << 0) |
| 59 | #define DAVINCI_MCBSP_PCR_CLKXP (1 << 1) |
| 60 | #define DAVINCI_MCBSP_PCR_FSRP (1 << 2) |
| 61 | #define DAVINCI_MCBSP_PCR_FSXP (1 << 3) |
Hugo Villeneuve | b402dff | 2008-11-08 13:26:09 -0500 | [diff] [blame] | 62 | #define DAVINCI_MCBSP_PCR_SCLKME (1 << 7) |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 63 | #define DAVINCI_MCBSP_PCR_CLKRM (1 << 8) |
| 64 | #define DAVINCI_MCBSP_PCR_CLKXM (1 << 9) |
| 65 | #define DAVINCI_MCBSP_PCR_FSRM (1 << 10) |
| 66 | #define DAVINCI_MCBSP_PCR_FSXM (1 << 11) |
| 67 | |
| 68 | #define MOD_REG_BIT(val, mask, set) do { \ |
| 69 | if (set) { \ |
| 70 | val |= mask; \ |
| 71 | } else { \ |
| 72 | val &= ~mask; \ |
| 73 | } \ |
| 74 | } while (0) |
| 75 | |
| 76 | enum { |
| 77 | DAVINCI_MCBSP_WORD_8 = 0, |
| 78 | DAVINCI_MCBSP_WORD_12, |
| 79 | DAVINCI_MCBSP_WORD_16, |
| 80 | DAVINCI_MCBSP_WORD_20, |
| 81 | DAVINCI_MCBSP_WORD_24, |
| 82 | DAVINCI_MCBSP_WORD_32, |
| 83 | }; |
| 84 | |
| 85 | static struct davinci_pcm_dma_params davinci_i2s_pcm_out = { |
| 86 | .name = "I2S PCM Stereo out", |
| 87 | }; |
| 88 | |
| 89 | static struct davinci_pcm_dma_params davinci_i2s_pcm_in = { |
| 90 | .name = "I2S PCM Stereo in", |
| 91 | }; |
| 92 | |
| 93 | struct davinci_mcbsp_dev { |
| 94 | void __iomem *base; |
| 95 | struct clk *clk; |
| 96 | struct davinci_pcm_dma_params *dma_params[2]; |
| 97 | }; |
| 98 | |
| 99 | static inline void davinci_mcbsp_write_reg(struct davinci_mcbsp_dev *dev, |
| 100 | int reg, u32 val) |
| 101 | { |
| 102 | __raw_writel(val, dev->base + reg); |
| 103 | } |
| 104 | |
| 105 | static inline u32 davinci_mcbsp_read_reg(struct davinci_mcbsp_dev *dev, int reg) |
| 106 | { |
| 107 | return __raw_readl(dev->base + reg); |
| 108 | } |
| 109 | |
| 110 | static void davinci_mcbsp_start(struct snd_pcm_substream *substream) |
| 111 | { |
| 112 | struct snd_soc_pcm_runtime *rtd = substream->private_data; |
| 113 | struct davinci_mcbsp_dev *dev = rtd->dai->cpu_dai->private_data; |
Naresh Medisetty | fb0ef64 | 2008-11-12 10:26:31 +0530 | [diff] [blame] | 114 | struct snd_soc_device *socdev = rtd->socdev; |
Mark Brown | 87689d5 | 2008-12-02 16:01:14 +0000 | [diff] [blame] | 115 | struct snd_soc_platform *platform = socdev->card->platform; |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 116 | u32 w; |
Naresh Medisetty | fb0ef64 | 2008-11-12 10:26:31 +0530 | [diff] [blame] | 117 | int ret; |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 118 | |
| 119 | /* Start the sample generator and enable transmitter/receiver */ |
| 120 | w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_SPCR_REG); |
| 121 | MOD_REG_BIT(w, DAVINCI_MCBSP_SPCR_GRST, 1); |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 122 | davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SPCR_REG, w); |
| 123 | |
Naresh Medisetty | fb0ef64 | 2008-11-12 10:26:31 +0530 | [diff] [blame] | 124 | if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { |
| 125 | /* Stop the DMA to avoid data loss */ |
| 126 | /* while the transmitter is out of reset to handle XSYNCERR */ |
| 127 | if (platform->pcm_ops->trigger) { |
| 128 | ret = platform->pcm_ops->trigger(substream, |
| 129 | SNDRV_PCM_TRIGGER_STOP); |
| 130 | if (ret < 0) |
| 131 | printk(KERN_DEBUG "Playback DMA stop failed\n"); |
| 132 | } |
| 133 | |
| 134 | /* Enable the transmitter */ |
| 135 | w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_SPCR_REG); |
| 136 | MOD_REG_BIT(w, DAVINCI_MCBSP_SPCR_XRST, 1); |
| 137 | davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SPCR_REG, w); |
| 138 | |
| 139 | /* wait for any unexpected frame sync error to occur */ |
| 140 | udelay(100); |
| 141 | |
| 142 | /* Disable the transmitter to clear any outstanding XSYNCERR */ |
| 143 | w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_SPCR_REG); |
| 144 | MOD_REG_BIT(w, DAVINCI_MCBSP_SPCR_XRST, 0); |
| 145 | davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SPCR_REG, w); |
| 146 | |
| 147 | /* Restart the DMA */ |
| 148 | if (platform->pcm_ops->trigger) { |
| 149 | ret = platform->pcm_ops->trigger(substream, |
| 150 | SNDRV_PCM_TRIGGER_START); |
| 151 | if (ret < 0) |
| 152 | printk(KERN_DEBUG "Playback DMA start failed\n"); |
| 153 | } |
| 154 | /* Enable the transmitter */ |
| 155 | w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_SPCR_REG); |
| 156 | MOD_REG_BIT(w, DAVINCI_MCBSP_SPCR_XRST, 1); |
| 157 | davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SPCR_REG, w); |
| 158 | |
| 159 | } else { |
| 160 | |
| 161 | /* Enable the reciever */ |
| 162 | w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_SPCR_REG); |
| 163 | MOD_REG_BIT(w, DAVINCI_MCBSP_SPCR_RRST, 1); |
| 164 | davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SPCR_REG, w); |
| 165 | } |
| 166 | |
| 167 | |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 168 | /* Start frame sync */ |
| 169 | w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_SPCR_REG); |
| 170 | MOD_REG_BIT(w, DAVINCI_MCBSP_SPCR_FRST, 1); |
| 171 | davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SPCR_REG, w); |
| 172 | } |
| 173 | |
| 174 | static void davinci_mcbsp_stop(struct snd_pcm_substream *substream) |
| 175 | { |
| 176 | struct snd_soc_pcm_runtime *rtd = substream->private_data; |
| 177 | struct davinci_mcbsp_dev *dev = rtd->dai->cpu_dai->private_data; |
| 178 | u32 w; |
| 179 | |
| 180 | /* Reset transmitter/receiver and sample rate/frame sync generators */ |
| 181 | w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_SPCR_REG); |
| 182 | MOD_REG_BIT(w, DAVINCI_MCBSP_SPCR_GRST | |
| 183 | DAVINCI_MCBSP_SPCR_FRST, 0); |
| 184 | if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) |
| 185 | MOD_REG_BIT(w, DAVINCI_MCBSP_SPCR_XRST, 0); |
| 186 | else |
| 187 | MOD_REG_BIT(w, DAVINCI_MCBSP_SPCR_RRST, 0); |
| 188 | davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SPCR_REG, w); |
| 189 | } |
| 190 | |
Mark Brown | dee89c4 | 2008-11-18 22:11:38 +0000 | [diff] [blame] | 191 | static int davinci_i2s_startup(struct snd_pcm_substream *substream, |
| 192 | struct snd_soc_dai *dai) |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 193 | { |
| 194 | struct snd_soc_pcm_runtime *rtd = substream->private_data; |
Liam Girdwood | 9cb132d | 2008-07-07 16:07:42 +0100 | [diff] [blame] | 195 | struct snd_soc_dai *cpu_dai = rtd->dai->cpu_dai; |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 196 | struct davinci_mcbsp_dev *dev = rtd->dai->cpu_dai->private_data; |
| 197 | |
| 198 | cpu_dai->dma_data = dev->dma_params[substream->stream]; |
| 199 | |
| 200 | return 0; |
| 201 | } |
| 202 | |
Troy Kisky | 21903c1 | 2008-12-18 12:36:43 -0700 | [diff] [blame] | 203 | #define DEFAULT_BITPERSAMPLE 16 |
| 204 | |
Liam Girdwood | 9cb132d | 2008-07-07 16:07:42 +0100 | [diff] [blame] | 205 | static int davinci_i2s_set_dai_fmt(struct snd_soc_dai *cpu_dai, |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 206 | unsigned int fmt) |
| 207 | { |
| 208 | struct davinci_mcbsp_dev *dev = cpu_dai->private_data; |
Troy Kisky | 21903c1 | 2008-12-18 12:36:43 -0700 | [diff] [blame] | 209 | unsigned int pcr; |
| 210 | unsigned int srgr; |
| 211 | unsigned int rcr; |
| 212 | unsigned int xcr; |
| 213 | srgr = DAVINCI_MCBSP_SRGR_FSGM | |
| 214 | DAVINCI_MCBSP_SRGR_FPER(DEFAULT_BITPERSAMPLE * 2 - 1) | |
| 215 | DAVINCI_MCBSP_SRGR_FWID(DEFAULT_BITPERSAMPLE - 1); |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 216 | |
| 217 | switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { |
| 218 | case SND_SOC_DAIFMT_CBS_CFS: |
Troy Kisky | 21903c1 | 2008-12-18 12:36:43 -0700 | [diff] [blame] | 219 | /* cpu is master */ |
| 220 | pcr = DAVINCI_MCBSP_PCR_FSXM | |
| 221 | DAVINCI_MCBSP_PCR_FSRM | |
| 222 | DAVINCI_MCBSP_PCR_CLKXM | |
| 223 | DAVINCI_MCBSP_PCR_CLKRM; |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 224 | break; |
Hugo Villeneuve | b402dff | 2008-11-08 13:26:09 -0500 | [diff] [blame] | 225 | case SND_SOC_DAIFMT_CBM_CFS: |
| 226 | /* McBSP CLKR pin is the input for the Sample Rate Generator. |
| 227 | * McBSP FSR and FSX are driven by the Sample Rate Generator. */ |
Troy Kisky | 21903c1 | 2008-12-18 12:36:43 -0700 | [diff] [blame] | 228 | pcr = DAVINCI_MCBSP_PCR_SCLKME | |
| 229 | DAVINCI_MCBSP_PCR_FSXM | |
| 230 | DAVINCI_MCBSP_PCR_FSRM; |
Hugo Villeneuve | b402dff | 2008-11-08 13:26:09 -0500 | [diff] [blame] | 231 | break; |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 232 | case SND_SOC_DAIFMT_CBM_CFM: |
Troy Kisky | 21903c1 | 2008-12-18 12:36:43 -0700 | [diff] [blame] | 233 | /* codec is master */ |
| 234 | pcr = 0; |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 235 | break; |
| 236 | default: |
Troy Kisky | 21903c1 | 2008-12-18 12:36:43 -0700 | [diff] [blame] | 237 | printk(KERN_ERR "%s:bad master\n", __func__); |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 238 | return -EINVAL; |
| 239 | } |
| 240 | |
Troy Kisky | 69ab820 | 2008-12-18 12:36:44 -0700 | [diff] [blame^] | 241 | rcr = DAVINCI_MCBSP_RCR_RFRLEN1(1); |
| 242 | xcr = DAVINCI_MCBSP_XCR_XFIG | DAVINCI_MCBSP_XCR_XFRLEN1(1); |
| 243 | switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { |
| 244 | case SND_SOC_DAIFMT_RIGHT_J: |
| 245 | break; |
| 246 | case SND_SOC_DAIFMT_I2S: |
| 247 | case SND_SOC_DAIFMT_DSP_B: |
| 248 | rcr |= DAVINCI_MCBSP_RCR_RDATDLY(1); |
| 249 | xcr |= DAVINCI_MCBSP_XCR_XDATDLY(1); |
| 250 | break; |
| 251 | default: |
| 252 | printk(KERN_ERR "%s:bad format\n", __func__); |
| 253 | return -EINVAL; |
| 254 | } |
| 255 | |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 256 | switch (fmt & SND_SOC_DAIFMT_INV_MASK) { |
| 257 | case SND_SOC_DAIFMT_IB_NF: |
Troy Kisky | 664b4af | 2008-12-18 12:36:41 -0700 | [diff] [blame] | 258 | /* CLKRP Receive clock polarity, |
| 259 | * 1 - sampled on rising edge of CLKR |
| 260 | * valid on rising edge |
| 261 | * CLKXP Transmit clock polarity, |
| 262 | * 1 - clocked on falling edge of CLKX |
| 263 | * valid on rising edge |
| 264 | * FSRP Receive frame sync pol, 0 - active high |
| 265 | * FSXP Transmit frame sync pol, 0 - active high |
| 266 | */ |
Troy Kisky | 21903c1 | 2008-12-18 12:36:43 -0700 | [diff] [blame] | 267 | pcr |= (DAVINCI_MCBSP_PCR_CLKXP | DAVINCI_MCBSP_PCR_CLKRP); |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 268 | break; |
| 269 | case SND_SOC_DAIFMT_NB_IF: |
Troy Kisky | 664b4af | 2008-12-18 12:36:41 -0700 | [diff] [blame] | 270 | /* CLKRP Receive clock polarity, |
| 271 | * 0 - sampled on falling edge of CLKR |
| 272 | * valid on falling edge |
| 273 | * CLKXP Transmit clock polarity, |
| 274 | * 0 - clocked on rising edge of CLKX |
| 275 | * valid on falling edge |
| 276 | * FSRP Receive frame sync pol, 1 - active low |
| 277 | * FSXP Transmit frame sync pol, 1 - active low |
| 278 | */ |
Troy Kisky | 21903c1 | 2008-12-18 12:36:43 -0700 | [diff] [blame] | 279 | pcr |= (DAVINCI_MCBSP_PCR_FSXP | DAVINCI_MCBSP_PCR_FSRP); |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 280 | break; |
| 281 | case SND_SOC_DAIFMT_IB_IF: |
Troy Kisky | 664b4af | 2008-12-18 12:36:41 -0700 | [diff] [blame] | 282 | /* CLKRP Receive clock polarity, |
| 283 | * 1 - sampled on rising edge of CLKR |
| 284 | * valid on rising edge |
| 285 | * CLKXP Transmit clock polarity, |
| 286 | * 1 - clocked on falling edge of CLKX |
| 287 | * valid on rising edge |
| 288 | * FSRP Receive frame sync pol, 1 - active low |
| 289 | * FSXP Transmit frame sync pol, 1 - active low |
| 290 | */ |
Troy Kisky | 21903c1 | 2008-12-18 12:36:43 -0700 | [diff] [blame] | 291 | pcr |= (DAVINCI_MCBSP_PCR_CLKXP | DAVINCI_MCBSP_PCR_CLKRP | |
| 292 | DAVINCI_MCBSP_PCR_FSXP | DAVINCI_MCBSP_PCR_FSRP); |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 293 | break; |
| 294 | case SND_SOC_DAIFMT_NB_NF: |
Troy Kisky | 664b4af | 2008-12-18 12:36:41 -0700 | [diff] [blame] | 295 | /* CLKRP Receive clock polarity, |
| 296 | * 0 - sampled on falling edge of CLKR |
| 297 | * valid on falling edge |
| 298 | * CLKXP Transmit clock polarity, |
| 299 | * 0 - clocked on rising edge of CLKX |
| 300 | * valid on falling edge |
| 301 | * FSRP Receive frame sync pol, 0 - active high |
| 302 | * FSXP Transmit frame sync pol, 0 - active high |
| 303 | */ |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 304 | break; |
| 305 | default: |
| 306 | return -EINVAL; |
| 307 | } |
Troy Kisky | 21903c1 | 2008-12-18 12:36:43 -0700 | [diff] [blame] | 308 | davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SRGR_REG, srgr); |
| 309 | davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_PCR_REG, pcr); |
| 310 | davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_RCR_REG, rcr); |
| 311 | davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_XCR_REG, xcr); |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 312 | return 0; |
| 313 | } |
| 314 | |
| 315 | static int davinci_i2s_hw_params(struct snd_pcm_substream *substream, |
Mark Brown | dee89c4 | 2008-11-18 22:11:38 +0000 | [diff] [blame] | 316 | struct snd_pcm_hw_params *params, |
| 317 | struct snd_soc_dai *dai) |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 318 | { |
| 319 | struct snd_soc_pcm_runtime *rtd = substream->private_data; |
| 320 | struct davinci_pcm_dma_params *dma_params = rtd->dai->cpu_dai->dma_data; |
| 321 | struct davinci_mcbsp_dev *dev = rtd->dai->cpu_dai->private_data; |
| 322 | struct snd_interval *i = NULL; |
| 323 | int mcbsp_word_length; |
| 324 | u32 w; |
| 325 | |
| 326 | /* general line settings */ |
Naresh Medisetty | cb6e206 | 2008-11-18 11:01:03 +0530 | [diff] [blame] | 327 | w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_SPCR_REG); |
| 328 | if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) { |
| 329 | w |= DAVINCI_MCBSP_SPCR_RINTM(3) | DAVINCI_MCBSP_SPCR_FREE; |
| 330 | davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SPCR_REG, w); |
| 331 | } else { |
| 332 | w |= DAVINCI_MCBSP_SPCR_XINTM(3) | DAVINCI_MCBSP_SPCR_FREE; |
| 333 | davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SPCR_REG, w); |
| 334 | } |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 335 | |
| 336 | i = hw_param_interval(params, SNDRV_PCM_HW_PARAM_SAMPLE_BITS); |
Troy Kisky | 21903c1 | 2008-12-18 12:36:43 -0700 | [diff] [blame] | 337 | w = DAVINCI_MCBSP_SRGR_FSGM; |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 338 | MOD_REG_BIT(w, DAVINCI_MCBSP_SRGR_FWID(snd_interval_value(i) - 1), 1); |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 339 | |
| 340 | i = hw_param_interval(params, SNDRV_PCM_HW_PARAM_FRAME_BITS); |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 341 | MOD_REG_BIT(w, DAVINCI_MCBSP_SRGR_FPER(snd_interval_value(i) - 1), 1); |
| 342 | davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SRGR_REG, w); |
| 343 | |
| 344 | /* Determine xfer data type */ |
| 345 | switch (params_format(params)) { |
| 346 | case SNDRV_PCM_FORMAT_S8: |
| 347 | dma_params->data_type = 1; |
| 348 | mcbsp_word_length = DAVINCI_MCBSP_WORD_8; |
| 349 | break; |
| 350 | case SNDRV_PCM_FORMAT_S16_LE: |
| 351 | dma_params->data_type = 2; |
| 352 | mcbsp_word_length = DAVINCI_MCBSP_WORD_16; |
| 353 | break; |
| 354 | case SNDRV_PCM_FORMAT_S32_LE: |
| 355 | dma_params->data_type = 4; |
| 356 | mcbsp_word_length = DAVINCI_MCBSP_WORD_32; |
| 357 | break; |
| 358 | default: |
Jean Delvare | 9b6e12e | 2008-08-26 15:47:55 +0200 | [diff] [blame] | 359 | printk(KERN_WARNING "davinci-i2s: unsupported PCM format\n"); |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 360 | return -EINVAL; |
| 361 | } |
| 362 | |
Naresh Medisetty | cb6e206 | 2008-11-18 11:01:03 +0530 | [diff] [blame] | 363 | if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) { |
| 364 | w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_RCR_REG); |
| 365 | MOD_REG_BIT(w, DAVINCI_MCBSP_RCR_RWDLEN1(mcbsp_word_length) | |
| 366 | DAVINCI_MCBSP_RCR_RWDLEN2(mcbsp_word_length), 1); |
| 367 | davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_RCR_REG, w); |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 368 | |
Naresh Medisetty | cb6e206 | 2008-11-18 11:01:03 +0530 | [diff] [blame] | 369 | } else { |
| 370 | w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_XCR_REG); |
| 371 | MOD_REG_BIT(w, DAVINCI_MCBSP_XCR_XWDLEN1(mcbsp_word_length) | |
| 372 | DAVINCI_MCBSP_XCR_XWDLEN2(mcbsp_word_length), 1); |
| 373 | davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_XCR_REG, w); |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 374 | |
Naresh Medisetty | cb6e206 | 2008-11-18 11:01:03 +0530 | [diff] [blame] | 375 | } |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 376 | return 0; |
| 377 | } |
| 378 | |
Mark Brown | dee89c4 | 2008-11-18 22:11:38 +0000 | [diff] [blame] | 379 | static int davinci_i2s_trigger(struct snd_pcm_substream *substream, int cmd, |
| 380 | struct snd_soc_dai *dai) |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 381 | { |
| 382 | int ret = 0; |
| 383 | |
| 384 | switch (cmd) { |
| 385 | case SNDRV_PCM_TRIGGER_START: |
| 386 | case SNDRV_PCM_TRIGGER_RESUME: |
| 387 | case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: |
| 388 | davinci_mcbsp_start(substream); |
| 389 | break; |
| 390 | case SNDRV_PCM_TRIGGER_STOP: |
| 391 | case SNDRV_PCM_TRIGGER_SUSPEND: |
| 392 | case SNDRV_PCM_TRIGGER_PAUSE_PUSH: |
| 393 | davinci_mcbsp_stop(substream); |
| 394 | break; |
| 395 | default: |
| 396 | ret = -EINVAL; |
| 397 | } |
| 398 | |
| 399 | return ret; |
| 400 | } |
| 401 | |
Mark Brown | bdb9287 | 2008-06-11 13:47:10 +0100 | [diff] [blame] | 402 | static int davinci_i2s_probe(struct platform_device *pdev, |
Liam Girdwood | 9cb132d | 2008-07-07 16:07:42 +0100 | [diff] [blame] | 403 | struct snd_soc_dai *dai) |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 404 | { |
| 405 | struct snd_soc_device *socdev = platform_get_drvdata(pdev); |
Mark Brown | 8750654 | 2008-11-18 20:50:34 +0000 | [diff] [blame] | 406 | struct snd_soc_card *card = socdev->card; |
| 407 | struct snd_soc_dai *cpu_dai = card->dai_link[pdev->id].cpu_dai; |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 408 | struct davinci_mcbsp_dev *dev; |
| 409 | struct resource *mem, *ioarea; |
| 410 | struct evm_snd_platform_data *pdata; |
| 411 | int ret; |
| 412 | |
| 413 | mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| 414 | if (!mem) { |
| 415 | dev_err(&pdev->dev, "no mem resource?\n"); |
| 416 | return -ENODEV; |
| 417 | } |
| 418 | |
| 419 | ioarea = request_mem_region(mem->start, (mem->end - mem->start) + 1, |
| 420 | pdev->name); |
| 421 | if (!ioarea) { |
| 422 | dev_err(&pdev->dev, "McBSP region already claimed\n"); |
| 423 | return -EBUSY; |
| 424 | } |
| 425 | |
| 426 | dev = kzalloc(sizeof(struct davinci_mcbsp_dev), GFP_KERNEL); |
| 427 | if (!dev) { |
| 428 | ret = -ENOMEM; |
| 429 | goto err_release_region; |
| 430 | } |
| 431 | |
| 432 | cpu_dai->private_data = dev; |
| 433 | |
| 434 | dev->clk = clk_get(&pdev->dev, "McBSPCLK"); |
| 435 | if (IS_ERR(dev->clk)) { |
| 436 | ret = -ENODEV; |
| 437 | goto err_free_mem; |
| 438 | } |
| 439 | clk_enable(dev->clk); |
| 440 | |
| 441 | dev->base = (void __iomem *)IO_ADDRESS(mem->start); |
| 442 | pdata = pdev->dev.platform_data; |
| 443 | |
| 444 | dev->dma_params[SNDRV_PCM_STREAM_PLAYBACK] = &davinci_i2s_pcm_out; |
| 445 | dev->dma_params[SNDRV_PCM_STREAM_PLAYBACK]->channel = pdata->tx_dma_ch; |
| 446 | dev->dma_params[SNDRV_PCM_STREAM_PLAYBACK]->dma_addr = |
| 447 | (dma_addr_t)(io_v2p(dev->base) + DAVINCI_MCBSP_DXR_REG); |
| 448 | |
| 449 | dev->dma_params[SNDRV_PCM_STREAM_CAPTURE] = &davinci_i2s_pcm_in; |
| 450 | dev->dma_params[SNDRV_PCM_STREAM_CAPTURE]->channel = pdata->rx_dma_ch; |
| 451 | dev->dma_params[SNDRV_PCM_STREAM_CAPTURE]->dma_addr = |
| 452 | (dma_addr_t)(io_v2p(dev->base) + DAVINCI_MCBSP_DRR_REG); |
| 453 | |
| 454 | return 0; |
| 455 | |
| 456 | err_free_mem: |
| 457 | kfree(dev); |
| 458 | err_release_region: |
| 459 | release_mem_region(mem->start, (mem->end - mem->start) + 1); |
| 460 | |
| 461 | return ret; |
| 462 | } |
| 463 | |
Mark Brown | bdb9287 | 2008-06-11 13:47:10 +0100 | [diff] [blame] | 464 | static void davinci_i2s_remove(struct platform_device *pdev, |
Liam Girdwood | 9cb132d | 2008-07-07 16:07:42 +0100 | [diff] [blame] | 465 | struct snd_soc_dai *dai) |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 466 | { |
| 467 | struct snd_soc_device *socdev = platform_get_drvdata(pdev); |
Mark Brown | 8750654 | 2008-11-18 20:50:34 +0000 | [diff] [blame] | 468 | struct snd_soc_card *card = socdev->card; |
| 469 | struct snd_soc_dai *cpu_dai = card->dai_link[pdev->id].cpu_dai; |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 470 | struct davinci_mcbsp_dev *dev = cpu_dai->private_data; |
| 471 | struct resource *mem; |
| 472 | |
| 473 | clk_disable(dev->clk); |
| 474 | clk_put(dev->clk); |
| 475 | dev->clk = NULL; |
| 476 | |
| 477 | kfree(dev); |
| 478 | |
| 479 | mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| 480 | release_mem_region(mem->start, (mem->end - mem->start) + 1); |
| 481 | } |
| 482 | |
| 483 | #define DAVINCI_I2S_RATES SNDRV_PCM_RATE_8000_96000 |
| 484 | |
Liam Girdwood | 9cb132d | 2008-07-07 16:07:42 +0100 | [diff] [blame] | 485 | struct snd_soc_dai davinci_i2s_dai = { |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 486 | .name = "davinci-i2s", |
| 487 | .id = 0, |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 488 | .probe = davinci_i2s_probe, |
| 489 | .remove = davinci_i2s_remove, |
| 490 | .playback = { |
| 491 | .channels_min = 2, |
| 492 | .channels_max = 2, |
| 493 | .rates = DAVINCI_I2S_RATES, |
| 494 | .formats = SNDRV_PCM_FMTBIT_S16_LE,}, |
| 495 | .capture = { |
| 496 | .channels_min = 2, |
| 497 | .channels_max = 2, |
| 498 | .rates = DAVINCI_I2S_RATES, |
| 499 | .formats = SNDRV_PCM_FMTBIT_S16_LE,}, |
| 500 | .ops = { |
| 501 | .startup = davinci_i2s_startup, |
| 502 | .trigger = davinci_i2s_trigger, |
Mark Brown | dee89c4 | 2008-11-18 22:11:38 +0000 | [diff] [blame] | 503 | .hw_params = davinci_i2s_hw_params, |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 504 | .set_fmt = davinci_i2s_set_dai_fmt, |
| 505 | }, |
| 506 | }; |
| 507 | EXPORT_SYMBOL_GPL(davinci_i2s_dai); |
| 508 | |
Takashi Iwai | c9b3a40 | 2008-12-10 07:47:22 +0100 | [diff] [blame] | 509 | static int __init davinci_i2s_init(void) |
Mark Brown | 3f4b783 | 2008-12-03 19:26:35 +0000 | [diff] [blame] | 510 | { |
| 511 | return snd_soc_register_dai(&davinci_i2s_dai); |
| 512 | } |
| 513 | module_init(davinci_i2s_init); |
| 514 | |
| 515 | static void __exit davinci_i2s_exit(void) |
| 516 | { |
| 517 | snd_soc_unregister_dai(&davinci_i2s_dai); |
| 518 | } |
| 519 | module_exit(davinci_i2s_exit); |
| 520 | |
Vladimir Barinov | 310355c | 2008-02-18 11:40:22 +0100 | [diff] [blame] | 521 | MODULE_AUTHOR("Vladimir Barinov"); |
| 522 | MODULE_DESCRIPTION("TI DAVINCI I2S (McBSP) SoC Interface"); |
| 523 | MODULE_LICENSE("GPL"); |