sound/soc/kirkwood/kirkwood-i2s.c

   1 /*
   2  * kirkwood-i2s.c
   3  *
   4  * (c) 2010 Arnaud Patard <apatard@mandriva.com>
   5  * (c) 2010 Arnaud Patard <arnaud.patard@rtp-net.org>
   6  *
   7  *  This program is free software; you can redistribute  it and/or modify it
   8  *  under  the terms of  the GNU General  Public License as published by the
   9  *  Free Software Foundation;  either version 2 of the  License, or (at your
  10  *  option) any later version.
  11  */
  12
  13 #include <linux/init.h>
  14 #include <linux/module.h>
  15 #include <linux/platform_device.h>
  16 #include <linux/io.h>
  17 #include <linux/slab.h>
  18 #include <linux/mbus.h>
  19 #include <linux/delay.h>
  20 #include <linux/clk.h>
  21 #include <sound/pcm.h>
  22 #include <sound/pcm_params.h>
  23 #include <sound/soc.h>
  24 #include <linux/platform_data/asoc-kirkwood.h>
  25 #include <linux/of.h>
  26
  27 #include "kirkwood.h"
  28
  29 #define DRV_NAME        "mvebu-audio"
  30
  31 #define KIRKWOOD_I2S_FORMATS \
  32         (SNDRV_PCM_FMTBIT_S16_LE | \
  33          SNDRV_PCM_FMTBIT_S24_LE | \
  34          SNDRV_PCM_FMTBIT_S32_LE)
  35
  36 #define KIRKWOOD_SPDIF_FORMATS \
  37         (SNDRV_PCM_FMTBIT_S16_LE | \
  38          SNDRV_PCM_FMTBIT_S24_LE)
  39
  40 static int kirkwood_i2s_set_fmt(struct snd_soc_dai *cpu_dai,
  41                 unsigned int fmt)
  42 {
  43         struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(cpu_dai);
  44         unsigned long mask;
  45         unsigned long value;
  46
  47         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  48         case SND_SOC_DAIFMT_RIGHT_J:
  49                 mask = KIRKWOOD_I2S_CTL_RJ;
  50                 break;
  51         case SND_SOC_DAIFMT_LEFT_J:
  52                 mask = KIRKWOOD_I2S_CTL_LJ;
  53                 break;
  54         case SND_SOC_DAIFMT_I2S:
  55                 mask = KIRKWOOD_I2S_CTL_I2S;
  56                 break;
  57         default:
  58                 return -EINVAL;
  59         }
  60
  61         /*
  62          * Set same format for playback and record
  63          * This avoids some troubles.
  64          */
  65         value = readl(priv->io+KIRKWOOD_I2S_PLAYCTL);
  66         value &= ~KIRKWOOD_I2S_CTL_JUST_MASK;
  67         value |= mask;
  68         writel(value, priv->io+KIRKWOOD_I2S_PLAYCTL);
  69
  70         value = readl(priv->io+KIRKWOOD_I2S_RECCTL);
  71         value &= ~KIRKWOOD_I2S_CTL_JUST_MASK;
  72         value |= mask;
  73         writel(value, priv->io+KIRKWOOD_I2S_RECCTL);
  74
  75         return 0;
  76 }
  77
  78 static inline void kirkwood_set_dco(void __iomem *io, unsigned long rate)
  79 {
  80         unsigned long value;
  81
  82         value = KIRKWOOD_DCO_CTL_OFFSET_0;
  83         switch (rate) {
  84         default:
  85         case 44100:
  86                 value |= KIRKWOOD_DCO_CTL_FREQ_11;
  87                 break;
  88         case 48000:
  89                 value |= KIRKWOOD_DCO_CTL_FREQ_12;
  90                 break;
  91         case 96000:
  92                 value |= KIRKWOOD_DCO_CTL_FREQ_24;
  93                 break;
  94         }
  95         writel(value, io + KIRKWOOD_DCO_CTL);
  96
  97         /* wait for dco locked */
  98         do {
  99                 cpu_relax();
 100                 value = readl(io + KIRKWOOD_DCO_SPCR_STATUS);
 101                 value &= KIRKWOOD_DCO_SPCR_STATUS_DCO_LOCK;
 102         } while (value == 0);
 103 }
 104
 105 static void kirkwood_set_rate(struct snd_soc_dai *dai,
 106         struct kirkwood_dma_data *priv, unsigned long rate)
 107 {
 108         uint32_t clks_ctrl;
 109
 110         if (IS_ERR(priv->extclk)) {
 111                 /* use internal dco for the supported rates
 112                  * defined in kirkwood_i2s_dai */
 113                 dev_dbg(dai->dev, "%s: dco set rate = %lu\n",
 114                         __func__, rate);
 115                 kirkwood_set_dco(priv->io, rate);
 116
 117                 clks_ctrl = KIRKWOOD_MCLK_SOURCE_DCO;
 118         } else {
 119                 /* use the external clock for the other rates
 120                  * defined in kirkwood_i2s_dai_extclk */
 121                 dev_dbg(dai->dev, "%s: extclk set rate = %lu -> %lu\n",
 122                         __func__, rate, 256 * rate);
 123                 clk_set_rate(priv->extclk, 256 * rate);
 124
 125                 clks_ctrl = KIRKWOOD_MCLK_SOURCE_EXTCLK;
 126         }
 127         writel(clks_ctrl, priv->io + KIRKWOOD_CLOCKS_CTRL);
 128 }
 129
 130 static int kirkwood_i2s_startup(struct snd_pcm_substream *substream,
 131                 struct snd_soc_dai *dai)
 132 {
 133         struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(dai);
 134
 135         snd_soc_dai_set_dma_data(dai, substream, priv);
 136         return 0;
 137 }
 138
 139 static int kirkwood_i2s_hw_params(struct snd_pcm_substream *substream,
 140                                  struct snd_pcm_hw_params *params,
 141                                  struct snd_soc_dai *dai)
 142 {
 143         struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(dai);
 144         uint32_t ctl_play, ctl_rec;
 145         unsigned int i2s_reg;
 146         unsigned long i2s_value;
 147
 148         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 149                 i2s_reg = KIRKWOOD_I2S_PLAYCTL;
 150         } else {
 151                 i2s_reg = KIRKWOOD_I2S_RECCTL;
 152         }
 153
 154         kirkwood_set_rate(dai, priv, params_rate(params));
 155
 156         i2s_value = readl(priv->io+i2s_reg);
 157         i2s_value &= ~KIRKWOOD_I2S_CTL_SIZE_MASK;
 158
 159         /*
 160          * Size settings in play/rec i2s control regs and play/rec control
 161          * regs must be the same.
 162          */
 163         switch (params_format(params)) {
 164         case SNDRV_PCM_FORMAT_S16_LE:
 165                 i2s_value |= KIRKWOOD_I2S_CTL_SIZE_16;
 166                 ctl_play = KIRKWOOD_PLAYCTL_SIZE_16_C |
 167                            KIRKWOOD_PLAYCTL_I2S_EN |
 168                            KIRKWOOD_PLAYCTL_SPDIF_EN;
 169                 ctl_rec = KIRKWOOD_RECCTL_SIZE_16_C |
 170                           KIRKWOOD_RECCTL_I2S_EN |
 171                           KIRKWOOD_RECCTL_SPDIF_EN;
 172                 break;
 173         /*
 174          * doesn't work... S20_3LE != kirkwood 20bit format ?
 175          *
 176         case SNDRV_PCM_FORMAT_S20_3LE:
 177                 i2s_value |= KIRKWOOD_I2S_CTL_SIZE_20;
 178                 ctl_play = KIRKWOOD_PLAYCTL_SIZE_20 |
 179                            KIRKWOOD_PLAYCTL_I2S_EN;
 180                 ctl_rec = KIRKWOOD_RECCTL_SIZE_20 |
 181                           KIRKWOOD_RECCTL_I2S_EN;
 182                 break;
 183         */
 184         case SNDRV_PCM_FORMAT_S24_LE:
 185                 i2s_value |= KIRKWOOD_I2S_CTL_SIZE_24;
 186                 ctl_play = KIRKWOOD_PLAYCTL_SIZE_24 |
 187                            KIRKWOOD_PLAYCTL_I2S_EN |
 188                            KIRKWOOD_PLAYCTL_SPDIF_EN;
 189                 ctl_rec = KIRKWOOD_RECCTL_SIZE_24 |
 190                           KIRKWOOD_RECCTL_I2S_EN |
 191                           KIRKWOOD_RECCTL_SPDIF_EN;
 192                 break;
 193         case SNDRV_PCM_FORMAT_S32_LE:
 194                 i2s_value |= KIRKWOOD_I2S_CTL_SIZE_32;
 195                 ctl_play = KIRKWOOD_PLAYCTL_SIZE_32 |
 196                            KIRKWOOD_PLAYCTL_I2S_EN;
 197                 ctl_rec = KIRKWOOD_RECCTL_SIZE_32 |
 198                           KIRKWOOD_RECCTL_I2S_EN;
 199                 break;
 200         default:
 201                 return -EINVAL;
 202         }
 203
 204         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 205                 if (params_channels(params) == 1)
 206                         ctl_play |= KIRKWOOD_PLAYCTL_MONO_BOTH;
 207                 else
 208                         ctl_play |= KIRKWOOD_PLAYCTL_MONO_OFF;
 209
 210                 priv->ctl_play &= ~(KIRKWOOD_PLAYCTL_MONO_MASK |
 211                                     KIRKWOOD_PLAYCTL_ENABLE_MASK |
 212                                     KIRKWOOD_PLAYCTL_SIZE_MASK);
 213                 priv->ctl_play |= ctl_play;
 214         } else {
 215                 priv->ctl_rec &= ~KIRKWOOD_RECCTL_SIZE_MASK;
 216                 priv->ctl_rec |= ctl_rec;
 217         }
 218
 219         writel(i2s_value, priv->io+i2s_reg);
 220
 221         return 0;
 222 }
 223
 224 static int kirkwood_i2s_play_trigger(struct snd_pcm_substream *substream,
 225                                 int cmd, struct snd_soc_dai *dai)
 226 {
 227         struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(dai);
 228         uint32_t ctl, value;
 229
 230         ctl = readl(priv->io + KIRKWOOD_PLAYCTL);
 231         if (ctl & KIRKWOOD_PLAYCTL_PAUSE) {
 232                 unsigned timeout = 5000;
 233                 /*
 234                  * The Armada510 spec says that if we enter pause mode, the
 235                  * busy bit must be read back as clear _twice_.  Make sure
 236                  * we respect that otherwise we get DMA underruns.
 237                  */
 238                 do {
 239                         value = ctl;
 240                         ctl = readl(priv->io + KIRKWOOD_PLAYCTL);
 241                         if (!((ctl | value) & KIRKWOOD_PLAYCTL_PLAY_BUSY))
 242                                 break;
 243                         udelay(1);
 244                 } while (timeout--);
 245
 246                 if ((ctl | value) & KIRKWOOD_PLAYCTL_PLAY_BUSY)
 247                         dev_notice(dai->dev, "timed out waiting for busy to deassert: %08x\n",
 248                                    ctl);
 249         }
 250
 251         switch (cmd) {
 252         case SNDRV_PCM_TRIGGER_START:
 253                 /* configure */
 254                 ctl = priv->ctl_play;
 255                 if (dai->id == 0)
 256                         ctl &= ~KIRKWOOD_PLAYCTL_SPDIF_EN;      /* i2s */
 257                 else
 258                         ctl &= ~KIRKWOOD_PLAYCTL_I2S_EN;        /* spdif */
 259
 260                 value = ctl & ~KIRKWOOD_PLAYCTL_ENABLE_MASK;
 261                 writel(value, priv->io + KIRKWOOD_PLAYCTL);
 262
 263                 /* enable interrupts */
 264                 value = readl(priv->io + KIRKWOOD_INT_MASK);
 265                 value |= KIRKWOOD_INT_CAUSE_PLAY_BYTES;
 266                 writel(value, priv->io + KIRKWOOD_INT_MASK);
 267
 268                 /* enable playback */
 269                 writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
 270                 break;
 271
 272         case SNDRV_PCM_TRIGGER_STOP:
 273                 /* stop audio, disable interrupts */
 274                 ctl |= KIRKWOOD_PLAYCTL_PAUSE | KIRKWOOD_PLAYCTL_I2S_MUTE |
 275                                 KIRKWOOD_PLAYCTL_SPDIF_MUTE;
 276                 writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
 277
 278                 value = readl(priv->io + KIRKWOOD_INT_MASK);
 279                 value &= ~KIRKWOOD_INT_CAUSE_PLAY_BYTES;
 280                 writel(value, priv->io + KIRKWOOD_INT_MASK);
 281
 282                 /* disable all playbacks */
 283                 ctl &= ~KIRKWOOD_PLAYCTL_ENABLE_MASK;
 284                 writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
 285                 break;
 286
 287         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
 288         case SNDRV_PCM_TRIGGER_SUSPEND:
 289                 ctl |= KIRKWOOD_PLAYCTL_PAUSE | KIRKWOOD_PLAYCTL_I2S_MUTE |
 290                                 KIRKWOOD_PLAYCTL_SPDIF_MUTE;
 291                 writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
 292                 break;
 293
 294         case SNDRV_PCM_TRIGGER_RESUME:
 295         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
 296                 ctl &= ~(KIRKWOOD_PLAYCTL_PAUSE | KIRKWOOD_PLAYCTL_I2S_MUTE |
 297                                 KIRKWOOD_PLAYCTL_SPDIF_MUTE);
 298                 writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
 299                 break;
 300
 301         default:
 302                 return -EINVAL;
 303         }
 304
 305         return 0;
 306 }
 307
 308 static int kirkwood_i2s_rec_trigger(struct snd_pcm_substream *substream,
 309                                 int cmd, struct snd_soc_dai *dai)
 310 {
 311         struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(dai);
 312         uint32_t ctl, value;
 313
 314         value = readl(priv->io + KIRKWOOD_RECCTL);
 315
 316         switch (cmd) {
 317         case SNDRV_PCM_TRIGGER_START:
 318                 /* configure */
 319                 ctl = priv->ctl_rec;
 320                 if (dai->id == 0)
 321                         ctl &= ~KIRKWOOD_RECCTL_SPDIF_EN;       /* i2s */
 322                 else
 323                         ctl &= ~KIRKWOOD_RECCTL_I2S_EN;         /* spdif */
 324
 325                 value = ctl & ~KIRKWOOD_RECCTL_ENABLE_MASK;
 326                 writel(value, priv->io + KIRKWOOD_RECCTL);
 327
 328                 /* enable interrupts */
 329                 value = readl(priv->io + KIRKWOOD_INT_MASK);
 330                 value |= KIRKWOOD_INT_CAUSE_REC_BYTES;
 331                 writel(value, priv->io + KIRKWOOD_INT_MASK);
 332
 333                 /* enable record */
 334                 writel(ctl, priv->io + KIRKWOOD_RECCTL);
 335                 break;
 336
 337         case SNDRV_PCM_TRIGGER_STOP:
 338                 /* stop audio, disable interrupts */
 339                 value = readl(priv->io + KIRKWOOD_RECCTL);
 340                 value |= KIRKWOOD_RECCTL_PAUSE | KIRKWOOD_RECCTL_MUTE;
 341                 writel(value, priv->io + KIRKWOOD_RECCTL);
 342
 343                 value = readl(priv->io + KIRKWOOD_INT_MASK);
 344                 value &= ~KIRKWOOD_INT_CAUSE_REC_BYTES;
 345                 writel(value, priv->io + KIRKWOOD_INT_MASK);
 346
 347                 /* disable all records */
 348                 value = readl(priv->io + KIRKWOOD_RECCTL);
 349                 value &= ~KIRKWOOD_RECCTL_ENABLE_MASK;
 350                 writel(value, priv->io + KIRKWOOD_RECCTL);
 351                 break;
 352
 353         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
 354         case SNDRV_PCM_TRIGGER_SUSPEND:
 355                 value = readl(priv->io + KIRKWOOD_RECCTL);
 356                 value |= KIRKWOOD_RECCTL_PAUSE | KIRKWOOD_RECCTL_MUTE;
 357                 writel(value, priv->io + KIRKWOOD_RECCTL);
 358                 break;
 359
 360         case SNDRV_PCM_TRIGGER_RESUME:
 361         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
 362                 value = readl(priv->io + KIRKWOOD_RECCTL);
 363                 value &= ~(KIRKWOOD_RECCTL_PAUSE | KIRKWOOD_RECCTL_MUTE);
 364                 writel(value, priv->io + KIRKWOOD_RECCTL);
 365                 break;
 366
 367         default:
 368                 return -EINVAL;
 369         }
 370
 371         return 0;
 372 }
 373
 374 static int kirkwood_i2s_trigger(struct snd_pcm_substream *substream, int cmd,
 375                                struct snd_soc_dai *dai)
 376 {
 377         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
 378                 return kirkwood_i2s_play_trigger(substream, cmd, dai);
 379         else
 380                 return kirkwood_i2s_rec_trigger(substream, cmd, dai);
 381
 382         return 0;
 383 }
 384
 385 static int kirkwood_i2s_init(struct kirkwood_dma_data *priv)
 386 {
 387         unsigned long value;
 388         unsigned int reg_data;
 389
 390         /* put system in a "safe" state : */
 391         /* disable audio interrupts */
 392         writel(0xffffffff, priv->io + KIRKWOOD_INT_CAUSE);
 393         writel(0, priv->io + KIRKWOOD_INT_MASK);
 394
 395         reg_data = readl(priv->io + 0x1200);
 396         reg_data &= (~(0x333FF8));
 397         reg_data |= 0x111D18;
 398         writel(reg_data, priv->io + 0x1200);
 399
 400         msleep(500);
 401
 402         reg_data = readl(priv->io + 0x1200);
 403         reg_data &= (~(0x333FF8));
 404         reg_data |= 0x111D18;
 405         writel(reg_data, priv->io + 0x1200);
 406
 407         /* disable playback/record */
 408         value = readl(priv->io + KIRKWOOD_PLAYCTL);
 409         value &= ~KIRKWOOD_PLAYCTL_ENABLE_MASK;
 410         writel(value, priv->io + KIRKWOOD_PLAYCTL);
 411
 412         value = readl(priv->io + KIRKWOOD_RECCTL);
 413         value &= ~KIRKWOOD_RECCTL_ENABLE_MASK;
 414         writel(value, priv->io + KIRKWOOD_RECCTL);
 415
 416         return 0;
 417
 418 }
 419
 420 static const struct snd_soc_dai_ops kirkwood_i2s_dai_ops = {
 421         .startup        = kirkwood_i2s_startup,
 422         .trigger        = kirkwood_i2s_trigger,
 423         .hw_params      = kirkwood_i2s_hw_params,
 424         .set_fmt        = kirkwood_i2s_set_fmt,
 425 };
 426
 427 static struct snd_soc_dai_driver kirkwood_i2s_dai[2] = {
 428     {
 429         .name = "i2s",
 430         .id = 0,
 431         .playback = {
 432                 .channels_min = 1,
 433                 .channels_max = 2,
 434                 .rates = SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |
 435                                 SNDRV_PCM_RATE_96000,
 436                 .formats = KIRKWOOD_I2S_FORMATS,
 437         },
 438         .capture = {
 439                 .channels_min = 1,
 440                 .channels_max = 2,
 441                 .rates = SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |
 442                                 SNDRV_PCM_RATE_96000,
 443                 .formats = KIRKWOOD_I2S_FORMATS,
 444         },
 445         .ops = &kirkwood_i2s_dai_ops,
 446     },
 447     {
 448         .name = "spdif",
 449         .id = 1,
 450         .playback = {
 451                 .channels_min = 1,
 452                 .channels_max = 2,
 453                 .rates = SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |
 454                                 SNDRV_PCM_RATE_96000,
 455                 .formats = KIRKWOOD_SPDIF_FORMATS,
 456         },
 457         .capture = {
 458                 .channels_min = 1,
 459                 .channels_max = 2,
 460                 .rates = SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |
 461                                 SNDRV_PCM_RATE_96000,
 462                 .formats = KIRKWOOD_SPDIF_FORMATS,
 463         },
 464         .ops = &kirkwood_i2s_dai_ops,
 465     },
 466 };
 467
 468 static struct snd_soc_dai_driver kirkwood_i2s_dai_extclk[2] = {
 469     {
 470         .name = "i2s",
 471         .id = 0,
 472         .playback = {
 473                 .channels_min = 1,
 474                 .channels_max = 2,
 475                 .rates = SNDRV_PCM_RATE_CONTINUOUS,
 476                 .rate_min = 5512,
 477                 .rate_max = 192000,
 478                 .formats = KIRKWOOD_I2S_FORMATS,
 479         },
 480         .capture = {
 481                 .channels_min = 1,
 482                 .channels_max = 2,
 483                 .rates = SNDRV_PCM_RATE_CONTINUOUS,
 484                 .rate_min = 5512,
 485                 .rate_max = 192000,
 486                 .formats = KIRKWOOD_I2S_FORMATS,
 487         },
 488         .ops = &kirkwood_i2s_dai_ops,
 489     },
 490     {
 491         .name = "spdif",
 492         .id = 1,
 493         .playback = {
 494                 .channels_min = 1,
 495                 .channels_max = 2,
 496                 .rates = SNDRV_PCM_RATE_CONTINUOUS,
 497                 .rate_min = 5512,
 498                 .rate_max = 192000,
 499                 .formats = KIRKWOOD_SPDIF_FORMATS,
 500         },
 501         .capture = {
 502                 .channels_min = 1,
 503                 .channels_max = 2,
 504                 .rates = SNDRV_PCM_RATE_CONTINUOUS,
 505                 .rate_min = 5512,
 506                 .rate_max = 192000,
 507                 .formats = KIRKWOOD_SPDIF_FORMATS,
 508         },
 509         .ops = &kirkwood_i2s_dai_ops,
 510     },
 511 };
 512
 513 static const struct snd_soc_component_driver kirkwood_i2s_component = {
 514         .name           = DRV_NAME,
 515 };
 516
 517 static int kirkwood_i2s_dev_probe(struct platform_device *pdev)
 518 {
 519         struct kirkwood_asoc_platform_data *data = pdev->dev.platform_data;
 520         struct snd_soc_dai_driver *soc_dai = kirkwood_i2s_dai;
 521         struct kirkwood_dma_data *priv;
 522         struct resource *mem;
 523         struct device_node *np = pdev->dev.of_node;
 524         int err;
 525
 526         priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
 527         if (!priv) {
 528                 dev_err(&pdev->dev, "allocation failed\n");
 529                 return -ENOMEM;
 530         }
 531         dev_set_drvdata(&pdev->dev, priv);
 532
 533         mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 534         priv->io = devm_ioremap_resource(&pdev->dev, mem);
 535         if (IS_ERR(priv->io))
 536                 return PTR_ERR(priv->io);
 537
 538         priv->irq = platform_get_irq(pdev, 0);
 539         if (priv->irq <= 0) {
 540                 dev_err(&pdev->dev, "platform_get_irq failed\n");
 541                 return -ENXIO;
 542         }
 543
 544         if (np) {
 545                 priv->burst = 128;              /* might be 32 or 128 */
 546         } else if (data) {
 547                 priv->burst = data->burst;
 548         } else {
 549                 dev_err(&pdev->dev, "no DT nor platform data ?!\n");
 550                 return -EINVAL;
 551         }
 552
 553         priv->clk = devm_clk_get(&pdev->dev, np ? "internal" : NULL);
 554         if (IS_ERR(priv->clk)) {
 555                 dev_err(&pdev->dev, "no clock\n");
 556                 return PTR_ERR(priv->clk);
 557         }
 558
 559         err = clk_prepare_enable(priv->clk);
 560         if (err < 0)
 561                 return err;
 562
 563         priv->extclk = devm_clk_get(&pdev->dev, "extclk");
 564         if (IS_ERR(priv->extclk)) {
 565                 if (PTR_ERR(priv->extclk) == -EPROBE_DEFER)
 566                         return -EPROBE_DEFER;
 567         } else {
 568                 if (priv->extclk == priv->clk) {
 569                         devm_clk_put(&pdev->dev, priv->extclk);
 570                         priv->extclk = ERR_PTR(-EINVAL);
 571                 } else {
 572                         dev_info(&pdev->dev, "found external clock\n");
 573                         clk_prepare_enable(priv->extclk);
 574                         soc_dai = kirkwood_i2s_dai_extclk;
 575                 }
 576         }
 577
 578         /* Some sensible defaults - this reflects the powerup values */
 579         priv->ctl_play = KIRKWOOD_PLAYCTL_SIZE_24;
 580         priv->ctl_rec = KIRKWOOD_RECCTL_SIZE_24;
 581
 582         /* Select the burst size */
 583         if (priv->burst == 32) {
 584                 priv->ctl_play |= KIRKWOOD_PLAYCTL_BURST_32;
 585                 priv->ctl_rec |= KIRKWOOD_RECCTL_BURST_32;
 586         } else {
 587                 priv->ctl_play |= KIRKWOOD_PLAYCTL_BURST_128;
 588                 priv->ctl_rec |= KIRKWOOD_RECCTL_BURST_128;
 589         }
 590
 591         err = snd_soc_register_component(&pdev->dev, &kirkwood_i2s_component,
 592                                          soc_dai, 2);
 593         if (err) {
 594                 dev_err(&pdev->dev, "snd_soc_register_component failed\n");
 595                 goto err_component;
 596         }
 597
 598         err = snd_soc_register_platform(&pdev->dev, &kirkwood_soc_platform);
 599         if (err) {
 600                 dev_err(&pdev->dev, "snd_soc_register_platform failed\n");
 601                 goto err_platform;
 602         }
 603
 604         kirkwood_i2s_init(priv);
 605
 606         return 0;
 607  err_platform:
 608         snd_soc_unregister_component(&pdev->dev);
 609  err_component:
 610         if (!IS_ERR(priv->extclk))
 611                 clk_disable_unprepare(priv->extclk);
 612         clk_disable_unprepare(priv->clk);
 613
 614         return err;
 615 }
 616
 617 static int kirkwood_i2s_dev_remove(struct platform_device *pdev)
 618 {
 619         struct kirkwood_dma_data *priv = dev_get_drvdata(&pdev->dev);
 620
 621         snd_soc_unregister_platform(&pdev->dev);
 622         snd_soc_unregister_component(&pdev->dev);
 623
 624         if (!IS_ERR(priv->extclk))
 625                 clk_disable_unprepare(priv->extclk);
 626         clk_disable_unprepare(priv->clk);
 627
 628         return 0;
 629 }
 630
 631 #ifdef CONFIG_OF
 632 static struct of_device_id mvebu_audio_of_match[] = {
 633         { .compatible = "marvell,kirkwood-audio" },
 634         { .compatible = "marvell,dove-audio" },
 635         { .compatible = "marvell,armada370-audio" },
 636         { }
 637 };
 638 MODULE_DEVICE_TABLE(of, mvebu_audio_of_match);
 639 #endif
 640
 641 static struct platform_driver kirkwood_i2s_driver = {
 642         .probe  = kirkwood_i2s_dev_probe,
 643         .remove = kirkwood_i2s_dev_remove,
 644         .driver = {
 645                 .name = DRV_NAME,
 646                 .owner = THIS_MODULE,
 647                 .of_match_table = of_match_ptr(mvebu_audio_of_match),
 648         },
 649 };
 650
 651 module_platform_driver(kirkwood_i2s_driver);
 652
 653 /* Module information */
 654 MODULE_AUTHOR("Arnaud Patard, <arnaud.patard@rtp-net.org>");
 655 MODULE_DESCRIPTION("Kirkwood I2S SoC Interface");
 656 MODULE_LICENSE("GPL");
 657 MODULE_ALIAS("platform:mvebu-audio");