sound/soc/rockchip/rk_spdif.c

   1 /*
   2  * Rockchip S/PDIF ALSA SoC Digital Audio Interface(DAI)  driver
   3  *
   4  * Copyright (C) 2015 Fuzhou Rockchip Electronics Co., Ltd
   5  *
   6  * This software is licensed under the terms of the GNU General Public
   7  * License version 2, as published by the Free Software Foundation, and
   8  * may be copied, distributed, and modified under those terms.
   9  *
  10  * This program is distributed in the hope that it will be useful,
  11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  * GNU General Public License for more details.
  14  *
  15  */
  16
  17 #include <linux/init.h>
  18 #include <linux/module.h>
  19 #include <linux/interrupt.h>
  20 #include <linux/device.h>
  21 #include <linux/delay.h>
  22 #include <linux/clk.h>
  23 #include <linux/version.h>
  24 #include <linux/of.h>
  25 #include <linux/of_gpio.h>
  26 #include <linux/clk.h>
  27 #include <linux/io.h>
  28 #include <linux/platform_device.h>
  29 #include <linux/pm_runtime.h>
  30 #include <linux/regmap.h>
  31 #include <linux/slab.h>
  32
  33 #include <linux/rockchip/iomap.h>
  34 #include <linux/rockchip/grf.h>
  35
  36 #include <asm/dma.h>
  37 #include <sound/core.h>
  38 #include <sound/pcm.h>
  39 #include <sound/pcm_params.h>
  40 #include <sound/initval.h>
  41 #include <sound/soc.h>
  42 #include <sound/dmaengine_pcm.h>
  43 #include <linux/spinlock.h>
  44 #include "rk_pcm.h"
  45
  46 /*
  47  * channel status register
  48  * 192 frame channel status bits: include 384 subframe bits
  49  */
  50 #define SPDIF_CHNSR00_ADDR      0xC0
  51 #define SPDIF_CHNSR01_ADDR      0xC4
  52 #define SPDIF_CHNSR02_ADDR      0xC8
  53 #define SPDIF_CHNSR03_ADDR      0xCC
  54 #define SPDIF_CHNSR04_ADDR      0xD0
  55 #define SPDIF_CHNSR05_ADDR      0xD4
  56 #define SPDIF_CHNSR06_ADDR      0xD8
  57 #define SPDIF_CHNSR07_ADDR      0xDC
  58 #define SPDIF_CHNSR08_ADDR      0xE0
  59 #define SPDIF_CHNSR09_ADDR      0xE4
  60 #define SPDIF_CHNSR10_ADDR      0xE8
  61 #define SPDIF_CHNSR11_ADDR      0xEC
  62
  63 /*
  64  * according to iec958, we only care about
  65  * the first meaningful 5 bytes(40 bits)
  66  */
  67 #define CHNSTA_BYTES            (5)
  68 #define BIT_1_LPCM              (0X0<<1)
  69 #define BIT_1_NLPCM             (0x1<<1)
  70
  71 /* sample word length bit 32~35 */
  72 #define CHNS_SAMPLE_WORD_LEN_16 (0x2)
  73 #define CHNS_SAMPLE_WORD_LEN_24 (0xb)
  74
  75 /* sample frequency bit 24~27 */
  76 #define CHNS_SAMPLE_FREQ_22P05K (0X4)
  77 #define CHNS_SAMPLE_FREQ_44P1K  (0X0)
  78 #define CHNS_SAMPLE_FREQ_88P2K  (0X8)
  79 #define CHNS_SAMPLE_FREQ_176P4K (0Xc)
  80 #define CHNS_SAMPLE_FREQ_24K    (0X6)
  81 #define CHNS_SAMPLE_FREQ_48K    (0X2)
  82 #define CHNS_SAMPLE_FREQ_96K    (0Xa)
  83 #define CHNS_SAMPLE_FREQ_192K   (0Xe)
  84 #define CHNS_SAMPLE_FREQ_32K    (0X3)
  85 #define CHNS_SAMPLE_FREQ_768K   (0X9)
  86
  87 /* Registers */
  88 #define CFGR                    0x00
  89 #define SDBLR                   0x04
  90 #define DMACR                   0x08
  91 #define INTCR                   0x0C
  92 #define INTSR                   0x10
  93 #define XFER                    0x18
  94 #define SMPDR                   0x20
  95
  96 /* transfer configuration register */
  97 #define CFGR_VALID_DATA_16bit           (0x0 << 0)
  98 #define CFGR_VALID_DATA_20bit           (0x1 << 0)
  99 #define CFGR_VALID_DATA_24bit           (0x2 << 0)
 100 #define CFGR_VALID_DATA_MASK            (0x3 << 0)
 101 #define CFGR_HALFWORD_TX_ENABLE         (0x1 << 2)
 102 #define CFGR_HALFWORD_TX_DISABLE        (0x0 << 2)
 103 #define CFGR_HALFWORD_TX_MASK           (0x1 << 2)
 104 #define CFGR_JUSTIFIED_RIGHT            (0x0 << 3)
 105 #define CFGR_JUSTIFIED_LEFT             (0x1 << 3)
 106 #define CFGR_JUSTIFIED_MASK             (0x1 << 3)
 107 #define CFGR_CSE_DISABLE                (0x0 << 6)
 108 #define CFGR_CSE_ENABLE                 (0x1 << 6)
 109 #define CFGR_CSE_MASK                   (0x1 << 6)
 110 #define CFGR_MCLK_CLR                   (0x1 << 7)
 111 #define CFGR_LINEAR_PCM                 (0x0 << 8)
 112 #define CFGR_NON_LINEAR_PCM             (0x1 << 8)
 113 #define CFGR_LINEAR_MASK                (0x1 << 8)
 114 #define CFGR_PRE_CHANGE_ENALBLE         (0x1 << 9)
 115 #define CFGR_PRE_CHANGE_DISABLE         (0x0 << 9)
 116 #define CFGR_PRE_CHANGE_MASK            (0x1 << 9)
 117 #define CFGR_CLK_RATE_MASK              (0xFF << 16)
 118
 119 /* transfer start register */
 120 #define XFER_TRAN_STOP                  (0x0 << 0)
 121 #define XFER_TRAN_START                 (0x1 << 0)
 122 #define XFER_MASK                       (0x1 << 0)
 123
 124 /* dma control register */
 125 #define DMACR_TRAN_DMA_DISABLE          (0x0 << 5)
 126 #define DMACR_TRAN_DMA_ENABLE           (0x1 << 5)
 127 #define DMACR_TRAN_DMA_CTL_MASK         (0x1 << 5)
 128 #define DMACR_TRAN_DATA_LEVEL           (0x10)
 129 #define DMACR_TRAN_DATA_LEVEL_MASK      (0x1F)
 130 #define DMACR_TRAN_DMA_MASK             (0x3F)
 131 #define DMA_DATA_LEVEL_16               (0x10)
 132
 133 /* interrupt control register */
 134 #define INTCR_SDBEIE_DISABLE            (0x0 << 4)
 135 #define INTCR_SDBEIE_ENABLE             (0x1 << 4)
 136 #define INTCR_SDBEIE_MASK               (0x1 << 4)
 137
 138 struct rockchip_spdif_info {
 139         spinlock_t lock;/*lock parmeter setting.*/
 140         void __iomem *regs;
 141         unsigned long clk_rate;
 142         struct clk *hclk;
 143         struct clk *clk;
 144         struct device *dev;
 145         struct snd_dmaengine_dai_dma_data dma_playback;
 146 };
 147
 148 static inline struct rockchip_spdif_info *to_info(struct snd_soc_dai *cpu_dai)
 149 {
 150         return snd_soc_dai_get_drvdata(cpu_dai);
 151 }
 152
 153 static void spdif_snd_txctrl(struct rockchip_spdif_info *spdif, int on)
 154 {
 155         void __iomem *regs = spdif->regs;
 156         u32 dmacr, xfer;
 157
 158         xfer = readl(regs + XFER) & (~XFER_MASK);
 159         dmacr = readl(regs + DMACR) & (~DMACR_TRAN_DMA_CTL_MASK);
 160
 161         if (on) {
 162                 xfer |= XFER_TRAN_START;
 163                 dmacr |= DMACR_TRAN_DMA_ENABLE;
 164                 writel(dmacr, regs + DMACR);
 165                 writel(xfer, regs + XFER);
 166         } else {
 167                 xfer &= XFER_TRAN_STOP;
 168                 dmacr &= DMACR_TRAN_DMA_DISABLE;
 169                 writel(xfer, regs + XFER);
 170                 writel(dmacr, regs + DMACR);
 171                 writel(CFGR_MCLK_CLR, regs + CFGR);
 172         }
 173
 174         dev_dbg(spdif->dev, "on: %d, xfer = 0x%x, dmacr = 0x%x\n",
 175                 on, readl(regs + XFER), readl(regs + DMACR));
 176 }
 177
 178 static int spdif_set_syclk(struct snd_soc_dai *cpu_dai, int clk_id,
 179                            unsigned int freq, int dir)
 180 {
 181         struct rockchip_spdif_info *spdif = to_info(cpu_dai);
 182
 183         dev_dbg(spdif->dev, "%s: sysclk = %d\n", __func__, freq);
 184
 185         spdif->clk_rate = freq;
 186         clk_set_rate(spdif->clk, freq);
 187
 188         return 0;
 189 }
 190
 191 static int spdif_trigger(struct snd_pcm_substream *substream, int cmd,
 192                          struct snd_soc_dai *dai)
 193 {
 194         struct snd_soc_pcm_runtime *rtd = substream->private_data;
 195         struct rockchip_spdif_info *spdif = to_info(rtd->cpu_dai);
 196         unsigned long flags;
 197
 198         dev_dbg(spdif->dev, "%s: cmd: %d\n", __func__, cmd);
 199
 200         switch (cmd) {
 201         case SNDRV_PCM_TRIGGER_START:
 202         case SNDRV_PCM_TRIGGER_RESUME:
 203         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
 204                 spin_lock_irqsave(&spdif->lock, flags);
 205                 spdif_snd_txctrl(spdif, 1);
 206                 spin_unlock_irqrestore(&spdif->lock, flags);
 207                 break;
 208         case SNDRV_PCM_TRIGGER_STOP:
 209         case SNDRV_PCM_TRIGGER_SUSPEND:
 210         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
 211                 spin_lock_irqsave(&spdif->lock, flags);
 212                 spdif_snd_txctrl(spdif, 0);
 213                 spin_unlock_irqrestore(&spdif->lock, flags);
 214                 break;
 215         default:
 216                 return -EINVAL;
 217         }
 218
 219         return 0;
 220 }
 221
 222 static int spdif_hw_params(struct snd_pcm_substream *substream,
 223                            struct snd_pcm_hw_params *params,
 224                            struct snd_soc_dai *dai)
 225 {
 226         struct rockchip_spdif_info *spdif = to_info(dai);
 227         void __iomem *regs = spdif->regs;
 228         unsigned long flags;
 229         unsigned int val;
 230         int cfgr, dmac, intcr, chnregval;
 231         char chnsta[CHNSTA_BYTES];
 232
 233         dev_dbg(spdif->dev, "%s\n", __func__);
 234
 235         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 236                 dai->playback_dma_data = &spdif->dma_playback;
 237         } else {
 238                 dev_err(spdif->dev, "capture is not supported\n");
 239                 return -EINVAL;
 240         }
 241
 242         spin_lock_irqsave(&spdif->lock, flags);
 243
 244         cfgr = readl(regs + CFGR);
 245
 246         cfgr &= ~CFGR_VALID_DATA_MASK;
 247         switch (params_format(params)) {
 248         case SNDRV_PCM_FORMAT_S16_LE:
 249                 cfgr |= CFGR_VALID_DATA_16bit;
 250                 break;
 251         case SNDRV_PCM_FORMAT_S20_3LE:
 252                 cfgr |= CFGR_VALID_DATA_20bit;
 253                 break;
 254         case SNDRV_PCM_FORMAT_S24_LE:
 255                 cfgr |= CFGR_VALID_DATA_24bit;
 256                 break;
 257         default:
 258                 goto err;
 259         }
 260
 261         cfgr &= ~CFGR_HALFWORD_TX_MASK;
 262         cfgr |= CFGR_HALFWORD_TX_ENABLE;
 263
 264         /* no need divder, let set_syclk care about this */
 265         cfgr &= ~CFGR_CLK_RATE_MASK;
 266         cfgr |= (0x0<<16);
 267
 268         cfgr &= ~CFGR_JUSTIFIED_MASK;
 269         cfgr |= CFGR_JUSTIFIED_RIGHT;
 270
 271         cfgr &= ~CFGR_CSE_MASK;
 272         cfgr |= CFGR_CSE_ENABLE;
 273
 274         cfgr &= ~CFGR_LINEAR_MASK;
 275         cfgr |= CFGR_LINEAR_PCM;
 276
 277         cfgr &= ~CFGR_PRE_CHANGE_MASK;
 278         cfgr |= CFGR_PRE_CHANGE_ENALBLE;
 279
 280         writel(cfgr, regs + CFGR);
 281
 282         intcr = readl(regs + INTCR) & (~INTCR_SDBEIE_MASK);
 283         intcr |= INTCR_SDBEIE_DISABLE;
 284         writel(intcr, regs + INTCR);
 285
 286         dmac = readl(regs + DMACR) & (~DMACR_TRAN_DATA_LEVEL_MASK);
 287         dmac |= DMA_DATA_LEVEL_16;
 288         writel(dmac, regs + DMACR);
 289
 290         /* channel status bit */
 291         memset(chnsta, 0x0, CHNSTA_BYTES);
 292         switch (params_rate(params)) {
 293         case 44100:
 294                 val = CHNS_SAMPLE_FREQ_44P1K;
 295                 break;
 296         case 48000:
 297                 val = CHNS_SAMPLE_FREQ_48K;
 298                 break;
 299         case 88200:
 300                 val = CHNS_SAMPLE_FREQ_88P2K;
 301                 break;
 302         case 96000:
 303                 val = CHNS_SAMPLE_FREQ_96K;
 304                 break;
 305         case 176400:
 306                 val = CHNS_SAMPLE_FREQ_176P4K;
 307                 break;
 308         case 192000:
 309                 val = CHNS_SAMPLE_FREQ_192K;
 310                 break;
 311         default:
 312                 val = CHNS_SAMPLE_FREQ_44P1K;
 313                 break;
 314         }
 315
 316         chnsta[0] |= BIT_1_LPCM;
 317         chnsta[3] |= val;
 318         chnsta[4] |= ((~val)<<4 | CHNS_SAMPLE_WORD_LEN_16);
 319
 320         chnregval = (chnsta[4] << 16) | (chnsta[4]);
 321         writel(chnregval, regs + SPDIF_CHNSR02_ADDR);
 322
 323         chnregval = (chnsta[3] << 24) | (chnsta[3] << 8);
 324         writel(chnregval, regs + SPDIF_CHNSR01_ADDR);
 325
 326         chnregval = (chnsta[1] << 24) | (chnsta[0] << 16) |
 327                                 (chnsta[1] << 8) | (chnsta[0]);
 328         writel(chnregval, regs + SPDIF_CHNSR00_ADDR);
 329
 330         spin_unlock_irqrestore(&spdif->lock, flags);
 331
 332         return 0;
 333 err:
 334         spin_unlock_irqrestore(&spdif->lock, flags);
 335         return -EINVAL;
 336 }
 337
 338 #ifdef CONFIG_PM
 339 static int spdif_suspend(struct snd_soc_dai *cpu_dai)
 340 {
 341         struct rockchip_spdif_info *spdif = to_info(cpu_dai);
 342
 343         dev_dbg(spdif->dev, "%s\n", __func__);
 344         return 0;
 345 }
 346
 347 static int spdif_resume(struct snd_soc_dai *cpu_dai)
 348 {
 349         struct rockchip_spdif_info *spdif = to_info(cpu_dai);
 350
 351         dev_dbg(spdif->dev, "%s\n", __func__);
 352         return 0;
 353 }
 354 #else
 355 #define spdif_suspend NULL
 356 #define spdif_resume NULL
 357 #endif
 358
 359 static struct snd_soc_dai_ops spdif_dai_ops = {
 360         .set_sysclk     = spdif_set_syclk,
 361         .trigger        = spdif_trigger,
 362         .hw_params      = spdif_hw_params,
 363 };
 364
 365 struct snd_soc_dai_driver rockchip_spdif_dai = {
 366         .name = "rockchip-spdif",
 367         .playback = {
 368                 .stream_name = "SPDIF Playback",
 369                 .channels_min = 2,
 370                 .channels_max = 2,
 371                 .rates = SNDRV_PCM_RATE_8000_192000,
 372                 .formats = SNDRV_PCM_FMTBIT_S16_LE |
 373                            SNDRV_PCM_FMTBIT_S20_3LE |
 374                            SNDRV_PCM_FMTBIT_S24_LE, },
 375         .ops = &spdif_dai_ops,
 376         .suspend = spdif_suspend,
 377         .resume = spdif_resume,
 378 };
 379
 380 static const struct snd_soc_component_driver rockchip_spdif_component = {
 381         .name = "rockchip-spdif",
 382 };
 383
 384 static int spdif_probe(struct platform_device *pdev)
 385 {
 386         struct resource *memregion;
 387         struct resource *mem_res;
 388         struct rockchip_spdif_info *spdif;
 389         int ret;
 390
 391         spdif = devm_kzalloc(&pdev->dev, sizeof(
 392                 struct rockchip_spdif_info), GFP_KERNEL);
 393         if (!spdif) {
 394                 dev_err(&pdev->dev, "Can't allocate spdif info\n");
 395                 return -ENOMEM;
 396         }
 397
 398         spdif->dev = &pdev->dev;
 399         platform_set_drvdata(pdev, spdif);
 400
 401         spin_lock_init(&spdif->lock);
 402
 403         /* get spdif register region. */
 404         mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 405         if (!mem_res) {
 406                 dev_err(&pdev->dev, "No memory resource\n");
 407                 ret = -ENOENT;
 408                 goto err_;
 409         }
 410         memregion = devm_request_mem_region(&pdev->dev,
 411                                             mem_res->start,
 412                                             resource_size(mem_res),
 413                                             "rockchip-spdif");
 414         if (!memregion) {
 415                 dev_err(&pdev->dev, "Memory region already claimed\n");
 416                 ret = -EBUSY;
 417                 goto err_;
 418         }
 419         spdif->regs = devm_ioremap(&pdev->dev,
 420                                    memregion->start,
 421                                    resource_size(memregion));
 422         if (!spdif->regs) {
 423                 dev_err(&pdev->dev, "ioremap failed\n");
 424                 ret = -ENOMEM;
 425                 goto err_;
 426         }
 427
 428         /* get spdif clock and init. */
 429         spdif->hclk = devm_clk_get(&pdev->dev, "spdif_hclk");
 430         if (IS_ERR(spdif->hclk)) {
 431                 dev_err(&pdev->dev, "Can't retrieve spdif hclk\n");
 432                 spdif->hclk = NULL;
 433         }
 434         clk_prepare_enable(spdif->hclk);
 435
 436         spdif->clk = devm_clk_get(&pdev->dev, "spdif_mclk");
 437         if (IS_ERR(spdif->clk)) {
 438                 dev_err(&pdev->dev, "Can't retrieve spdif mclk\n");
 439                 ret = -ENOMEM;
 440                 goto err_;
 441         }
 442         /* init freq */
 443         clk_set_rate(spdif->clk, 11289600);
 444         clk_prepare_enable(spdif->clk);
 445
 446         spdif->dma_playback.addr = mem_res->start + SMPDR;
 447         spdif->dma_playback.addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES;
 448         spdif->dma_playback.maxburst = 4;
 449
 450         ret = snd_soc_register_component(&pdev->dev,
 451                                          &rockchip_spdif_component,
 452                                          &rockchip_spdif_dai, 1);
 453         if (ret) {
 454                 dev_err(&pdev->dev, "Could not register DAI: %d\n", ret);
 455                 ret = -ENOMEM;
 456                 goto err_;
 457         }
 458
 459         ret = rockchip_pcm_platform_register(&pdev->dev);
 460         if (ret) {
 461                 dev_err(&pdev->dev, "Could not register PCM: %d\n", ret);
 462                 goto err_;
 463         }
 464
 465         dev_info(&pdev->dev, "spdif ready.\n");
 466
 467         return 0;
 468
 469 err_:
 470         platform_set_drvdata(pdev, NULL);
 471
 472         return ret;
 473 }
 474
 475 static int spdif_remove(struct platform_device *pdev)
 476 {
 477         rockchip_pcm_platform_unregister(&pdev->dev);
 478         snd_soc_unregister_component(&pdev->dev);
 479
 480         return 0;
 481 }
 482
 483 #ifdef CONFIG_OF
 484 static const struct of_device_id rockchip_spdif_match[] = {
 485         { .compatible = "rockchip-spdif", },
 486         {},
 487 };
 488 MODULE_DEVICE_TABLE(of, rockchip_spdif_match);
 489 #endif
 490
 491 static struct platform_driver rockchip_spdif_driver = {
 492         .probe  = spdif_probe,
 493         .remove = spdif_remove,
 494         .driver = {
 495                 .name   = "rockchip-spdif",
 496                 .of_match_table = of_match_ptr(rockchip_spdif_match),
 497         },
 498 };
 499 module_platform_driver(rockchip_spdif_driver);
 500
 501 MODULE_AUTHOR("Sugar <sugar.zhang@rock-chips.com>");
 502 MODULE_DESCRIPTION("Rockchip S/PDIF Controller Driver");
 503 MODULE_LICENSE("GPL v2");
 504 MODULE_ALIAS("platform:rockchip-spdif");