This source file includes following definitions.
- psc_i2s_hw_params
- psc_i2s_set_sysclk
- psc_i2s_set_fmt
- psc_i2s_of_probe
- psc_i2s_of_remove
   1 
   2 
   3 
   4 
   5 
   6 
   7 
   8 
   9 #include <linux/module.h>
  10 #include <linux/of_device.h>
  11 #include <linux/of_platform.h>
  12 
  13 #include <sound/pcm.h>
  14 #include <sound/pcm_params.h>
  15 #include <sound/soc.h>
  16 
  17 #include <asm/mpc52xx_psc.h>
  18 
  19 #include "mpc5200_dma.h"
  20 
  21 
  22 
  23 
  24 
  25 
  26 
  27 
  28 
  29 #define PSC_I2S_RATES SNDRV_PCM_RATE_CONTINUOUS
  30 
  31 
  32 
  33 
  34 #define PSC_I2S_FORMATS (SNDRV_PCM_FMTBIT_S8 | SNDRV_PCM_FMTBIT_S16_BE | \
  35                          SNDRV_PCM_FMTBIT_S24_BE | SNDRV_PCM_FMTBIT_S32_BE)
  36 
  37 static int psc_i2s_hw_params(struct snd_pcm_substream *substream,
  38                                  struct snd_pcm_hw_params *params,
  39                                  struct snd_soc_dai *dai)
  40 {
  41         struct snd_soc_pcm_runtime *rtd = substream->private_data;
  42         struct psc_dma *psc_dma = snd_soc_dai_get_drvdata(rtd->cpu_dai);
  43         u32 mode;
  44 
  45         dev_dbg(psc_dma->dev, "%s(substream=%p) p_size=%i p_bytes=%i"
  46                 " periods=%i buffer_size=%i  buffer_bytes=%i\n",
  47                 __func__, substream, params_period_size(params),
  48                 params_period_bytes(params), params_periods(params),
  49                 params_buffer_size(params), params_buffer_bytes(params));
  50 
  51         switch (params_format(params)) {
  52         case SNDRV_PCM_FORMAT_S8:
  53                 mode = MPC52xx_PSC_SICR_SIM_CODEC_8;
  54                 break;
  55         case SNDRV_PCM_FORMAT_S16_BE:
  56                 mode = MPC52xx_PSC_SICR_SIM_CODEC_16;
  57                 break;
  58         case SNDRV_PCM_FORMAT_S24_BE:
  59                 mode = MPC52xx_PSC_SICR_SIM_CODEC_24;
  60                 break;
  61         case SNDRV_PCM_FORMAT_S32_BE:
  62                 mode = MPC52xx_PSC_SICR_SIM_CODEC_32;
  63                 break;
  64         default:
  65                 dev_dbg(psc_dma->dev, "invalid format\n");
  66                 return -EINVAL;
  67         }
  68         out_be32(&psc_dma->psc_regs->sicr, psc_dma->sicr | mode);
  69 
  70         return 0;
  71 }
  72 
  73 
  74 
  75 
  76 
  77 
  78 
  79 
  80 
  81 
  82 
  83 
  84 
  85 
  86 
  87 static int psc_i2s_set_sysclk(struct snd_soc_dai *cpu_dai,
  88                               int clk_id, unsigned int freq, int dir)
  89 {
  90         struct psc_dma *psc_dma = snd_soc_dai_get_drvdata(cpu_dai);
  91         dev_dbg(psc_dma->dev, "psc_i2s_set_sysclk(cpu_dai=%p, dir=%i)\n",
  92                                 cpu_dai, dir);
  93         return (dir == SND_SOC_CLOCK_IN) ? 0 : -EINVAL;
  94 }
  95 
  96 
  97 
  98 
  99 
 100 
 101 
 102 
 103 
 104 
 105 
 106 
 107 static int psc_i2s_set_fmt(struct snd_soc_dai *cpu_dai, unsigned int format)
 108 {
 109         struct psc_dma *psc_dma = snd_soc_dai_get_drvdata(cpu_dai);
 110         dev_dbg(psc_dma->dev, "psc_i2s_set_fmt(cpu_dai=%p, format=%i)\n",
 111                                 cpu_dai, format);
 112         return (format == SND_SOC_DAIFMT_I2S) ? 0 : -EINVAL;
 113 }
 114 
 115 
 116 
 117 
 118 
 119 
 120 
 121 
 122 
 123 
 124 
 125 static const struct snd_soc_dai_ops psc_i2s_dai_ops = {
 126         .hw_params      = psc_i2s_hw_params,
 127         .set_sysclk     = psc_i2s_set_sysclk,
 128         .set_fmt        = psc_i2s_set_fmt,
 129 };
 130 
 131 static struct snd_soc_dai_driver psc_i2s_dai[] = {{
 132         .name = "mpc5200-psc-i2s.0",
 133         .playback = {
 134                 .stream_name = "I2S Playback",
 135                 .channels_min = 2,
 136                 .channels_max = 2,
 137                 .rates = PSC_I2S_RATES,
 138                 .formats = PSC_I2S_FORMATS,
 139         },
 140         .capture = {
 141                 .stream_name = "I2S Capture",
 142                 .channels_min = 2,
 143                 .channels_max = 2,
 144                 .rates = PSC_I2S_RATES,
 145                 .formats = PSC_I2S_FORMATS,
 146         },
 147         .ops = &psc_i2s_dai_ops,
 148 } };
 149 
 150 static const struct snd_soc_component_driver psc_i2s_component = {
 151         .name           = "mpc5200-i2s",
 152 };
 153 
 154 
 155 
 156 
 157 
 158 
 159 static int psc_i2s_of_probe(struct platform_device *op)
 160 {
 161         int rc;
 162         struct psc_dma *psc_dma;
 163         struct mpc52xx_psc __iomem *regs;
 164 
 165         rc = mpc5200_audio_dma_create(op);
 166         if (rc != 0)
 167                 return rc;
 168 
 169         rc = snd_soc_register_component(&op->dev, &psc_i2s_component,
 170                                         psc_i2s_dai, ARRAY_SIZE(psc_i2s_dai));
 171         if (rc != 0) {
 172                 pr_err("Failed to register DAI\n");
 173                 return rc;
 174         }
 175 
 176         psc_dma = dev_get_drvdata(&op->dev);
 177         regs = psc_dma->psc_regs;
 178 
 179         
 180         psc_dma->sicr = MPC52xx_PSC_SICR_DTS1 | MPC52xx_PSC_SICR_I2S |
 181                         MPC52xx_PSC_SICR_CLKPOL;
 182         out_be32(&psc_dma->psc_regs->sicr,
 183                  psc_dma->sicr | MPC52xx_PSC_SICR_SIM_CODEC_8);
 184 
 185         
 186 
 187         if (!of_get_property(op->dev.of_node, "codec-handle", NULL))
 188                 return 0;
 189 
 190         
 191 
 192 
 193 
 194         
 195         while ((in_8(®s->ipcr_acr.ipcr) & 0x80) != 0)
 196                 ;
 197         
 198         while ((in_8(®s->ipcr_acr.ipcr) & 0x80) == 0)
 199                 ;
 200         
 201 
 202 
 203 
 204         
 205         out_8(&psc_dma->psc_regs->command,
 206                         MPC52xx_PSC_TX_ENABLE | MPC52xx_PSC_RX_ENABLE);
 207 
 208         return 0;
 209 
 210 }
 211 
 212 static int psc_i2s_of_remove(struct platform_device *op)
 213 {
 214         mpc5200_audio_dma_destroy(op);
 215         snd_soc_unregister_component(&op->dev);
 216         return 0;
 217 }
 218 
 219 
 220 static const struct of_device_id psc_i2s_match[] = {
 221         { .compatible = "fsl,mpc5200-psc-i2s", },
 222         { .compatible = "fsl,mpc5200b-psc-i2s", },
 223         {}
 224 };
 225 MODULE_DEVICE_TABLE(of, psc_i2s_match);
 226 
 227 static struct platform_driver psc_i2s_driver = {
 228         .probe = psc_i2s_of_probe,
 229         .remove = psc_i2s_of_remove,
 230         .driver = {
 231                 .name = "mpc5200-psc-i2s",
 232                 .of_match_table = psc_i2s_match,
 233         },
 234 };
 235 
 236 module_platform_driver(psc_i2s_driver);
 237 
 238 MODULE_AUTHOR("Grant Likely <grant.likely@secretlab.ca>");
 239 MODULE_DESCRIPTION("Freescale MPC5200 PSC in I2S mode ASoC Driver");
 240 MODULE_LICENSE("GPL");
 241