target/linux/ramips/patches-5.15/835-asoc-add-mt7620-support.patch

   1 From 7f29222b1731e8182ba94a331531dec18865a1e4 Mon Sep 17 00:00:00 2001
   2 From: John Crispin <blogic@openwrt.org>
   3 Date: Sun, 27 Jul 2014 09:31:47 +0100
   4 Subject: [PATCH 48/53] asoc: add mt7620 support
   5
   6 Signed-off-by: John Crispin <blogic@openwrt.org>
   7 ---
   8  arch/mips/ralink/of.c            |    2 +
   9  sound/soc/Kconfig                |    1 +
  10  sound/soc/Makefile               |    1 +
  11  sound/soc/ralink/Kconfig         |   15 ++
  12  sound/soc/ralink/Makefile        |   11 +
  13  sound/soc/ralink/mt7620-i2s.c    |  436 ++++++++++++++++++++++++++++++++++++++
  14  sound/soc/ralink/mt7620-wm8960.c |  233 ++++++++++++++++++++
  15  7 files changed, 699 insertions(+)
  16  create mode 100644 sound/soc/ralink/Kconfig
  17  create mode 100644 sound/soc/ralink/Makefile
  18  create mode 100644 sound/soc/ralink/mt7620-i2s.c
  19  create mode 100644 sound/soc/ralink/mt7620-wm8960.c
  20
  21 --- a/sound/soc/Kconfig
  22 +++ b/sound/soc/Kconfig
  23 @@ -78,6 +78,7 @@ source "sound/soc/mxs/Kconfig"
  24  source "sound/soc/pxa/Kconfig"
  25  source "sound/soc/qcom/Kconfig"
  26  source "sound/soc/rockchip/Kconfig"
  27 +source "sound/soc/ralink/Kconfig"
  28  source "sound/soc/samsung/Kconfig"
  29  source "sound/soc/sh/Kconfig"
  30  source "sound/soc/sof/Kconfig"
  31 --- a/sound/soc/Makefile
  32 +++ b/sound/soc/Makefile
  33 @@ -48,6 +48,7 @@ obj-$(CONFIG_SND_SOC) += kirkwood/
  34  obj-$(CONFIG_SND_SOC)  += pxa/
  35  obj-$(CONFIG_SND_SOC)  += qcom/
  36  obj-$(CONFIG_SND_SOC)  += rockchip/
  37 +obj-$(CONFIG_SND_SOC)  += ralink/
  38  obj-$(CONFIG_SND_SOC)  += samsung/
  39  obj-$(CONFIG_SND_SOC)  += sh/
  40  obj-$(CONFIG_SND_SOC)  += sof/
  41 --- /dev/null
  42 +++ b/sound/soc/ralink/Kconfig
  43 @@ -0,0 +1,8 @@
  44 +config SND_RALINK_SOC_I2S
  45 +       depends on RALINK && SND_SOC && !SOC_RT288X
  46 +       select SND_SOC_GENERIC_DMAENGINE_PCM
  47 +       select REGMAP_MMIO
  48 +       tristate "SoC Audio (I2S protocol) for Ralink SoC"
  49 +       help
  50 +         Say Y if you want to use I2S protocol and I2S codec on Ralink/MediaTek
  51 +         based boards.
  52 --- /dev/null
  53 +++ b/sound/soc/ralink/Makefile
  54 @@ -0,0 +1,6 @@
  55 +#
  56 +# Ralink/MediaTek Platform Support
  57 +#
  58 +snd-soc-ralink-i2s-objs := ralink-i2s.o
  59 +
  60 +obj-$(CONFIG_SND_RALINK_SOC_I2S) += snd-soc-ralink-i2s.o
  61 --- /dev/null
  62 +++ b/sound/soc/ralink/ralink-i2s.c
  63 @@ -0,0 +1,970 @@
  64 +/*
  65 + *  Copyright (C) 2010, Lars-Peter Clausen <lars@metafoo.de>
  66 + *  Copyright (C) 2016 Michael Lee <igvtee@gmail.com>
  67 + *
  68 + *  This program is free software; you can redistribute it and/or modify it
  69 + *  under  the terms of the GNU General  Public License as published by the
  70 + *  Free Software Foundation;  either version 2 of the License, or (at your
  71 + *  option) any later version.
  72 + *
  73 + *  You should have received a copy of the GNU General Public License along
  74 + *  with this program; if not, write to the Free Software Foundation, Inc.,
  75 + *  675 Mass Ave, Cambridge, MA 02139, USA.
  76 + *
  77 + */
  78 +
  79 +#include <linux/module.h>
  80 +#include <linux/platform_device.h>
  81 +#include <linux/clk.h>
  82 +#include <linux/regmap.h>
  83 +#include <linux/reset.h>
  84 +#include <linux/debugfs.h>
  85 +#include <linux/of_device.h>
  86 +#include <sound/pcm_params.h>
  87 +#include <sound/dmaengine_pcm.h>
  88 +
  89 +#include <asm/mach-ralink/ralink_regs.h>
  90 +
  91 +#define DRV_NAME "ralink-i2s"
  92 +
  93 +#define I2S_REG_CFG0           0x00
  94 +#define I2S_REG_INT_STATUS     0x04
  95 +#define I2S_REG_INT_EN         0x08
  96 +#define I2S_REG_FF_STATUS      0x0c
  97 +#define I2S_REG_WREG           0x10
  98 +#define I2S_REG_RREG           0x14
  99 +#define I2S_REG_CFG1           0x18
 100 +#define I2S_REG_DIVCMP         0x20
 101 +#define I2S_REG_DIVINT         0x24
 102 +
 103 +/* I2S_REG_CFG0 */
 104 +#define I2S_REG_CFG0_EN                BIT(31)
 105 +#define I2S_REG_CFG0_DMA_EN    BIT(30)
 106 +#define I2S_REG_CFG0_BYTE_SWAP BIT(28)
 107 +#define I2S_REG_CFG0_TX_EN     BIT(24)
 108 +#define I2S_REG_CFG0_RX_EN     BIT(20)
 109 +#define I2S_REG_CFG0_SLAVE     BIT(16)
 110 +#define I2S_REG_CFG0_RX_THRES  12
 111 +#define I2S_REG_CFG0_TX_THRES  4
 112 +#define I2S_REG_CFG0_THRES_MASK        (0xf << I2S_REG_CFG0_RX_THRES) | \
 113 +       (4 << I2S_REG_CFG0_TX_THRES)
 114 +#define I2S_REG_CFG0_DFT_THRES (4 << I2S_REG_CFG0_RX_THRES) | \
 115 +       (4 << I2S_REG_CFG0_TX_THRES)
 116 +/* RT305x */
 117 +#define I2S_REG_CFG0_CLK_DIS   BIT(8)
 118 +#define I2S_REG_CFG0_TXCH_SWAP BIT(3)
 119 +#define I2S_REG_CFG0_TXCH1_OFF BIT(2)
 120 +#define I2S_REG_CFG0_TXCH0_OFF BIT(1)
 121 +#define I2S_REG_CFG0_SLAVE_EN  BIT(0)
 122 +/* RT3883 */
 123 +#define I2S_REG_CFG0_RXCH_SWAP BIT(11)
 124 +#define I2S_REG_CFG0_RXCH1_OFF BIT(10)
 125 +#define I2S_REG_CFG0_RXCH0_OFF BIT(9)
 126 +#define I2S_REG_CFG0_WS_INV    BIT(0)
 127 +/* MT7628 */
 128 +#define I2S_REG_CFG0_FMT_LE    BIT(29)
 129 +#define I2S_REG_CFG0_SYS_BE    BIT(28)
 130 +#define I2S_REG_CFG0_NORM_24   BIT(18)
 131 +#define I2S_REG_CFG0_DATA_24   BIT(17)
 132 +
 133 +/* I2S_REG_INT_STATUS */
 134 +#define I2S_REG_INT_RX_FAULT   BIT(7)
 135 +#define I2S_REG_INT_RX_OVRUN   BIT(6)
 136 +#define I2S_REG_INT_RX_UNRUN   BIT(5)
 137 +#define I2S_REG_INT_RX_THRES   BIT(4)
 138 +#define I2S_REG_INT_TX_FAULT   BIT(3)
 139 +#define I2S_REG_INT_TX_OVRUN   BIT(2)
 140 +#define I2S_REG_INT_TX_UNRUN   BIT(1)
 141 +#define I2S_REG_INT_TX_THRES   BIT(0)
 142 +#define I2S_REG_INT_TX_MASK    0xf
 143 +#define I2S_REG_INT_RX_MASK    0xf0
 144 +
 145 +/* I2S_REG_INT_STATUS */
 146 +#define I2S_RX_AVCNT(x)                ((x >> 4) & 0xf)
 147 +#define I2S_TX_AVCNT(x)                (x & 0xf)
 148 +/* MT7628 */
 149 +#define MT7628_I2S_RX_AVCNT(x) ((x >> 8) & 0x1f)
 150 +#define MT7628_I2S_TX_AVCNT(x) (x & 0x1f)
 151 +
 152 +/* I2S_REG_CFG1 */
 153 +#define I2S_REG_CFG1_LBK       BIT(31)
 154 +#define I2S_REG_CFG1_EXTLBK    BIT(30)
 155 +/* RT3883 */
 156 +#define I2S_REG_CFG1_LEFT_J    BIT(0)
 157 +#define I2S_REG_CFG1_RIGHT_J   BIT(1)
 158 +#define I2S_REG_CFG1_FMT_MASK  0x3
 159 +
 160 +/* I2S_REG_DIVCMP */
 161 +#define I2S_REG_DIVCMP_CLKEN   BIT(31)
 162 +#define I2S_REG_DIVCMP_DIVCOMP_MASK    0x1ff
 163 +
 164 +/* I2S_REG_DIVINT */
 165 +#define I2S_REG_DIVINT_MASK    0x3ff
 166 +
 167 +/* BCLK dividers */
 168 +#define RALINK_I2S_DIVCMP      0
 169 +#define RALINK_I2S_DIVINT      1
 170 +
 171 +/* FIFO */
 172 +#define RALINK_I2S_FIFO_SIZE   32
 173 +
 174 +/* feature flags */
 175 +#define RALINK_FLAGS_TXONLY    BIT(0)
 176 +#define RALINK_FLAGS_LEFT_J    BIT(1)
 177 +#define RALINK_FLAGS_RIGHT_J   BIT(2)
 178 +#define RALINK_FLAGS_ENDIAN    BIT(3)
 179 +#define RALINK_FLAGS_24BIT     BIT(4)
 180 +
 181 +#define RALINK_I2S_INT_EN      0
 182 +
 183 +struct ralink_i2s_stats {
 184 +       u32 dmafault;
 185 +       u32 overrun;
 186 +       u32 underrun;
 187 +       u32 belowthres;
 188 +};
 189 +
 190 +struct ralink_i2s {
 191 +       struct device *dev;
 192 +       void __iomem *regs;
 193 +       struct clk *clk;
 194 +       struct regmap *regmap;
 195 +       u32 flags;
 196 +       unsigned int fmt;
 197 +       u16 txdma_req;
 198 +       u16 rxdma_req;
 199 +
 200 +       struct snd_dmaengine_dai_dma_data playback_dma_data;
 201 +       struct snd_dmaengine_dai_dma_data capture_dma_data;
 202 +
 203 +       struct dentry *dbg_dir;
 204 +        struct dentry *dbg_stats;
 205 +       struct ralink_i2s_stats txstats;
 206 +       struct ralink_i2s_stats rxstats;
 207 +};
 208 +
 209 +static void ralink_i2s_dump_regs(struct ralink_i2s *i2s)
 210 +{
 211 +       u32 buf[10];
 212 +       int ret;
 213 +
 214 +       ret = regmap_bulk_read(i2s->regmap, I2S_REG_CFG0,
 215 +                       buf, ARRAY_SIZE(buf));
 216 +
 217 +       dev_dbg(i2s->dev, "CFG0: %08x, INTSTAT: %08x, INTEN: %08x, " \
 218 +                       "FFSTAT: %08x, WREG: %08x, RREG: %08x, " \
 219 +                       "CFG1: %08x, DIVCMP: %08x, DIVINT: %08x\n",
 220 +                       buf[0], buf[1], buf[2], buf[3], buf[4],
 221 +                       buf[5], buf[6], buf[8], buf[9]);
 222 +}
 223 +
 224 +static int ralink_i2s_set_sysclk(struct snd_soc_dai *dai,
 225 +                              int clk_id, unsigned int freq, int dir)
 226 +{
 227 +       return 0;
 228 +}
 229 +
 230 +static int ralink_i2s_set_sys_bclk(struct snd_soc_dai *dai, int width, int rate)
 231 +{
 232 +       struct ralink_i2s *i2s = snd_soc_dai_get_drvdata(dai);
 233 +       unsigned long clk = clk_get_rate(i2s->clk);
 234 +       int div;
 235 +       uint32_t data;
 236 +
 237 +       /* disable clock at slave mode */
 238 +       if ((i2s->fmt & SND_SOC_DAIFMT_MASTER_MASK) ==
 239 +                       SND_SOC_DAIFMT_CBM_CFM) {
 240 +               regmap_update_bits(i2s->regmap, I2S_REG_CFG0,
 241 +                               I2S_REG_CFG0_CLK_DIS,
 242 +                               I2S_REG_CFG0_CLK_DIS);
 243 +               return 0;
 244 +       }
 245 +
 246 +       /* FREQOUT = FREQIN / (I2S_CLK_DIV + 1) */
 247 +       div = (clk / rate ) - 1;
 248 +
 249 +       data = rt_sysc_r32(0x30);
 250 +       data &= (0xff << 8);
 251 +       data |= (0x1 << 15) | (div << 8);
 252 +       rt_sysc_w32(data, 0x30);
 253 +
 254 +       /* enable clock */
 255 +       regmap_update_bits(i2s->regmap, I2S_REG_CFG0, I2S_REG_CFG0_CLK_DIS, 0);
 256 +
 257 +       dev_dbg(i2s->dev, "clk: %lu, rate: %u, div: %d\n",
 258 +                       clk, rate, div);
 259 +
 260 +       return 0;
 261 +}
 262 +
 263 +static int ralink_i2s_set_bclk(struct snd_soc_dai *dai, int width, int rate)
 264 +{
 265 +       struct ralink_i2s *i2s = snd_soc_dai_get_drvdata(dai);
 266 +       unsigned long clk = clk_get_rate(i2s->clk);
 267 +       int divint, divcomp;
 268 +
 269 +       /* disable clock at slave mode */
 270 +       if ((i2s->fmt & SND_SOC_DAIFMT_MASTER_MASK) ==
 271 +                       SND_SOC_DAIFMT_CBM_CFM) {
 272 +               regmap_update_bits(i2s->regmap, I2S_REG_DIVCMP,
 273 +                               I2S_REG_DIVCMP_CLKEN, 0);
 274 +               return 0;
 275 +       }
 276 +
 277 +       /* FREQOUT = FREQIN * (1/2) * (1/(DIVINT + DIVCOMP/512)) */
 278 +       clk = clk / (2 * 2 * width);
 279 +       divint = clk / rate;
 280 +       divcomp = ((clk % rate) * 512) / rate;
 281 +
 282 +       if ((divint > I2S_REG_DIVINT_MASK) ||
 283 +                       (divcomp > I2S_REG_DIVCMP_DIVCOMP_MASK))
 284 +               return -EINVAL;
 285 +
 286 +       regmap_update_bits(i2s->regmap, I2S_REG_DIVINT,
 287 +                       I2S_REG_DIVINT_MASK, divint);
 288 +       regmap_update_bits(i2s->regmap, I2S_REG_DIVCMP,
 289 +                       I2S_REG_DIVCMP_DIVCOMP_MASK, divcomp);
 290 +
 291 +       /* enable clock */
 292 +       regmap_update_bits(i2s->regmap, I2S_REG_DIVCMP, I2S_REG_DIVCMP_CLKEN,
 293 +                       I2S_REG_DIVCMP_CLKEN);
 294 +
 295 +       dev_dbg(i2s->dev, "clk: %lu, rate: %u, int: %d, comp: %d\n",
 296 +                       clk_get_rate(i2s->clk), rate, divint, divcomp);
 297 +
 298 +       return 0;
 299 +}
 300 +
 301 +static int ralink_i2s_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
 302 +{
 303 +       struct ralink_i2s *i2s = snd_soc_dai_get_drvdata(dai);
 304 +       unsigned int cfg0 = 0, cfg1 = 0;
 305 +
 306 +       /* set master/slave audio interface */
 307 +       switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
 308 +       case SND_SOC_DAIFMT_CBM_CFM:
 309 +               if (i2s->flags & RALINK_FLAGS_TXONLY)
 310 +                       cfg0 |= I2S_REG_CFG0_SLAVE_EN;
 311 +               else
 312 +                       cfg0 |= I2S_REG_CFG0_SLAVE;
 313 +               break;
 314 +       case SND_SOC_DAIFMT_CBS_CFS:
 315 +               break;
 316 +       default:
 317 +               return -EINVAL;
 318 +       }
 319 +
 320 +       /* interface format */
 321 +       switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
 322 +       case SND_SOC_DAIFMT_I2S:
 323 +               break;
 324 +       case SND_SOC_DAIFMT_RIGHT_J:
 325 +               if (i2s->flags & RALINK_FLAGS_RIGHT_J) {
 326 +                       cfg1 |= I2S_REG_CFG1_RIGHT_J;
 327 +                       break;
 328 +               }
 329 +               return -EINVAL;
 330 +       case SND_SOC_DAIFMT_LEFT_J:
 331 +               if (i2s->flags & RALINK_FLAGS_LEFT_J) {
 332 +                       cfg1 |= I2S_REG_CFG1_LEFT_J;
 333 +                       break;
 334 +               }
 335 +               return -EINVAL;
 336 +       default:
 337 +               return -EINVAL;
 338 +       }
 339 +
 340 +       /* clock inversion */
 341 +       switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
 342 +       case SND_SOC_DAIFMT_NB_NF:
 343 +               break;
 344 +       default:
 345 +               return -EINVAL;
 346 +       }
 347 +
 348 +       if (i2s->flags & RALINK_FLAGS_TXONLY) {
 349 +               regmap_update_bits(i2s->regmap, I2S_REG_CFG0,
 350 +                               I2S_REG_CFG0_SLAVE_EN, cfg0);
 351 +       } else {
 352 +               regmap_update_bits(i2s->regmap, I2S_REG_CFG0,
 353 +                               I2S_REG_CFG0_SLAVE, cfg0);
 354 +       }
 355 +       regmap_update_bits(i2s->regmap, I2S_REG_CFG1,
 356 +                       I2S_REG_CFG1_FMT_MASK, cfg1);
 357 +       i2s->fmt = fmt;
 358 +
 359 +       return 0;
 360 +}
 361 +
 362 +static int ralink_i2s_startup(struct snd_pcm_substream *substream,
 363 +               struct snd_soc_dai *dai)
 364 +{
 365 +       struct ralink_i2s *i2s = snd_soc_dai_get_drvdata(dai);
 366 +
 367 +       if (snd_soc_dai_active(dai))
 368 +               return 0;
 369 +
 370 +       /* setup status interrupt */
 371 +#if (RALINK_I2S_INT_EN)
 372 +       regmap_write(i2s->regmap, I2S_REG_INT_EN, 0xff);
 373 +#else
 374 +       regmap_write(i2s->regmap, I2S_REG_INT_EN, 0x0);
 375 +#endif
 376 +
 377 +       /* enable */
 378 +       regmap_update_bits(i2s->regmap, I2S_REG_CFG0,
 379 +                       I2S_REG_CFG0_EN | I2S_REG_CFG0_DMA_EN |
 380 +                       I2S_REG_CFG0_THRES_MASK,
 381 +                       I2S_REG_CFG0_EN | I2S_REG_CFG0_DMA_EN |
 382 +                       I2S_REG_CFG0_DFT_THRES);
 383 +
 384 +       return 0;
 385 +}
 386 +
 387 +static void ralink_i2s_shutdown(struct snd_pcm_substream *substream,
 388 +               struct snd_soc_dai *dai)
 389 +{
 390 +       struct ralink_i2s *i2s = snd_soc_dai_get_drvdata(dai);
 391 +
 392 +       /* If both streams are stopped, disable module and clock */
 393 +       if (snd_soc_dai_active(dai))
 394 +               return;
 395 +
 396 +       /*
 397 +        * datasheet mention when disable all control regs are cleared
 398 +        * to initial values. need reinit at startup.
 399 +        */
 400 +       regmap_update_bits(i2s->regmap, I2S_REG_CFG0, I2S_REG_CFG0_EN, 0);
 401 +}
 402 +
 403 +static int ralink_i2s_hw_params(struct snd_pcm_substream *substream,
 404 +               struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
 405 +{
 406 +       struct ralink_i2s *i2s = snd_soc_dai_get_drvdata(dai);
 407 +       int width;
 408 +       int ret;
 409 +
 410 +       width = params_width(params);
 411 +       switch (width) {
 412 +       case 16:
 413 +               if (i2s->flags & RALINK_FLAGS_24BIT)
 414 +                       regmap_update_bits(i2s->regmap, I2S_REG_CFG0,
 415 +                                       I2S_REG_CFG0_DATA_24, 0);
 416 +               break;
 417 +       case 24:
 418 +               if (i2s->flags & RALINK_FLAGS_24BIT) {
 419 +                       regmap_update_bits(i2s->regmap, I2S_REG_CFG0,
 420 +                                       I2S_REG_CFG0_DATA_24,
 421 +                                       I2S_REG_CFG0_DATA_24);
 422 +                       break;
 423 +               }
 424 +               return -EINVAL;
 425 +       default:
 426 +               return -EINVAL;
 427 +       }
 428 +
 429 +       switch (params_channels(params)) {
 430 +       case 2:
 431 +               break;
 432 +       default:
 433 +               return -EINVAL;
 434 +       }
 435 +
 436 +       if (i2s->flags & RALINK_FLAGS_ENDIAN) {
 437 +               /* system endian */
 438 +#ifdef SNDRV_LITTLE_ENDIAN
 439 +               regmap_update_bits(i2s->regmap, I2S_REG_CFG0,
 440 +                               I2S_REG_CFG0_SYS_BE, 0);
 441 +#else
 442 +               regmap_update_bits(i2s->regmap, I2S_REG_CFG0,
 443 +                               I2S_REG_CFG0_SYS_BE,
 444 +                               I2S_REG_CFG0_SYS_BE);
 445 +#endif
 446 +
 447 +               /* data endian */
 448 +               switch (params_format(params)) {
 449 +               case SNDRV_PCM_FORMAT_S16_LE:
 450 +               case SNDRV_PCM_FORMAT_S24_LE:
 451 +                       regmap_update_bits(i2s->regmap, I2S_REG_CFG0,
 452 +                                       I2S_REG_CFG0_FMT_LE,
 453 +                                       I2S_REG_CFG0_FMT_LE);
 454 +                       break;
 455 +               case SNDRV_PCM_FORMAT_S16_BE:
 456 +               case SNDRV_PCM_FORMAT_S24_BE:
 457 +                       regmap_update_bits(i2s->regmap, I2S_REG_CFG0,
 458 +                                       I2S_REG_CFG0_FMT_LE, 0);
 459 +                       break;
 460 +               default:
 461 +                       return -EINVAL;
 462 +               }
 463 +       }
 464 +
 465 +       /* setup bclk rate */
 466 +       if (i2s->flags & RALINK_FLAGS_TXONLY)
 467 +               ret = ralink_i2s_set_sys_bclk(dai, width, params_rate(params));
 468 +       else
 469 +               ret = ralink_i2s_set_bclk(dai, width, params_rate(params));
 470 +
 471 +       return ret;
 472 +}
 473 +
 474 +static int ralink_i2s_trigger(struct snd_pcm_substream *substream, int cmd,
 475 +               struct snd_soc_dai *dai)
 476 +{
 477 +       struct ralink_i2s *i2s = snd_soc_dai_get_drvdata(dai);
 478 +       unsigned int mask, val;
 479 +
 480 +       if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
 481 +               mask = I2S_REG_CFG0_TX_EN;
 482 +       else
 483 +               mask = I2S_REG_CFG0_RX_EN;
 484 +
 485 +       switch (cmd) {
 486 +       case SNDRV_PCM_TRIGGER_START:
 487 +       case SNDRV_PCM_TRIGGER_RESUME:
 488 +       case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
 489 +               val = mask;
 490 +               break;
 491 +       case SNDRV_PCM_TRIGGER_STOP:
 492 +       case SNDRV_PCM_TRIGGER_SUSPEND:
 493 +       case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
 494 +               val = 0;
 495 +               break;
 496 +       default:
 497 +               return -EINVAL;
 498 +       }
 499 +
 500 +       regmap_update_bits(i2s->regmap, I2S_REG_CFG0, mask, val);
 501 +
 502 +       return 0;
 503 +}
 504 +
 505 +static void ralink_i2s_init_dma_data(struct ralink_i2s *i2s,
 506 +               struct resource *res)
 507 +{
 508 +       struct snd_dmaengine_dai_dma_data *dma_data;
 509 +
 510 +       /* Playback */
 511 +       dma_data = &i2s->playback_dma_data;
 512 +       dma_data->addr = res->start + I2S_REG_WREG;
 513 +       dma_data->addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES;
 514 +       dma_data->maxburst = 1;
 515 +       dma_data->slave_id = i2s->txdma_req;
 516 +
 517 +       if (i2s->flags & RALINK_FLAGS_TXONLY)
 518 +               return;
 519 +
 520 +       /* Capture */
 521 +       dma_data = &i2s->capture_dma_data;
 522 +       dma_data->addr = res->start + I2S_REG_RREG;
 523 +       dma_data->addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES;
 524 +       dma_data->maxburst = 1;
 525 +       dma_data->slave_id = i2s->rxdma_req;
 526 +}
 527 +
 528 +static int ralink_i2s_dai_probe(struct snd_soc_dai *dai)
 529 +{
 530 +       struct ralink_i2s *i2s = snd_soc_dai_get_drvdata(dai);
 531 +
 532 +       snd_soc_dai_init_dma_data(dai, &i2s->playback_dma_data,
 533 +                       &i2s->capture_dma_data);
 534 +
 535 +       return 0;
 536 +}
 537 +
 538 +static int ralink_i2s_dai_remove(struct snd_soc_dai *dai)
 539 +{
 540 +       return 0;
 541 +}
 542 +
 543 +static const struct snd_soc_dai_ops ralink_i2s_dai_ops = {
 544 +       .set_sysclk = ralink_i2s_set_sysclk,
 545 +       .set_fmt = ralink_i2s_set_fmt,
 546 +       .startup = ralink_i2s_startup,
 547 +       .shutdown = ralink_i2s_shutdown,
 548 +       .hw_params = ralink_i2s_hw_params,
 549 +       .trigger = ralink_i2s_trigger,
 550 +};
 551 +
 552 +static struct snd_soc_dai_driver ralink_i2s_dai = {
 553 +       .name = DRV_NAME,
 554 +       .probe = ralink_i2s_dai_probe,
 555 +       .remove = ralink_i2s_dai_remove,
 556 +       .ops = &ralink_i2s_dai_ops,
 557 +       .capture = {
 558 +               .stream_name = "I2S Capture",
 559 +               .channels_min = 2,
 560 +               .channels_max = 2,
 561 +               .rate_min = 5512,
 562 +               .rate_max = 192000,
 563 +               .rates = SNDRV_PCM_RATE_CONTINUOUS,
 564 +               .formats = SNDRV_PCM_FMTBIT_S16_LE,
 565 +       },
 566 +       .playback = {
 567 +               .stream_name = "I2S Playback",
 568 +               .channels_min = 2,
 569 +               .channels_max = 2,
 570 +               .rate_min = 5512,
 571 +               .rate_max = 192000,
 572 +               .rates = SNDRV_PCM_RATE_CONTINUOUS,
 573 +               .formats = SNDRV_PCM_FMTBIT_S16_LE,
 574 +       },
 575 +       .symmetric_rate = 1,
 576 +};
 577 +
 578 +static struct snd_pcm_hardware ralink_pcm_hardware = {
 579 +       .info = SNDRV_PCM_INFO_MMAP |
 580 +               SNDRV_PCM_INFO_MMAP_VALID |
 581 +               SNDRV_PCM_INFO_INTERLEAVED |
 582 +               SNDRV_PCM_INFO_BLOCK_TRANSFER,
 583 +       .formats = SNDRV_PCM_FMTBIT_S16_LE,
 584 +       .channels_min           = 2,
 585 +       .channels_max           = 2,
 586 +       .period_bytes_min       = PAGE_SIZE,
 587 +       .period_bytes_max       = PAGE_SIZE * 2,
 588 +       .periods_min            = 2,
 589 +       .periods_max            = 128,
 590 +       .buffer_bytes_max       = 128 * 1024,
 591 +       .fifo_size              = RALINK_I2S_FIFO_SIZE,
 592 +};
 593 +
 594 +static const struct snd_dmaengine_pcm_config ralink_dmaengine_pcm_config = {
 595 +       .prepare_slave_config = snd_dmaengine_pcm_prepare_slave_config,
 596 +       .pcm_hardware = &ralink_pcm_hardware,
 597 +       .prealloc_buffer_size = 256 * PAGE_SIZE,
 598 +};
 599 +
 600 +static const struct snd_soc_component_driver ralink_i2s_component = {
 601 +       .name = DRV_NAME,
 602 +};
 603 +
 604 +static bool ralink_i2s_readable_reg(struct device *dev, unsigned int reg)
 605 +{
 606 +       return true;
 607 +}
 608 +
 609 +static bool ralink_i2s_volatile_reg(struct device *dev, unsigned int reg)
 610 +{
 611 +       switch (reg) {
 612 +       case I2S_REG_INT_STATUS:
 613 +       case I2S_REG_FF_STATUS:
 614 +               return true;
 615 +       }
 616 +       return false;
 617 +}
 618 +
 619 +static bool ralink_i2s_writeable_reg(struct device *dev, unsigned int reg)
 620 +{
 621 +       switch (reg) {
 622 +       case I2S_REG_FF_STATUS:
 623 +       case I2S_REG_RREG:
 624 +               return false;
 625 +       }
 626 +       return true;
 627 +}
 628 +
 629 +static const struct regmap_config ralink_i2s_regmap_config = {
 630 +       .reg_bits = 32,
 631 +       .reg_stride = 4,
 632 +       .val_bits = 32,
 633 +       .writeable_reg = ralink_i2s_writeable_reg,
 634 +       .readable_reg = ralink_i2s_readable_reg,
 635 +       .volatile_reg = ralink_i2s_volatile_reg,
 636 +       .max_register = I2S_REG_DIVINT,
 637 +};
 638 +
 639 +#if (RALINK_I2S_INT_EN)
 640 +static irqreturn_t ralink_i2s_irq(int irq, void *devid)
 641 +{
 642 +       struct ralink_i2s *i2s = devid;
 643 +       u32 status;
 644 +
 645 +       regmap_read(i2s->regmap, I2S_REG_INT_STATUS, &status);
 646 +       if (unlikely(!status))
 647 +               return IRQ_NONE;
 648 +
 649 +       /* tx stats */
 650 +       if (status & I2S_REG_INT_TX_MASK) {
 651 +               if (status & I2S_REG_INT_TX_THRES)
 652 +                       i2s->txstats.belowthres++;
 653 +               if (status & I2S_REG_INT_TX_UNRUN)
 654 +                       i2s->txstats.underrun++;
 655 +               if (status & I2S_REG_INT_TX_OVRUN)
 656 +                       i2s->txstats.overrun++;
 657 +               if (status & I2S_REG_INT_TX_FAULT)
 658 +                       i2s->txstats.dmafault++;
 659 +       }
 660 +
 661 +       /* rx stats */
 662 +       if (status & I2S_REG_INT_RX_MASK) {
 663 +               if (status & I2S_REG_INT_RX_THRES)
 664 +                       i2s->rxstats.belowthres++;
 665 +               if (status & I2S_REG_INT_RX_UNRUN)
 666 +                       i2s->rxstats.underrun++;
 667 +               if (status & I2S_REG_INT_RX_OVRUN)
 668 +                       i2s->rxstats.overrun++;
 669 +               if (status & I2S_REG_INT_RX_FAULT)
 670 +                       i2s->rxstats.dmafault++;
 671 +       }
 672 +
 673 +       /* clean status bits */
 674 +       regmap_write(i2s->regmap, I2S_REG_INT_STATUS, status);
 675 +
 676 +       return IRQ_HANDLED;
 677 +}
 678 +#endif
 679 +
 680 +#if IS_ENABLED(CONFIG_DEBUG_FS)
 681 +static int ralink_i2s_stats_show(struct seq_file *s, void *unused)
 682 +{
 683 +        struct ralink_i2s *i2s = s->private;
 684 +
 685 +       seq_printf(s, "tx stats\n");
 686 +       seq_printf(s, "\tbelow threshold\t%u\n", i2s->txstats.belowthres);
 687 +       seq_printf(s, "\tunder run\t%u\n", i2s->txstats.underrun);
 688 +       seq_printf(s, "\tover run\t%u\n", i2s->txstats.overrun);
 689 +       seq_printf(s, "\tdma fault\t%u\n", i2s->txstats.dmafault);
 690 +
 691 +       seq_printf(s, "rx stats\n");
 692 +       seq_printf(s, "\tbelow threshold\t%u\n", i2s->rxstats.belowthres);
 693 +       seq_printf(s, "\tunder run\t%u\n", i2s->rxstats.underrun);
 694 +       seq_printf(s, "\tover run\t%u\n", i2s->rxstats.overrun);
 695 +       seq_printf(s, "\tdma fault\t%u\n", i2s->rxstats.dmafault);
 696 +
 697 +       ralink_i2s_dump_regs(i2s);
 698 +
 699 +       return 0;
 700 +}
 701 +
 702 +static int ralink_i2s_stats_open(struct inode *inode, struct file *file)
 703 +{
 704 +        return single_open(file, ralink_i2s_stats_show, inode->i_private);
 705 +}
 706 +
 707 +static const struct file_operations ralink_i2s_stats_ops = {
 708 +        .open = ralink_i2s_stats_open,
 709 +        .read = seq_read,
 710 +        .llseek = seq_lseek,
 711 +        .release = single_release,
 712 +};
 713 +
 714 +static inline int ralink_i2s_debugfs_create(struct ralink_i2s *i2s)
 715 +{
 716 +        i2s->dbg_dir = debugfs_create_dir(dev_name(i2s->dev), NULL);
 717 +        if (!i2s->dbg_dir)
 718 +                return -ENOMEM;
 719 +
 720 +        i2s->dbg_stats = debugfs_create_file("stats", S_IRUGO,
 721 +                        i2s->dbg_dir, i2s, &ralink_i2s_stats_ops);
 722 +        if (!i2s->dbg_stats) {
 723 +                debugfs_remove(i2s->dbg_dir);
 724 +                return -ENOMEM;
 725 +        }
 726 +
 727 +        return 0;
 728 +}
 729 +
 730 +static inline void ralink_i2s_debugfs_remove(struct ralink_i2s *i2s)
 731 +{
 732 +       debugfs_remove(i2s->dbg_stats);
 733 +       debugfs_remove(i2s->dbg_dir);
 734 +}
 735 +#else
 736 +static inline int ralink_i2s_debugfs_create(struct ralink_i2s *i2s)
 737 +{
 738 +       return 0;
 739 +}
 740 +
 741 +static inline void ralink_i2s_debugfs_remove(struct ralink_i2s *i2s)
 742 +{
 743 +}
 744 +#endif
 745 +
 746 +/*
 747 + * TODO: these refclk setup functions should use
 748 + * clock framework instead. hardcode it now.
 749 + */
 750 +static void rt3350_refclk_setup(void)
 751 +{
 752 +       uint32_t data;
 753 +
 754 +       /* set refclk output 12Mhz clock */
 755 +       data = rt_sysc_r32(0x2c);
 756 +       data |= (0x1 << 8);
 757 +       rt_sysc_w32(data, 0x2c);
 758 +}
 759 +
 760 +static void rt3883_refclk_setup(void)
 761 +{
 762 +       uint32_t data;
 763 +
 764 +       /* set refclk output 12Mhz clock */
 765 +       data = rt_sysc_r32(0x2c);
 766 +       data &= ~(0x3 << 13);
 767 +       data |= (0x1 << 13);
 768 +       rt_sysc_w32(data, 0x2c);
 769 +}
 770 +
 771 +static void rt3552_refclk_setup(void)
 772 +{
 773 +       uint32_t data;
 774 +
 775 +       /* set refclk output 12Mhz clock */
 776 +       data = rt_sysc_r32(0x2c);
 777 +       data &= ~(0xf << 8);
 778 +       data |= (0x3 << 8);
 779 +       rt_sysc_w32(data, 0x2c);
 780 +}
 781 +
 782 +static void mt7620_refclk_setup(void)
 783 +{
 784 +       uint32_t data;
 785 +
 786 +       /* set refclk output 12Mhz clock */
 787 +       data = rt_sysc_r32(0x2c);
 788 +       data &= ~(0x7 << 9);
 789 +       data |= 0x1 << 9;
 790 +       rt_sysc_w32(data, 0x2c);
 791 +}
 792 +
 793 +static void mt7621_refclk_setup(void)
 794 +{
 795 +       uint32_t data;
 796 +
 797 +       /* set refclk output 12Mhz clock */
 798 +       data = rt_sysc_r32(0x2c);
 799 +       data &= ~(0x1f << 18);
 800 +       data |= (0x19 << 18);
 801 +       data &= ~(0x1f << 12);
 802 +       data |= (0x1 << 12);
 803 +       data &= ~(0x7 << 9);
 804 +       data |= (0x5 << 9);
 805 +       rt_sysc_w32(data, 0x2c);
 806 +}
 807 +
 808 +static void mt7628_refclk_setup(void)
 809 +{
 810 +       uint32_t data;
 811 +
 812 +       /* set i2s and refclk digital pad */
 813 +       data = rt_sysc_r32(0x3c);
 814 +       data |= 0x1f;
 815 +       rt_sysc_w32(data, 0x3c);
 816 +
 817 +       /* Adjust REFCLK0's driving strength */
 818 +       data = rt_sysc_r32(0x1354);
 819 +       data &= ~(0x1 << 5);
 820 +       rt_sysc_w32(data, 0x1354);
 821 +       data = rt_sysc_r32(0x1364);
 822 +       data |= ~(0x1 << 5);
 823 +       rt_sysc_w32(data, 0x1364);
 824 +
 825 +       /* set refclk output 12Mhz clock */
 826 +       data = rt_sysc_r32(0x2c);
 827 +       data &= ~(0x7 << 9);
 828 +       data |= 0x1 << 9;
 829 +       rt_sysc_w32(data, 0x2c);
 830 +}
 831 +
 832 +struct rt_i2s_data {
 833 +       u32 flags;
 834 +       void (*refclk_setup)(void);
 835 +};
 836 +
 837 +struct rt_i2s_data rt3050_i2s_data = { .flags = RALINK_FLAGS_TXONLY };
 838 +struct rt_i2s_data rt3350_i2s_data = { .flags = RALINK_FLAGS_TXONLY,
 839 +       .refclk_setup = rt3350_refclk_setup };
 840 +struct rt_i2s_data rt3883_i2s_data = {
 841 +       .flags = (RALINK_FLAGS_LEFT_J | RALINK_FLAGS_RIGHT_J),
 842 +       .refclk_setup = rt3883_refclk_setup };
 843 +struct rt_i2s_data rt3352_i2s_data = { .refclk_setup = rt3552_refclk_setup};
 844 +struct rt_i2s_data mt7620_i2s_data = { .refclk_setup = mt7620_refclk_setup};
 845 +struct rt_i2s_data mt7621_i2s_data = { .refclk_setup = mt7621_refclk_setup};
 846 +struct rt_i2s_data mt7628_i2s_data = {
 847 +       .flags = (RALINK_FLAGS_ENDIAN | RALINK_FLAGS_24BIT |
 848 +                       RALINK_FLAGS_LEFT_J),
 849 +       .refclk_setup = mt7628_refclk_setup};
 850 +
 851 +static const struct of_device_id ralink_i2s_match_table[] = {
 852 +       { .compatible = "ralink,rt3050-i2s",
 853 +               .data = (void *)&rt3050_i2s_data },
 854 +       { .compatible = "ralink,rt3350-i2s",
 855 +               .data = (void *)&rt3350_i2s_data },
 856 +       { .compatible = "ralink,rt3883-i2s",
 857 +               .data = (void *)&rt3883_i2s_data },
 858 +       { .compatible = "ralink,rt3352-i2s",
 859 +               .data = (void *)&rt3352_i2s_data },
 860 +       { .compatible = "mediatek,mt7620-i2s",
 861 +               .data = (void *)&mt7620_i2s_data },
 862 +       { .compatible = "mediatek,mt7621-i2s",
 863 +               .data = (void *)&mt7621_i2s_data },
 864 +       { .compatible = "mediatek,mt7628-i2s",
 865 +               .data = (void *)&mt7628_i2s_data },
 866 +       {},
 867 +};
 868 +MODULE_DEVICE_TABLE(of, ralink_i2s_match_table);
 869 +
 870 +static int ralink_i2s_probe(struct platform_device *pdev)
 871 +{
 872 +       const struct of_device_id *match;
 873 +       struct device_node *np = pdev->dev.of_node;
 874 +       struct ralink_i2s *i2s;
 875 +       struct resource *res;
 876 +       int irq, ret;
 877 +       u32 dma_req;
 878 +       struct rt_i2s_data *data;
 879 +
 880 +       i2s = devm_kzalloc(&pdev->dev, sizeof(*i2s), GFP_KERNEL);
 881 +       if (!i2s)
 882 +               return -ENOMEM;
 883 +
 884 +       platform_set_drvdata(pdev, i2s);
 885 +       i2s->dev = &pdev->dev;
 886 +
 887 +       match = of_match_device(ralink_i2s_match_table, &pdev->dev);
 888 +       if (!match)
 889 +               return -EINVAL;
 890 +       data = (struct rt_i2s_data *)match->data;
 891 +       i2s->flags = data->flags;
 892 +       /* setup out 12Mhz refclk to codec as mclk */
 893 +       if (data->refclk_setup)
 894 +               data->refclk_setup();
 895 +
 896 +       if (of_property_read_u32(np, "txdma-req", &dma_req)) {
 897 +               dev_err(&pdev->dev, "no txdma-req define\n");
 898 +               return -EINVAL;
 899 +       }
 900 +       i2s->txdma_req = (u16)dma_req;
 901 +       if (!(i2s->flags & RALINK_FLAGS_TXONLY)) {
 902 +               if (of_property_read_u32(np, "rxdma-req", &dma_req)) {
 903 +                       dev_err(&pdev->dev, "no rxdma-req define\n");
 904 +                       return -EINVAL;
 905 +               }
 906 +               i2s->rxdma_req = (u16)dma_req;
 907 +       }
 908 +
 909 +       res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 910 +       i2s->regs = devm_ioremap_resource(&pdev->dev, res);
 911 +       if (IS_ERR(i2s->regs))
 912 +               return PTR_ERR(i2s->regs);
 913 +
 914 +       i2s->regmap = devm_regmap_init_mmio(&pdev->dev, i2s->regs,
 915 +                       &ralink_i2s_regmap_config);
 916 +       if (IS_ERR(i2s->regmap)) {
 917 +               dev_err(&pdev->dev, "regmap init failed\n");
 918 +               return PTR_ERR(i2s->regmap);
 919 +       }
 920 +
 921 +        irq = platform_get_irq(pdev, 0);
 922 +        if (irq < 0) {
 923 +                dev_err(&pdev->dev, "failed to get irq\n");
 924 +                return -EINVAL;
 925 +        }
 926 +
 927 +#if (RALINK_I2S_INT_EN)
 928 +       ret = devm_request_irq(&pdev->dev, irq, ralink_i2s_irq,
 929 +                       0, dev_name(&pdev->dev), i2s);
 930 +       if (ret) {
 931 +               dev_err(&pdev->dev, "failed to request irq\n");
 932 +               return ret;
 933 +       }
 934 +#endif
 935 +
 936 +       i2s->clk = devm_clk_get(&pdev->dev, NULL);
 937 +       if (IS_ERR(i2s->clk)) {
 938 +               dev_err(&pdev->dev, "no clock defined\n");
 939 +               return PTR_ERR(i2s->clk);
 940 +       }
 941 +
 942 +       ret = clk_prepare_enable(i2s->clk);
 943 +       if (ret)
 944 +               return ret;
 945 +
 946 +       ralink_i2s_init_dma_data(i2s, res);
 947 +
 948 +       ret = device_reset(&pdev->dev);
 949 +       if (ret) {
 950 +               dev_err(&pdev->dev, "failed to reset device\n");
 951 +               goto err_clk_disable;
 952 +       }
 953 +
 954 +       ret = ralink_i2s_debugfs_create(i2s);
 955 +       if (ret) {
 956 +               dev_err(&pdev->dev, "create debugfs failed\n");
 957 +               goto err_clk_disable;
 958 +       }
 959 +
 960 +       /* enable 24bits support */
 961 +       if (i2s->flags & RALINK_FLAGS_24BIT) {
 962 +               ralink_i2s_dai.capture.formats |= SNDRV_PCM_FMTBIT_S24_LE;
 963 +               ralink_i2s_dai.playback.formats |= SNDRV_PCM_FMTBIT_S24_LE;
 964 +       }
 965 +
 966 +       /* enable big endian support */
 967 +       if (i2s->flags & RALINK_FLAGS_ENDIAN) {
 968 +               ralink_i2s_dai.capture.formats |= SNDRV_PCM_FMTBIT_S16_BE;
 969 +               ralink_i2s_dai.playback.formats |= SNDRV_PCM_FMTBIT_S16_BE;
 970 +               ralink_pcm_hardware.formats |= SNDRV_PCM_FMTBIT_S16_BE;
 971 +               if (i2s->flags & RALINK_FLAGS_24BIT) {
 972 +                       ralink_i2s_dai.capture.formats |=
 973 +                               SNDRV_PCM_FMTBIT_S24_BE;
 974 +                       ralink_i2s_dai.playback.formats |=
 975 +                               SNDRV_PCM_FMTBIT_S24_BE;
 976 +                       ralink_pcm_hardware.formats |=
 977 +                               SNDRV_PCM_FMTBIT_S24_BE;
 978 +               }
 979 +       }
 980 +
 981 +       /* disable capture support */
 982 +       if (i2s->flags & RALINK_FLAGS_TXONLY)
 983 +               memset(&ralink_i2s_dai.capture, sizeof(ralink_i2s_dai.capture),
 984 +                               0);
 985 +
 986 +       ret = devm_snd_soc_register_component(&pdev->dev, &ralink_i2s_component,
 987 +                       &ralink_i2s_dai, 1);
 988 +       if (ret)
 989 +               goto err_debugfs;
 990 +
 991 +       ret = devm_snd_dmaengine_pcm_register(&pdev->dev,
 992 +                       &ralink_dmaengine_pcm_config,
 993 +                       SND_DMAENGINE_PCM_FLAG_COMPAT);
 994 +       if (ret)
 995 +               goto err_debugfs;
 996 +
 997 +       dev_info(i2s->dev, "mclk %luMHz\n", clk_get_rate(i2s->clk) / 1000000);
 998 +
 999 +       return 0;
1000 +
1001 +err_debugfs:
1002 +       ralink_i2s_debugfs_remove(i2s);
1003 +
1004 +err_clk_disable:
1005 +       clk_disable_unprepare(i2s->clk);
1006 +
1007 +       return ret;
1008 +}
1009 +
1010 +static int ralink_i2s_remove(struct platform_device *pdev)
1011 +{
1012 +       struct ralink_i2s *i2s = platform_get_drvdata(pdev);
1013 +
1014 +       ralink_i2s_debugfs_remove(i2s);
1015 +       clk_disable_unprepare(i2s->clk);
1016 +
1017 +       return 0;
1018 +}
1019 +
1020 +static struct platform_driver ralink_i2s_driver = {
1021 +       .probe = ralink_i2s_probe,
1022 +       .remove = ralink_i2s_remove,
1023 +       .driver = {
1024 +               .name = DRV_NAME,
1025 +               .of_match_table = ralink_i2s_match_table,
1026 +       },
1027 +};
1028 +module_platform_driver(ralink_i2s_driver);
1029 +
1030 +MODULE_AUTHOR("Lars-Peter Clausen, <lars@metafoo.de>");
1031 +MODULE_DESCRIPTION("Ralink/MediaTek I2S driver");
1032 +MODULE_LICENSE("GPL");
1033 +MODULE_ALIAS("platform:" DRV_NAME);