sound/soc/mxs/mxs-saif.c

   1 /*
   2  * Copyright 2011 Freescale Semiconductor, Inc.
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License as published by
   6  * the Free Software Foundation; either version 2 of the License, or
   7  * (at your option) any later version.
   8  *
   9  * This program is distributed in the hope that it will be useful,
  10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12  * GNU General Public License for more details.
  13  *
  14  * You should have received a copy of the GNU General Public License along
  15  * with this program; if not, write to the Free Software Foundation, Inc.,
  16  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  17  */
  18
  19 #include <linux/module.h>
  20 #include <linux/init.h>
  21 #include <linux/of.h>
  22 #include <linux/of_device.h>
  23 #include <linux/platform_device.h>
  24 #include <linux/slab.h>
  25 #include <linux/dma-mapping.h>
  26 #include <linux/clk.h>
  27 #include <linux/delay.h>
  28 #include <linux/time.h>
  29 #include <linux/fsl/mxs-dma.h>
  30 #include <linux/pinctrl/consumer.h>
  31 #include <sound/core.h>
  32 #include <sound/pcm.h>
  33 #include <sound/pcm_params.h>
  34 #include <sound/soc.h>
  35 #include <sound/saif.h>
  36 #include <asm/mach-types.h>
  37 #include <mach/hardware.h>
  38 #include <mach/mxs.h>
  39
  40 #include "mxs-saif.h"
  41
  42 static struct mxs_saif *mxs_saif[2];
  43
  44 /*
  45  * SAIF is a little different with other normal SOC DAIs on clock using.
  46  *
  47  * For MXS, two SAIF modules are instantiated on-chip.
  48  * Each SAIF has a set of clock pins and can be operating in master
  49  * mode simultaneously if they are connected to different off-chip codecs.
  50  * Also, one of the two SAIFs can master or drive the clock pins while the
  51  * other SAIF, in slave mode, receives clocking from the master SAIF.
  52  * This also means that both SAIFs must operate at the same sample rate.
  53  *
  54  * We abstract this as each saif has a master, the master could be
  55  * himself or other saifs. In the generic saif driver, saif does not need
  56  * to know the different clkmux. Saif only needs to know who is his master
  57  * and operating his master to generate the proper clock rate for him.
  58  * The master id is provided in mach-specific layer according to different
  59  * clkmux setting.
  60  */
  61
  62 static int mxs_saif_set_dai_sysclk(struct snd_soc_dai *cpu_dai,
  63                         int clk_id, unsigned int freq, int dir)
  64 {
  65         struct mxs_saif *saif = snd_soc_dai_get_drvdata(cpu_dai);
  66
  67         switch (clk_id) {
  68         case MXS_SAIF_MCLK:
  69                 saif->mclk = freq;
  70                 break;
  71         default:
  72                 return -EINVAL;
  73         }
  74         return 0;
  75 }
  76
  77 /*
  78  * Since SAIF may work on EXTMASTER mode, IOW, it's working BITCLK&LRCLK
  79  * is provided by other SAIF, we provide a interface here to get its master
  80  * from its master_id.
  81  * Note that the master could be himself.
  82  */
  83 static inline struct mxs_saif *mxs_saif_get_master(struct mxs_saif * saif)
  84 {
  85         return mxs_saif[saif->master_id];
  86 }
  87
  88 /*
  89  * Set SAIF clock and MCLK
  90  */
  91 static int mxs_saif_set_clk(struct mxs_saif *saif,
  92                                   unsigned int mclk,
  93                                   unsigned int rate)
  94 {
  95         u32 scr;
  96         int ret;
  97         struct mxs_saif *master_saif;
  98
  99         dev_dbg(saif->dev, "mclk %d rate %d\n", mclk, rate);
 100
 101         /* Set master saif to generate proper clock */
 102         master_saif = mxs_saif_get_master(saif);
 103         if (!master_saif)
 104                 return -EINVAL;
 105
 106         dev_dbg(saif->dev, "master saif%d\n", master_saif->id);
 107
 108         /* Checking if can playback and capture simutaneously */
 109         if (master_saif->ongoing && rate != master_saif->cur_rate) {
 110                 dev_err(saif->dev,
 111                         "can not change clock, master saif%d(rate %d) is ongoing\n",
 112                         master_saif->id, master_saif->cur_rate);
 113                 return -EINVAL;
 114         }
 115
 116         scr = __raw_readl(master_saif->base + SAIF_CTRL);
 117         scr &= ~BM_SAIF_CTRL_BITCLK_MULT_RATE;
 118         scr &= ~BM_SAIF_CTRL_BITCLK_BASE_RATE;
 119
 120         /*
 121          * Set SAIF clock
 122          *
 123          * The SAIF clock should be either 384*fs or 512*fs.
 124          * If MCLK is used, the SAIF clk ratio need to match mclk ratio.
 125          *  For 32x mclk, set saif clk as 512*fs.
 126          *  For 48x mclk, set saif clk as 384*fs.
 127          *
 128          * If MCLK is not used, we just set saif clk to 512*fs.
 129          */
 130         clk_prepare_enable(master_saif->clk);
 131
 132         if (master_saif->mclk_in_use) {
 133                 if (mclk % 32 == 0) {
 134                         scr &= ~BM_SAIF_CTRL_BITCLK_BASE_RATE;
 135                         ret = clk_set_rate(master_saif->clk, 512 * rate);
 136                 } else if (mclk % 48 == 0) {
 137                         scr |= BM_SAIF_CTRL_BITCLK_BASE_RATE;
 138                         ret = clk_set_rate(master_saif->clk, 384 * rate);
 139                 } else {
 140                         /* SAIF MCLK should be either 32x or 48x */
 141                         clk_disable_unprepare(master_saif->clk);
 142                         return -EINVAL;
 143                 }
 144         } else {
 145                 ret = clk_set_rate(master_saif->clk, 512 * rate);
 146                 scr &= ~BM_SAIF_CTRL_BITCLK_BASE_RATE;
 147         }
 148
 149         clk_disable_unprepare(master_saif->clk);
 150
 151         if (ret)
 152                 return ret;
 153
 154         master_saif->cur_rate = rate;
 155
 156         if (!master_saif->mclk_in_use) {
 157                 __raw_writel(scr, master_saif->base + SAIF_CTRL);
 158                 return 0;
 159         }
 160
 161         /*
 162          * Program the over-sample rate for MCLK output
 163          *
 164          * The available MCLK range is 32x, 48x... 512x. The rate
 165          * could be from 8kHz to 192kH.
 166          */
 167         switch (mclk / rate) {
 168         case 32:
 169                 scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(4);
 170                 break;
 171         case 64:
 172                 scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(3);
 173                 break;
 174         case 128:
 175                 scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(2);
 176                 break;
 177         case 256:
 178                 scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(1);
 179                 break;
 180         case 512:
 181                 scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(0);
 182                 break;
 183         case 48:
 184                 scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(3);
 185                 break;
 186         case 96:
 187                 scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(2);
 188                 break;
 189         case 192:
 190                 scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(1);
 191                 break;
 192         case 384:
 193                 scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(0);
 194                 break;
 195         default:
 196                 return -EINVAL;
 197         }
 198
 199         __raw_writel(scr, master_saif->base + SAIF_CTRL);
 200
 201         return 0;
 202 }
 203
 204 /*
 205  * Put and disable MCLK.
 206  */
 207 int mxs_saif_put_mclk(unsigned int saif_id)
 208 {
 209         struct mxs_saif *saif = mxs_saif[saif_id];
 210         u32 stat;
 211
 212         if (!saif)
 213                 return -EINVAL;
 214
 215         stat = __raw_readl(saif->base + SAIF_STAT);
 216         if (stat & BM_SAIF_STAT_BUSY) {
 217                 dev_err(saif->dev, "error: busy\n");
 218                 return -EBUSY;
 219         }
 220
 221         clk_disable_unprepare(saif->clk);
 222
 223         /* disable MCLK output */
 224         __raw_writel(BM_SAIF_CTRL_CLKGATE,
 225                 saif->base + SAIF_CTRL + MXS_SET_ADDR);
 226         __raw_writel(BM_SAIF_CTRL_RUN,
 227                 saif->base + SAIF_CTRL + MXS_CLR_ADDR);
 228
 229         saif->mclk_in_use = 0;
 230         return 0;
 231 }
 232 EXPORT_SYMBOL_GPL(mxs_saif_put_mclk);
 233
 234 /*
 235  * Get MCLK and set clock rate, then enable it
 236  *
 237  * This interface is used for codecs who are using MCLK provided
 238  * by saif.
 239  */
 240 int mxs_saif_get_mclk(unsigned int saif_id, unsigned int mclk,
 241                                         unsigned int rate)
 242 {
 243         struct mxs_saif *saif = mxs_saif[saif_id];
 244         u32 stat;
 245         int ret;
 246         struct mxs_saif *master_saif;
 247
 248         if (!saif)
 249                 return -EINVAL;
 250
 251         /* Clear Reset */
 252         __raw_writel(BM_SAIF_CTRL_SFTRST,
 253                 saif->base + SAIF_CTRL + MXS_CLR_ADDR);
 254
 255         /* FIXME: need clear clk gate for register r/w */
 256         __raw_writel(BM_SAIF_CTRL_CLKGATE,
 257                 saif->base + SAIF_CTRL + MXS_CLR_ADDR);
 258
 259         master_saif = mxs_saif_get_master(saif);
 260         if (saif != master_saif) {
 261                 dev_err(saif->dev, "can not get mclk from a non-master saif\n");
 262                 return -EINVAL;
 263         }
 264
 265         stat = __raw_readl(saif->base + SAIF_STAT);
 266         if (stat & BM_SAIF_STAT_BUSY) {
 267                 dev_err(saif->dev, "error: busy\n");
 268                 return -EBUSY;
 269         }
 270
 271         saif->mclk_in_use = 1;
 272         ret = mxs_saif_set_clk(saif, mclk, rate);
 273         if (ret)
 274                 return ret;
 275
 276         ret = clk_prepare_enable(saif->clk);
 277         if (ret)
 278                 return ret;
 279
 280         /* enable MCLK output */
 281         __raw_writel(BM_SAIF_CTRL_RUN,
 282                 saif->base + SAIF_CTRL + MXS_SET_ADDR);
 283
 284         return 0;
 285 }
 286 EXPORT_SYMBOL_GPL(mxs_saif_get_mclk);
 287
 288 /*
 289  * SAIF DAI format configuration.
 290  * Should only be called when port is inactive.
 291  */
 292 static int mxs_saif_set_dai_fmt(struct snd_soc_dai *cpu_dai, unsigned int fmt)
 293 {
 294         u32 scr, stat;
 295         u32 scr0;
 296         struct mxs_saif *saif = snd_soc_dai_get_drvdata(cpu_dai);
 297
 298         stat = __raw_readl(saif->base + SAIF_STAT);
 299         if (stat & BM_SAIF_STAT_BUSY) {
 300                 dev_err(cpu_dai->dev, "error: busy\n");
 301                 return -EBUSY;
 302         }
 303
 304         scr0 = __raw_readl(saif->base + SAIF_CTRL);
 305         scr0 = scr0 & ~BM_SAIF_CTRL_BITCLK_EDGE & ~BM_SAIF_CTRL_LRCLK_POLARITY \
 306                 & ~BM_SAIF_CTRL_JUSTIFY & ~BM_SAIF_CTRL_DELAY;
 307         scr = 0;
 308
 309         /* DAI mode */
 310         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
 311         case SND_SOC_DAIFMT_I2S:
 312                 /* data frame low 1clk before data */
 313                 scr |= BM_SAIF_CTRL_DELAY;
 314                 scr &= ~BM_SAIF_CTRL_LRCLK_POLARITY;
 315                 break;
 316         case SND_SOC_DAIFMT_LEFT_J:
 317                 /* data frame high with data */
 318                 scr &= ~BM_SAIF_CTRL_DELAY;
 319                 scr &= ~BM_SAIF_CTRL_LRCLK_POLARITY;
 320                 scr &= ~BM_SAIF_CTRL_JUSTIFY;
 321                 break;
 322         default:
 323                 return -EINVAL;
 324         }
 325
 326         /* DAI clock inversion */
 327         switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
 328         case SND_SOC_DAIFMT_IB_IF:
 329                 scr |= BM_SAIF_CTRL_BITCLK_EDGE;
 330                 scr |= BM_SAIF_CTRL_LRCLK_POLARITY;
 331                 break;
 332         case SND_SOC_DAIFMT_IB_NF:
 333                 scr |= BM_SAIF_CTRL_BITCLK_EDGE;
 334                 scr &= ~BM_SAIF_CTRL_LRCLK_POLARITY;
 335                 break;
 336         case SND_SOC_DAIFMT_NB_IF:
 337                 scr &= ~BM_SAIF_CTRL_BITCLK_EDGE;
 338                 scr |= BM_SAIF_CTRL_LRCLK_POLARITY;
 339                 break;
 340         case SND_SOC_DAIFMT_NB_NF:
 341                 scr &= ~BM_SAIF_CTRL_BITCLK_EDGE;
 342                 scr &= ~BM_SAIF_CTRL_LRCLK_POLARITY;
 343                 break;
 344         }
 345
 346         /*
 347          * Note: We simply just support master mode since SAIF TX can only
 348          * work as master.
 349          * Here the master is relative to codec side.
 350          * Saif internally could be slave when working on EXTMASTER mode.
 351          * We just hide this to machine driver.
 352          */
 353         switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
 354         case SND_SOC_DAIFMT_CBS_CFS:
 355                 if (saif->id == saif->master_id)
 356                         scr &= ~BM_SAIF_CTRL_SLAVE_MODE;
 357                 else
 358                         scr |= BM_SAIF_CTRL_SLAVE_MODE;
 359
 360                 __raw_writel(scr | scr0, saif->base + SAIF_CTRL);
 361                 break;
 362         default:
 363                 return -EINVAL;
 364         }
 365
 366         return 0;
 367 }
 368
 369 static int mxs_saif_startup(struct snd_pcm_substream *substream,
 370                            struct snd_soc_dai *cpu_dai)
 371 {
 372         struct mxs_saif *saif = snd_soc_dai_get_drvdata(cpu_dai);
 373         snd_soc_dai_set_dma_data(cpu_dai, substream, &saif->dma_param);
 374
 375         /* clear error status to 0 for each re-open */
 376         saif->fifo_underrun = 0;
 377         saif->fifo_overrun = 0;
 378
 379         /* Clear Reset for normal operations */
 380         __raw_writel(BM_SAIF_CTRL_SFTRST,
 381                 saif->base + SAIF_CTRL + MXS_CLR_ADDR);
 382
 383         /* clear clock gate */
 384         __raw_writel(BM_SAIF_CTRL_CLKGATE,
 385                 saif->base + SAIF_CTRL + MXS_CLR_ADDR);
 386
 387         return 0;
 388 }
 389
 390 /*
 391  * Should only be called when port is inactive.
 392  * although can be called multiple times by upper layers.
 393  */
 394 static int mxs_saif_hw_params(struct snd_pcm_substream *substream,
 395                              struct snd_pcm_hw_params *params,
 396                              struct snd_soc_dai *cpu_dai)
 397 {
 398         struct mxs_saif *saif = snd_soc_dai_get_drvdata(cpu_dai);
 399         struct mxs_saif *master_saif;
 400         u32 scr, stat;
 401         int ret;
 402
 403         master_saif = mxs_saif_get_master(saif);
 404         if (!master_saif)
 405                 return -EINVAL;
 406
 407         /* mclk should already be set */
 408         if (!saif->mclk && saif->mclk_in_use) {
 409                 dev_err(cpu_dai->dev, "set mclk first\n");
 410                 return -EINVAL;
 411         }
 412
 413         stat = __raw_readl(saif->base + SAIF_STAT);
 414         if (stat & BM_SAIF_STAT_BUSY) {
 415                 dev_err(cpu_dai->dev, "error: busy\n");
 416                 return -EBUSY;
 417         }
 418
 419         /*
 420          * Set saif clk based on sample rate.
 421          * If mclk is used, we also set mclk, if not, saif->mclk is
 422          * default 0, means not used.
 423          */
 424         ret = mxs_saif_set_clk(saif, saif->mclk, params_rate(params));
 425         if (ret) {
 426                 dev_err(cpu_dai->dev, "unable to get proper clk\n");
 427                 return ret;
 428         }
 429
 430         /* prepare clk in hw_param, enable in trigger */
 431         clk_prepare(saif->clk);
 432         if (saif != master_saif) {
 433                 /*
 434                 * Set an initial clock rate for the saif internal logic to work
 435                 * properly. This is important when working in EXTMASTER mode
 436                 * that uses the other saif's BITCLK&LRCLK but it still needs a
 437                 * basic clock which should be fast enough for the internal
 438                 * logic.
 439                 */
 440                 clk_enable(saif->clk);
 441                 ret = clk_set_rate(saif->clk, 24000000);
 442                 clk_disable(saif->clk);
 443                 if (ret)
 444                         return ret;
 445
 446                 clk_prepare(master_saif->clk);
 447         }
 448
 449         scr = __raw_readl(saif->base + SAIF_CTRL);
 450
 451         scr &= ~BM_SAIF_CTRL_WORD_LENGTH;
 452         scr &= ~BM_SAIF_CTRL_BITCLK_48XFS_ENABLE;
 453         switch (params_format(params)) {
 454         case SNDRV_PCM_FORMAT_S16_LE:
 455                 scr |= BF_SAIF_CTRL_WORD_LENGTH(0);
 456                 break;
 457         case SNDRV_PCM_FORMAT_S20_3LE:
 458                 scr |= BF_SAIF_CTRL_WORD_LENGTH(4);
 459                 scr |= BM_SAIF_CTRL_BITCLK_48XFS_ENABLE;
 460                 break;
 461         case SNDRV_PCM_FORMAT_S24_LE:
 462                 scr |= BF_SAIF_CTRL_WORD_LENGTH(8);
 463                 scr |= BM_SAIF_CTRL_BITCLK_48XFS_ENABLE;
 464                 break;
 465         default:
 466                 return -EINVAL;
 467         }
 468
 469         /* Tx/Rx config */
 470         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 471                 /* enable TX mode */
 472                 scr &= ~BM_SAIF_CTRL_READ_MODE;
 473         } else {
 474                 /* enable RX mode */
 475                 scr |= BM_SAIF_CTRL_READ_MODE;
 476         }
 477
 478         __raw_writel(scr, saif->base + SAIF_CTRL);
 479         return 0;
 480 }
 481
 482 static int mxs_saif_prepare(struct snd_pcm_substream *substream,
 483                            struct snd_soc_dai *cpu_dai)
 484 {
 485         struct mxs_saif *saif = snd_soc_dai_get_drvdata(cpu_dai);
 486
 487         /* enable FIFO error irqs */
 488         __raw_writel(BM_SAIF_CTRL_FIFO_ERROR_IRQ_EN,
 489                 saif->base + SAIF_CTRL + MXS_SET_ADDR);
 490
 491         return 0;
 492 }
 493
 494 static int mxs_saif_trigger(struct snd_pcm_substream *substream, int cmd,
 495                                 struct snd_soc_dai *cpu_dai)
 496 {
 497         struct mxs_saif *saif = snd_soc_dai_get_drvdata(cpu_dai);
 498         struct mxs_saif *master_saif;
 499         u32 delay;
 500
 501         master_saif = mxs_saif_get_master(saif);
 502         if (!master_saif)
 503                 return -EINVAL;
 504
 505         switch (cmd) {
 506         case SNDRV_PCM_TRIGGER_START:
 507         case SNDRV_PCM_TRIGGER_RESUME:
 508         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
 509                 dev_dbg(cpu_dai->dev, "start\n");
 510
 511                 clk_enable(master_saif->clk);
 512                 if (!master_saif->mclk_in_use)
 513                         __raw_writel(BM_SAIF_CTRL_RUN,
 514                                 master_saif->base + SAIF_CTRL + MXS_SET_ADDR);
 515
 516                 /*
 517                  * If the saif's master is not himself, we also need to enable
 518                  * itself clk for its internal basic logic to work.
 519                  */
 520                 if (saif != master_saif) {
 521                         clk_enable(saif->clk);
 522                         __raw_writel(BM_SAIF_CTRL_RUN,
 523                                 saif->base + SAIF_CTRL + MXS_SET_ADDR);
 524                 }
 525
 526                 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 527                         /*
 528                          * write data to saif data register to trigger
 529                          * the transfer.
 530                          * For 24-bit format the 32-bit FIFO register stores
 531                          * only one channel, so we need to write twice.
 532                          * This is also safe for the other non 24-bit formats.
 533                          */
 534                         __raw_writel(0, saif->base + SAIF_DATA);
 535                         __raw_writel(0, saif->base + SAIF_DATA);
 536                 } else {
 537                         /*
 538                          * read data from saif data register to trigger
 539                          * the receive.
 540                          * For 24-bit format the 32-bit FIFO register stores
 541                          * only one channel, so we need to read twice.
 542                          * This is also safe for the other non 24-bit formats.
 543                          */
 544                         __raw_readl(saif->base + SAIF_DATA);
 545                         __raw_readl(saif->base + SAIF_DATA);
 546                 }
 547
 548                 master_saif->ongoing = 1;
 549
 550                 dev_dbg(saif->dev, "CTRL 0x%x STAT 0x%x\n",
 551                         __raw_readl(saif->base + SAIF_CTRL),
 552                         __raw_readl(saif->base + SAIF_STAT));
 553
 554                 dev_dbg(master_saif->dev, "CTRL 0x%x STAT 0x%x\n",
 555                         __raw_readl(master_saif->base + SAIF_CTRL),
 556                         __raw_readl(master_saif->base + SAIF_STAT));
 557                 break;
 558         case SNDRV_PCM_TRIGGER_SUSPEND:
 559         case SNDRV_PCM_TRIGGER_STOP:
 560         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
 561                 dev_dbg(cpu_dai->dev, "stop\n");
 562
 563                 /* wait a while for the current sample to complete */
 564                 delay = USEC_PER_SEC / master_saif->cur_rate;
 565
 566                 if (!master_saif->mclk_in_use) {
 567                         __raw_writel(BM_SAIF_CTRL_RUN,
 568                                 master_saif->base + SAIF_CTRL + MXS_CLR_ADDR);
 569                         udelay(delay);
 570                 }
 571                 clk_disable(master_saif->clk);
 572
 573                 if (saif != master_saif) {
 574                         __raw_writel(BM_SAIF_CTRL_RUN,
 575                                 saif->base + SAIF_CTRL + MXS_CLR_ADDR);
 576                         udelay(delay);
 577                         clk_disable(saif->clk);
 578                 }
 579
 580                 master_saif->ongoing = 0;
 581
 582                 break;
 583         default:
 584                 return -EINVAL;
 585         }
 586
 587         return 0;
 588 }
 589
 590 #define MXS_SAIF_RATES          SNDRV_PCM_RATE_8000_192000
 591 #define MXS_SAIF_FORMATS \
 592         (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
 593         SNDRV_PCM_FMTBIT_S24_LE)
 594
 595 static const struct snd_soc_dai_ops mxs_saif_dai_ops = {
 596         .startup = mxs_saif_startup,
 597         .trigger = mxs_saif_trigger,
 598         .prepare = mxs_saif_prepare,
 599         .hw_params = mxs_saif_hw_params,
 600         .set_sysclk = mxs_saif_set_dai_sysclk,
 601         .set_fmt = mxs_saif_set_dai_fmt,
 602 };
 603
 604 static int mxs_saif_dai_probe(struct snd_soc_dai *dai)
 605 {
 606         struct mxs_saif *saif = dev_get_drvdata(dai->dev);
 607
 608         snd_soc_dai_set_drvdata(dai, saif);
 609
 610         return 0;
 611 }
 612
 613 static struct snd_soc_dai_driver mxs_saif_dai = {
 614         .name = "mxs-saif",
 615         .probe = mxs_saif_dai_probe,
 616         .playback = {
 617                 .channels_min = 2,
 618                 .channels_max = 2,
 619                 .rates = MXS_SAIF_RATES,
 620                 .formats = MXS_SAIF_FORMATS,
 621         },
 622         .capture = {
 623                 .channels_min = 2,
 624                 .channels_max = 2,
 625                 .rates = MXS_SAIF_RATES,
 626                 .formats = MXS_SAIF_FORMATS,
 627         },
 628         .ops = &mxs_saif_dai_ops,
 629 };
 630
 631 static irqreturn_t mxs_saif_irq(int irq, void *dev_id)
 632 {
 633         struct mxs_saif *saif = dev_id;
 634         unsigned int stat;
 635
 636         stat = __raw_readl(saif->base + SAIF_STAT);
 637         if (!(stat & (BM_SAIF_STAT_FIFO_UNDERFLOW_IRQ |
 638                         BM_SAIF_STAT_FIFO_OVERFLOW_IRQ)))
 639                 return IRQ_NONE;
 640
 641         if (stat & BM_SAIF_STAT_FIFO_UNDERFLOW_IRQ) {
 642                 dev_dbg(saif->dev, "underrun!!! %d\n", ++saif->fifo_underrun);
 643                 __raw_writel(BM_SAIF_STAT_FIFO_UNDERFLOW_IRQ,
 644                                 saif->base + SAIF_STAT + MXS_CLR_ADDR);
 645         }
 646
 647         if (stat & BM_SAIF_STAT_FIFO_OVERFLOW_IRQ) {
 648                 dev_dbg(saif->dev, "overrun!!! %d\n", ++saif->fifo_overrun);
 649                 __raw_writel(BM_SAIF_STAT_FIFO_OVERFLOW_IRQ,
 650                                 saif->base + SAIF_STAT + MXS_CLR_ADDR);
 651         }
 652
 653         dev_dbg(saif->dev, "SAIF_CTRL %x SAIF_STAT %x\n",
 654                __raw_readl(saif->base + SAIF_CTRL),
 655                __raw_readl(saif->base + SAIF_STAT));
 656
 657         return IRQ_HANDLED;
 658 }
 659
 660 static int mxs_saif_probe(struct platform_device *pdev)
 661 {
 662         struct device_node *np = pdev->dev.of_node;
 663         struct resource *iores, *dmares;
 664         struct mxs_saif *saif;
 665         struct mxs_saif_platform_data *pdata;
 666         struct pinctrl *pinctrl;
 667         int ret = 0;
 668
 669
 670         if (!np && pdev->id >= ARRAY_SIZE(mxs_saif))
 671                 return -EINVAL;
 672
 673         saif = devm_kzalloc(&pdev->dev, sizeof(*saif), GFP_KERNEL);
 674         if (!saif)
 675                 return -ENOMEM;
 676
 677         if (np) {
 678                 struct device_node *master;
 679                 saif->id = of_alias_get_id(np, "saif");
 680                 if (saif->id < 0)
 681                         return saif->id;
 682                 /*
 683                  * If there is no "fsl,saif-master" phandle, it's a saif
 684                  * master.  Otherwise, it's a slave and its phandle points
 685                  * to the master.
 686                  */
 687                 master = of_parse_phandle(np, "fsl,saif-master", 0);
 688                 if (!master) {
 689                         saif->master_id = saif->id;
 690                 } else {
 691                         saif->master_id = of_alias_get_id(master, "saif");
 692                         if (saif->master_id < 0)
 693                                 return saif->master_id;
 694                 }
 695         } else {
 696                 saif->id = pdev->id;
 697                 pdata = pdev->dev.platform_data;
 698                 if (pdata && !pdata->master_mode)
 699                         saif->master_id = pdata->master_id;
 700                 else
 701                         saif->master_id = saif->id;
 702         }
 703
 704         if (saif->master_id < 0 || saif->master_id >= ARRAY_SIZE(mxs_saif)) {
 705                 dev_err(&pdev->dev, "get wrong master id\n");
 706                 return -EINVAL;
 707         }
 708
 709         mxs_saif[saif->id] = saif;
 710
 711         pinctrl = devm_pinctrl_get_select_default(&pdev->dev);
 712         if (IS_ERR(pinctrl)) {
 713                 ret = PTR_ERR(pinctrl);
 714                 return ret;
 715         }
 716
 717         saif->clk = devm_clk_get(&pdev->dev, NULL);
 718         if (IS_ERR(saif->clk)) {
 719                 ret = PTR_ERR(saif->clk);
 720                 dev_err(&pdev->dev, "Cannot get the clock: %d\n",
 721                         ret);
 722                 return ret;
 723         }
 724
 725         iores = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 726
 727         saif->base = devm_request_and_ioremap(&pdev->dev, iores);
 728         if (!saif->base) {
 729                 dev_err(&pdev->dev, "ioremap failed\n");
 730                 return -ENODEV;
 731         }
 732
 733         dmares = platform_get_resource(pdev, IORESOURCE_DMA, 0);
 734         if (!dmares) {
 735                 /*
 736                  * TODO: This is a temporary solution and should be changed
 737                  * to use generic DMA binding later when the helplers get in.
 738                  */
 739                 ret = of_property_read_u32(np, "fsl,saif-dma-channel",
 740                                            &saif->dma_param.chan_num);
 741                 if (ret) {
 742                         dev_err(&pdev->dev, "failed to get dma channel\n");
 743                         return ret;
 744                 }
 745         } else {
 746                 saif->dma_param.chan_num = dmares->start;
 747         }
 748
 749         saif->irq = platform_get_irq(pdev, 0);
 750         if (saif->irq < 0) {
 751                 ret = saif->irq;
 752                 dev_err(&pdev->dev, "failed to get irq resource: %d\n",
 753                         ret);
 754                 return ret;
 755         }
 756
 757         saif->dev = &pdev->dev;
 758         ret = devm_request_irq(&pdev->dev, saif->irq, mxs_saif_irq, 0,
 759                                "mxs-saif", saif);
 760         if (ret) {
 761                 dev_err(&pdev->dev, "failed to request irq\n");
 762                 return ret;
 763         }
 764
 765         saif->dma_param.chan_irq = platform_get_irq(pdev, 1);
 766         if (saif->dma_param.chan_irq < 0) {
 767                 ret = saif->dma_param.chan_irq;
 768                 dev_err(&pdev->dev, "failed to get dma irq resource: %d\n",
 769                         ret);
 770                 return ret;
 771         }
 772
 773         platform_set_drvdata(pdev, saif);
 774
 775         ret = snd_soc_register_dai(&pdev->dev, &mxs_saif_dai);
 776         if (ret) {
 777                 dev_err(&pdev->dev, "register DAI failed\n");
 778                 return ret;
 779         }
 780
 781         ret = mxs_pcm_platform_register(&pdev->dev);
 782         if (ret) {
 783                 dev_err(&pdev->dev, "register PCM failed: %d\n", ret);
 784                 goto failed_pdev_alloc;
 785         }
 786
 787         return 0;
 788
 789 failed_pdev_alloc:
 790         snd_soc_unregister_dai(&pdev->dev);
 791
 792         return ret;
 793 }
 794
 795 static int mxs_saif_remove(struct platform_device *pdev)
 796 {
 797         mxs_pcm_platform_unregister(&pdev->dev);
 798         snd_soc_unregister_dai(&pdev->dev);
 799
 800         return 0;
 801 }
 802
 803 static const struct of_device_id mxs_saif_dt_ids[] = {
 804         { .compatible = "fsl,imx28-saif", },
 805         { /* sentinel */ }
 806 };
 807 MODULE_DEVICE_TABLE(of, mxs_saif_dt_ids);
 808
 809 static struct platform_driver mxs_saif_driver = {
 810         .probe = mxs_saif_probe,
 811         .remove = mxs_saif_remove,
 812
 813         .driver = {
 814                 .name = "mxs-saif",
 815                 .owner = THIS_MODULE,
 816                 .of_match_table = mxs_saif_dt_ids,
 817         },
 818 };
 819
 820 module_platform_driver(mxs_saif_driver);
 821
 822 MODULE_AUTHOR("Freescale Semiconductor, Inc.");
 823 MODULE_DESCRIPTION("MXS ASoC SAIF driver");
 824 MODULE_LICENSE("GPL");
 825 MODULE_ALIAS("platform:mxs-saif");