kernel/sound/soc/pxa/mmp-sspa.c

   1 /*
   2  * linux/sound/soc/pxa/mmp-sspa.c
   3  * Base on pxa2xx-ssp.c
   4  *
   5  * Copyright (C) 2011 Marvell International Ltd.
   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 as published by
   9  * the Free Software Foundation; either version 2 of the License, or
  10  * (at your option) any later version.
  11  *
  12  * This program is distributed in the hope that it will be useful,
  13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  * GNU General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU General Public License
  18  * along with this program; if not, write to the Free Software
  19  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  20  *
  21  */
  22 #include <linux/init.h>
  23 #include <linux/module.h>
  24 #include <linux/platform_device.h>
  25 #include <linux/delay.h>
  26 #include <linux/clk.h>
  27 #include <linux/slab.h>
  28 #include <linux/pxa2xx_ssp.h>
  29 #include <linux/io.h>
  30 #include <linux/dmaengine.h>
  31
  32 #include <sound/core.h>
  33 #include <sound/pcm.h>
  34 #include <sound/initval.h>
  35 #include <sound/pcm_params.h>
  36 #include <sound/soc.h>
  37 #include <sound/pxa2xx-lib.h>
  38 #include <sound/dmaengine_pcm.h>
  39 #include "mmp-sspa.h"
  40
  41 /*
  42  * SSPA audio private data
  43  */
  44 struct sspa_priv {
  45         struct ssp_device *sspa;
  46         struct snd_dmaengine_dai_dma_data *dma_params;
  47         struct clk *audio_clk;
  48         struct clk *sysclk;
  49         int dai_fmt;
  50         int running_cnt;
  51 };
  52
  53 static void mmp_sspa_write_reg(struct ssp_device *sspa, u32 reg, u32 val)
  54 {
  55         __raw_writel(val, sspa->mmio_base + reg);
  56 }
  57
  58 static u32 mmp_sspa_read_reg(struct ssp_device *sspa, u32 reg)
  59 {
  60         return __raw_readl(sspa->mmio_base + reg);
  61 }
  62
  63 static void mmp_sspa_tx_enable(struct ssp_device *sspa)
  64 {
  65         unsigned int sspa_sp;
  66
  67         sspa_sp = mmp_sspa_read_reg(sspa, SSPA_TXSP);
  68         sspa_sp |= SSPA_SP_S_EN;
  69         sspa_sp |= SSPA_SP_WEN;
  70         mmp_sspa_write_reg(sspa, SSPA_TXSP, sspa_sp);
  71 }
  72
  73 static void mmp_sspa_tx_disable(struct ssp_device *sspa)
  74 {
  75         unsigned int sspa_sp;
  76
  77         sspa_sp = mmp_sspa_read_reg(sspa, SSPA_TXSP);
  78         sspa_sp &= ~SSPA_SP_S_EN;
  79         sspa_sp |= SSPA_SP_WEN;
  80         mmp_sspa_write_reg(sspa, SSPA_TXSP, sspa_sp);
  81 }
  82
  83 static void mmp_sspa_rx_enable(struct ssp_device *sspa)
  84 {
  85         unsigned int sspa_sp;
  86
  87         sspa_sp = mmp_sspa_read_reg(sspa, SSPA_RXSP);
  88         sspa_sp |= SSPA_SP_S_EN;
  89         sspa_sp |= SSPA_SP_WEN;
  90         mmp_sspa_write_reg(sspa, SSPA_RXSP, sspa_sp);
  91 }
  92
  93 static void mmp_sspa_rx_disable(struct ssp_device *sspa)
  94 {
  95         unsigned int sspa_sp;
  96
  97         sspa_sp = mmp_sspa_read_reg(sspa, SSPA_RXSP);
  98         sspa_sp &= ~SSPA_SP_S_EN;
  99         sspa_sp |= SSPA_SP_WEN;
 100         mmp_sspa_write_reg(sspa, SSPA_RXSP, sspa_sp);
 101 }
 102
 103 static int mmp_sspa_startup(struct snd_pcm_substream *substream,
 104         struct snd_soc_dai *dai)
 105 {
 106         struct sspa_priv *priv = snd_soc_dai_get_drvdata(dai);
 107
 108         clk_enable(priv->sysclk);
 109         clk_enable(priv->sspa->clk);
 110
 111         return 0;
 112 }
 113
 114 static void mmp_sspa_shutdown(struct snd_pcm_substream *substream,
 115         struct snd_soc_dai *dai)
 116 {
 117         struct sspa_priv *priv = snd_soc_dai_get_drvdata(dai);
 118
 119         clk_disable(priv->sspa->clk);
 120         clk_disable(priv->sysclk);
 121
 122         return;
 123 }
 124
 125 /*
 126  * Set the SSP ports SYSCLK.
 127  */
 128 static int mmp_sspa_set_dai_sysclk(struct snd_soc_dai *cpu_dai,
 129                                     int clk_id, unsigned int freq, int dir)
 130 {
 131         struct sspa_priv *priv = snd_soc_dai_get_drvdata(cpu_dai);
 132         int ret = 0;
 133
 134         switch (clk_id) {
 135         case MMP_SSPA_CLK_AUDIO:
 136                 ret = clk_set_rate(priv->audio_clk, freq);
 137                 if (ret)
 138                         return ret;
 139                 break;
 140         case MMP_SSPA_CLK_PLL:
 141         case MMP_SSPA_CLK_VCXO:
 142                 /* not support yet */
 143                 return -EINVAL;
 144         default:
 145                 return -EINVAL;
 146         }
 147
 148         return 0;
 149 }
 150
 151 static int mmp_sspa_set_dai_pll(struct snd_soc_dai *cpu_dai, int pll_id,
 152                                  int source, unsigned int freq_in,
 153                                  unsigned int freq_out)
 154 {
 155         struct sspa_priv *priv = snd_soc_dai_get_drvdata(cpu_dai);
 156         int ret = 0;
 157
 158         switch (pll_id) {
 159         case MMP_SYSCLK:
 160                 ret = clk_set_rate(priv->sysclk, freq_out);
 161                 if (ret)
 162                         return ret;
 163                 break;
 164         case MMP_SSPA_CLK:
 165                 ret = clk_set_rate(priv->sspa->clk, freq_out);
 166                 if (ret)
 167                         return ret;
 168                 break;
 169         default:
 170                 return -ENODEV;
 171         }
 172
 173         return 0;
 174 }
 175
 176 /*
 177  * Set up the sspa dai format. The sspa port must be inactive
 178  * before calling this function as the physical
 179  * interface format is changed.
 180  */
 181 static int mmp_sspa_set_dai_fmt(struct snd_soc_dai *cpu_dai,
 182                                  unsigned int fmt)
 183 {
 184         struct sspa_priv *sspa_priv = snd_soc_dai_get_drvdata(cpu_dai);
 185         struct ssp_device *sspa = sspa_priv->sspa;
 186         u32 sspa_sp, sspa_ctrl;
 187
 188         /* check if we need to change anything at all */
 189         if (sspa_priv->dai_fmt == fmt)
 190                 return 0;
 191
 192         /* we can only change the settings if the port is not in use */
 193         if ((mmp_sspa_read_reg(sspa, SSPA_TXSP) & SSPA_SP_S_EN) ||
 194             (mmp_sspa_read_reg(sspa, SSPA_RXSP) & SSPA_SP_S_EN)) {
 195                 dev_err(&sspa->pdev->dev,
 196                         "can't change hardware dai format: stream is in use\n");
 197                 return -EINVAL;
 198         }
 199
 200         /* reset port settings */
 201         sspa_sp   = SSPA_SP_WEN | SSPA_SP_S_RST | SSPA_SP_FFLUSH;
 202         sspa_ctrl = 0;
 203
 204         switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
 205         case SND_SOC_DAIFMT_CBS_CFS:
 206                 sspa_sp |= SSPA_SP_MSL;
 207                 break;
 208         case SND_SOC_DAIFMT_CBM_CFM:
 209                 break;
 210         default:
 211                 return -EINVAL;
 212         }
 213
 214         switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
 215         case SND_SOC_DAIFMT_NB_NF:
 216                 sspa_sp |= SSPA_SP_FSP;
 217                 break;
 218         default:
 219                 return -EINVAL;
 220         }
 221
 222         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
 223         case SND_SOC_DAIFMT_I2S:
 224                 sspa_sp |= SSPA_TXSP_FPER(63);
 225                 sspa_sp |= SSPA_SP_FWID(31);
 226                 sspa_ctrl |= SSPA_CTL_XDATDLY(1);
 227                 break;
 228         default:
 229                 return -EINVAL;
 230         }
 231
 232         mmp_sspa_write_reg(sspa, SSPA_TXSP, sspa_sp);
 233         mmp_sspa_write_reg(sspa, SSPA_RXSP, sspa_sp);
 234
 235         sspa_sp &= ~(SSPA_SP_S_RST | SSPA_SP_FFLUSH);
 236         mmp_sspa_write_reg(sspa, SSPA_TXSP, sspa_sp);
 237         mmp_sspa_write_reg(sspa, SSPA_RXSP, sspa_sp);
 238
 239         /*
 240          * FIXME: hw issue, for the tx serial port,
 241          * can not config the master/slave mode;
 242          * so must clean this bit.
 243          * The master/slave mode has been set in the
 244          * rx port.
 245          */
 246         sspa_sp &= ~SSPA_SP_MSL;
 247         mmp_sspa_write_reg(sspa, SSPA_TXSP, sspa_sp);
 248
 249         mmp_sspa_write_reg(sspa, SSPA_TXCTL, sspa_ctrl);
 250         mmp_sspa_write_reg(sspa, SSPA_RXCTL, sspa_ctrl);
 251
 252         /* Since we are configuring the timings for the format by hand
 253          * we have to defer some things until hw_params() where we
 254          * know parameters like the sample size.
 255          */
 256         sspa_priv->dai_fmt = fmt;
 257         return 0;
 258 }
 259
 260 /*
 261  * Set the SSPA audio DMA parameters and sample size.
 262  * Can be called multiple times by oss emulation.
 263  */
 264 static int mmp_sspa_hw_params(struct snd_pcm_substream *substream,
 265                                struct snd_pcm_hw_params *params,
 266                                struct snd_soc_dai *dai)
 267 {
 268         struct snd_soc_pcm_runtime *rtd = substream->private_data;
 269         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
 270         struct sspa_priv *sspa_priv = snd_soc_dai_get_drvdata(dai);
 271         struct ssp_device *sspa = sspa_priv->sspa;
 272         struct snd_dmaengine_dai_dma_data *dma_params;
 273         u32 sspa_ctrl;
 274
 275         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
 276                 sspa_ctrl = mmp_sspa_read_reg(sspa, SSPA_TXCTL);
 277         else
 278                 sspa_ctrl = mmp_sspa_read_reg(sspa, SSPA_RXCTL);
 279
 280         sspa_ctrl &= ~SSPA_CTL_XFRLEN1_MASK;
 281         sspa_ctrl |= SSPA_CTL_XFRLEN1(params_channels(params) - 1);
 282         sspa_ctrl &= ~SSPA_CTL_XWDLEN1_MASK;
 283         sspa_ctrl |= SSPA_CTL_XWDLEN1(SSPA_CTL_32_BITS);
 284         sspa_ctrl &= ~SSPA_CTL_XSSZ1_MASK;
 285
 286         switch (params_format(params)) {
 287         case SNDRV_PCM_FORMAT_S8:
 288                 sspa_ctrl |= SSPA_CTL_XSSZ1(SSPA_CTL_8_BITS);
 289                 break;
 290         case SNDRV_PCM_FORMAT_S16_LE:
 291                 sspa_ctrl |= SSPA_CTL_XSSZ1(SSPA_CTL_16_BITS);
 292                 break;
 293         case SNDRV_PCM_FORMAT_S20_3LE:
 294                 sspa_ctrl |= SSPA_CTL_XSSZ1(SSPA_CTL_20_BITS);
 295                 break;
 296         case SNDRV_PCM_FORMAT_S24_3LE:
 297                 sspa_ctrl |= SSPA_CTL_XSSZ1(SSPA_CTL_24_BITS);
 298                 break;
 299         case SNDRV_PCM_FORMAT_S32_LE:
 300                 sspa_ctrl |= SSPA_CTL_XSSZ1(SSPA_CTL_32_BITS);
 301                 break;
 302         default:
 303                 return -EINVAL;
 304         }
 305
 306         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 307                 mmp_sspa_write_reg(sspa, SSPA_TXCTL, sspa_ctrl);
 308                 mmp_sspa_write_reg(sspa, SSPA_TXFIFO_LL, 0x1);
 309         } else {
 310                 mmp_sspa_write_reg(sspa, SSPA_RXCTL, sspa_ctrl);
 311                 mmp_sspa_write_reg(sspa, SSPA_RXFIFO_UL, 0x0);
 312         }
 313
 314         dma_params = &sspa_priv->dma_params[substream->stream];
 315         dma_params->addr = substream->stream == SNDRV_PCM_STREAM_PLAYBACK ?
 316                                 (sspa->phys_base + SSPA_TXD) :
 317                                 (sspa->phys_base + SSPA_RXD);
 318         snd_soc_dai_set_dma_data(cpu_dai, substream, dma_params);
 319         return 0;
 320 }
 321
 322 static int mmp_sspa_trigger(struct snd_pcm_substream *substream, int cmd,
 323                              struct snd_soc_dai *dai)
 324 {
 325         struct sspa_priv *sspa_priv = snd_soc_dai_get_drvdata(dai);
 326         struct ssp_device *sspa = sspa_priv->sspa;
 327         int ret = 0;
 328
 329         switch (cmd) {
 330         case SNDRV_PCM_TRIGGER_START:
 331         case SNDRV_PCM_TRIGGER_RESUME:
 332         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
 333                 /*
 334                  * whatever playback or capture, must enable rx.
 335                  * this is a hw issue, so need check if rx has been
 336                  * enabled or not; if has been enabled by another
 337                  * stream, do not enable again.
 338                  */
 339                 if (!sspa_priv->running_cnt)
 340                         mmp_sspa_rx_enable(sspa);
 341
 342                 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
 343                         mmp_sspa_tx_enable(sspa);
 344
 345                 sspa_priv->running_cnt++;
 346                 break;
 347
 348         case SNDRV_PCM_TRIGGER_STOP:
 349         case SNDRV_PCM_TRIGGER_SUSPEND:
 350         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
 351                 sspa_priv->running_cnt--;
 352
 353                 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
 354                         mmp_sspa_tx_disable(sspa);
 355
 356                 /* have no capture stream, disable rx port */
 357                 if (!sspa_priv->running_cnt)
 358                         mmp_sspa_rx_disable(sspa);
 359                 break;
 360
 361         default:
 362                 ret = -EINVAL;
 363         }
 364
 365         return ret;
 366 }
 367
 368 static int mmp_sspa_probe(struct snd_soc_dai *dai)
 369 {
 370         struct sspa_priv *priv = dev_get_drvdata(dai->dev);
 371
 372         snd_soc_dai_set_drvdata(dai, priv);
 373         return 0;
 374
 375 }
 376
 377 #define MMP_SSPA_RATES SNDRV_PCM_RATE_8000_192000
 378 #define MMP_SSPA_FORMATS (SNDRV_PCM_FMTBIT_S8 | \
 379                 SNDRV_PCM_FMTBIT_S16_LE | \
 380                 SNDRV_PCM_FMTBIT_S24_LE | \
 381                 SNDRV_PCM_FMTBIT_S24_LE | \
 382                 SNDRV_PCM_FMTBIT_S32_LE)
 383
 384 static struct snd_soc_dai_ops mmp_sspa_dai_ops = {
 385         .startup        = mmp_sspa_startup,
 386         .shutdown       = mmp_sspa_shutdown,
 387         .trigger        = mmp_sspa_trigger,
 388         .hw_params      = mmp_sspa_hw_params,
 389         .set_sysclk     = mmp_sspa_set_dai_sysclk,
 390         .set_pll        = mmp_sspa_set_dai_pll,
 391         .set_fmt        = mmp_sspa_set_dai_fmt,
 392 };
 393
 394 static struct snd_soc_dai_driver mmp_sspa_dai = {
 395         .probe = mmp_sspa_probe,
 396         .playback = {
 397                 .channels_min = 1,
 398                 .channels_max = 128,
 399                 .rates = MMP_SSPA_RATES,
 400                 .formats = MMP_SSPA_FORMATS,
 401         },
 402         .capture = {
 403                 .channels_min = 1,
 404                 .channels_max = 2,
 405                 .rates = MMP_SSPA_RATES,
 406                 .formats = MMP_SSPA_FORMATS,
 407         },
 408         .ops = &mmp_sspa_dai_ops,
 409 };
 410
 411 static const struct snd_soc_component_driver mmp_sspa_component = {
 412         .name           = "mmp-sspa",
 413 };
 414
 415 static int asoc_mmp_sspa_probe(struct platform_device *pdev)
 416 {
 417         struct sspa_priv *priv;
 418         struct resource *res;
 419
 420         priv = devm_kzalloc(&pdev->dev,
 421                                 sizeof(struct sspa_priv), GFP_KERNEL);
 422         if (!priv)
 423                 return -ENOMEM;
 424
 425         priv->sspa = devm_kzalloc(&pdev->dev,
 426                                 sizeof(struct ssp_device), GFP_KERNEL);
 427         if (priv->sspa == NULL)
 428                 return -ENOMEM;
 429
 430         priv->dma_params = devm_kzalloc(&pdev->dev,
 431                         2 * sizeof(struct snd_dmaengine_dai_dma_data),
 432                         GFP_KERNEL);
 433         if (priv->dma_params == NULL)
 434                 return -ENOMEM;
 435
 436         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 437         priv->sspa->mmio_base = devm_ioremap_resource(&pdev->dev, res);
 438         if (IS_ERR(priv->sspa->mmio_base))
 439                 return PTR_ERR(priv->sspa->mmio_base);
 440
 441         priv->sspa->clk = devm_clk_get(&pdev->dev, NULL);
 442         if (IS_ERR(priv->sspa->clk))
 443                 return PTR_ERR(priv->sspa->clk);
 444
 445         priv->audio_clk = clk_get(NULL, "mmp-audio");
 446         if (IS_ERR(priv->audio_clk))
 447                 return PTR_ERR(priv->audio_clk);
 448
 449         priv->sysclk = clk_get(NULL, "mmp-sysclk");
 450         if (IS_ERR(priv->sysclk)) {
 451                 clk_put(priv->audio_clk);
 452                 return PTR_ERR(priv->sysclk);
 453         }
 454         clk_enable(priv->audio_clk);
 455         priv->dai_fmt = (unsigned int) -1;
 456         platform_set_drvdata(pdev, priv);
 457
 458         return devm_snd_soc_register_component(&pdev->dev, &mmp_sspa_component,
 459                                                &mmp_sspa_dai, 1);
 460 }
 461
 462 static int asoc_mmp_sspa_remove(struct platform_device *pdev)
 463 {
 464         struct sspa_priv *priv = platform_get_drvdata(pdev);
 465
 466         clk_disable(priv->audio_clk);
 467         clk_put(priv->audio_clk);
 468         clk_put(priv->sysclk);
 469         return 0;
 470 }
 471
 472 static struct platform_driver asoc_mmp_sspa_driver = {
 473         .driver = {
 474                 .name = "mmp-sspa-dai",
 475         },
 476         .probe = asoc_mmp_sspa_probe,
 477         .remove = asoc_mmp_sspa_remove,
 478 };
 479
 480 module_platform_driver(asoc_mmp_sspa_driver);
 481
 482 MODULE_AUTHOR("Leo Yan <leoy@marvell.com>");
 483 MODULE_DESCRIPTION("MMP SSPA SoC Interface");
 484 MODULE_LICENSE("GPL");