Merge branch 'stable/for-linus-5.11' of git://git.kernel.org/pub/scm/linux/kernel...
[linux-2.6-microblaze.git] / sound / soc / fsl / fsl_esai.c
1 // SPDX-License-Identifier: GPL-2.0
2 //
3 // Freescale ESAI ALSA SoC Digital Audio Interface (DAI) driver
4 //
5 // Copyright (C) 2014 Freescale Semiconductor, Inc.
6
7 #include <linux/clk.h>
8 #include <linux/dmaengine.h>
9 #include <linux/module.h>
10 #include <linux/of_irq.h>
11 #include <linux/of_platform.h>
12 #include <linux/pm_runtime.h>
13 #include <sound/dmaengine_pcm.h>
14 #include <sound/pcm_params.h>
15
16 #include "fsl_esai.h"
17 #include "imx-pcm.h"
18
19 #define FSL_ESAI_FORMATS        (SNDRV_PCM_FMTBIT_S8 | \
20                                 SNDRV_PCM_FMTBIT_S16_LE | \
21                                 SNDRV_PCM_FMTBIT_S20_3LE | \
22                                 SNDRV_PCM_FMTBIT_S24_LE)
23
24 /**
25  * struct fsl_esai_soc_data - soc specific data
26  * @imx: for imx platform
27  * @reset_at_xrun: flags for enable reset operaton
28  */
29 struct fsl_esai_soc_data {
30         bool imx;
31         bool reset_at_xrun;
32 };
33
34 /**
35  * struct fsl_esai - ESAI private data
36  * @dma_params_rx: DMA parameters for receive channel
37  * @dma_params_tx: DMA parameters for transmit channel
38  * @pdev: platform device pointer
39  * @regmap: regmap handler
40  * @coreclk: clock source to access register
41  * @extalclk: esai clock source to derive HCK, SCK and FS
42  * @fsysclk: system clock source to derive HCK, SCK and FS
43  * @spbaclk: SPBA clock (optional, depending on SoC design)
44  * @work: work to handle the reset operation
45  * @soc: soc specific data
46  * @lock: spin lock between hw_reset() and trigger()
47  * @fifo_depth: depth of tx/rx FIFO
48  * @slot_width: width of each DAI slot
49  * @slots: number of slots
50  * @tx_mask: slot mask for TX
51  * @rx_mask: slot mask for RX
52  * @channels: channel num for tx or rx
53  * @hck_rate: clock rate of desired HCKx clock
54  * @sck_rate: clock rate of desired SCKx clock
55  * @hck_dir: the direction of HCKx pads
56  * @sck_div: if using PSR/PM dividers for SCKx clock
57  * @slave_mode: if fully using DAI slave mode
58  * @synchronous: if using tx/rx synchronous mode
59  * @name: driver name
60  */
61 struct fsl_esai {
62         struct snd_dmaengine_dai_dma_data dma_params_rx;
63         struct snd_dmaengine_dai_dma_data dma_params_tx;
64         struct platform_device *pdev;
65         struct regmap *regmap;
66         struct clk *coreclk;
67         struct clk *extalclk;
68         struct clk *fsysclk;
69         struct clk *spbaclk;
70         struct work_struct work;
71         const struct fsl_esai_soc_data *soc;
72         spinlock_t lock; /* Protect hw_reset and trigger */
73         u32 fifo_depth;
74         u32 slot_width;
75         u32 slots;
76         u32 tx_mask;
77         u32 rx_mask;
78         u32 channels[2];
79         u32 hck_rate[2];
80         u32 sck_rate[2];
81         bool hck_dir[2];
82         bool sck_div[2];
83         bool slave_mode;
84         bool synchronous;
85         char name[32];
86 };
87
88 static struct fsl_esai_soc_data fsl_esai_vf610 = {
89         .imx = false,
90         .reset_at_xrun = true,
91 };
92
93 static struct fsl_esai_soc_data fsl_esai_imx35 = {
94         .imx = true,
95         .reset_at_xrun = true,
96 };
97
98 static struct fsl_esai_soc_data fsl_esai_imx6ull = {
99         .imx = true,
100         .reset_at_xrun = false,
101 };
102
103 static irqreturn_t esai_isr(int irq, void *devid)
104 {
105         struct fsl_esai *esai_priv = (struct fsl_esai *)devid;
106         struct platform_device *pdev = esai_priv->pdev;
107         u32 esr;
108         u32 saisr;
109
110         regmap_read(esai_priv->regmap, REG_ESAI_ESR, &esr);
111         regmap_read(esai_priv->regmap, REG_ESAI_SAISR, &saisr);
112
113         if ((saisr & (ESAI_SAISR_TUE | ESAI_SAISR_ROE)) &&
114             esai_priv->soc->reset_at_xrun) {
115                 dev_dbg(&pdev->dev, "reset module for xrun\n");
116                 regmap_update_bits(esai_priv->regmap, REG_ESAI_TCR,
117                                    ESAI_xCR_xEIE_MASK, 0);
118                 regmap_update_bits(esai_priv->regmap, REG_ESAI_RCR,
119                                    ESAI_xCR_xEIE_MASK, 0);
120                 schedule_work(&esai_priv->work);
121         }
122
123         if (esr & ESAI_ESR_TINIT_MASK)
124                 dev_dbg(&pdev->dev, "isr: Transmission Initialized\n");
125
126         if (esr & ESAI_ESR_RFF_MASK)
127                 dev_warn(&pdev->dev, "isr: Receiving overrun\n");
128
129         if (esr & ESAI_ESR_TFE_MASK)
130                 dev_warn(&pdev->dev, "isr: Transmission underrun\n");
131
132         if (esr & ESAI_ESR_TLS_MASK)
133                 dev_dbg(&pdev->dev, "isr: Just transmitted the last slot\n");
134
135         if (esr & ESAI_ESR_TDE_MASK)
136                 dev_dbg(&pdev->dev, "isr: Transmission data exception\n");
137
138         if (esr & ESAI_ESR_TED_MASK)
139                 dev_dbg(&pdev->dev, "isr: Transmitting even slots\n");
140
141         if (esr & ESAI_ESR_TD_MASK)
142                 dev_dbg(&pdev->dev, "isr: Transmitting data\n");
143
144         if (esr & ESAI_ESR_RLS_MASK)
145                 dev_dbg(&pdev->dev, "isr: Just received the last slot\n");
146
147         if (esr & ESAI_ESR_RDE_MASK)
148                 dev_dbg(&pdev->dev, "isr: Receiving data exception\n");
149
150         if (esr & ESAI_ESR_RED_MASK)
151                 dev_dbg(&pdev->dev, "isr: Receiving even slots\n");
152
153         if (esr & ESAI_ESR_RD_MASK)
154                 dev_dbg(&pdev->dev, "isr: Receiving data\n");
155
156         return IRQ_HANDLED;
157 }
158
159 /**
160  * fsl_esai_divisor_cal - This function is used to calculate the
161  * divisors of psr, pm, fp and it is supposed to be called in
162  * set_dai_sysclk() and set_bclk().
163  *
164  * @dai: pointer to DAI
165  * @tx: current setting is for playback or capture
166  * @ratio: desired overall ratio for the paticipating dividers
167  * @usefp: for HCK setting, there is no need to set fp divider
168  * @fp: bypass other dividers by setting fp directly if fp != 0
169  */
170 static int fsl_esai_divisor_cal(struct snd_soc_dai *dai, bool tx, u32 ratio,
171                                 bool usefp, u32 fp)
172 {
173         struct fsl_esai *esai_priv = snd_soc_dai_get_drvdata(dai);
174         u32 psr, pm = 999, maxfp, prod, sub, savesub, i, j;
175
176         maxfp = usefp ? 16 : 1;
177
178         if (usefp && fp)
179                 goto out_fp;
180
181         if (ratio > 2 * 8 * 256 * maxfp || ratio < 2) {
182                 dev_err(dai->dev, "the ratio is out of range (2 ~ %d)\n",
183                                 2 * 8 * 256 * maxfp);
184                 return -EINVAL;
185         } else if (ratio % 2) {
186                 dev_err(dai->dev, "the raio must be even if using upper divider\n");
187                 return -EINVAL;
188         }
189
190         ratio /= 2;
191
192         psr = ratio <= 256 * maxfp ? ESAI_xCCR_xPSR_BYPASS : ESAI_xCCR_xPSR_DIV8;
193
194         /* Do not loop-search if PM (1 ~ 256) alone can serve the ratio */
195         if (ratio <= 256) {
196                 pm = ratio;
197                 fp = 1;
198                 goto out;
199         }
200
201         /* Set the max fluctuation -- 0.1% of the max devisor */
202         savesub = (psr ? 1 : 8)  * 256 * maxfp / 1000;
203
204         /* Find the best value for PM */
205         for (i = 1; i <= 256; i++) {
206                 for (j = 1; j <= maxfp; j++) {
207                         /* PSR (1 or 8) * PM (1 ~ 256) * FP (1 ~ 16) */
208                         prod = (psr ? 1 : 8) * i * j;
209
210                         if (prod == ratio)
211                                 sub = 0;
212                         else if (prod / ratio == 1)
213                                 sub = prod - ratio;
214                         else if (ratio / prod == 1)
215                                 sub = ratio - prod;
216                         else
217                                 continue;
218
219                         /* Calculate the fraction */
220                         sub = sub * 1000 / ratio;
221                         if (sub < savesub) {
222                                 savesub = sub;
223                                 pm = i;
224                                 fp = j;
225                         }
226
227                         /* We are lucky */
228                         if (savesub == 0)
229                                 goto out;
230                 }
231         }
232
233         if (pm == 999) {
234                 dev_err(dai->dev, "failed to calculate proper divisors\n");
235                 return -EINVAL;
236         }
237
238 out:
239         regmap_update_bits(esai_priv->regmap, REG_ESAI_xCCR(tx),
240                            ESAI_xCCR_xPSR_MASK | ESAI_xCCR_xPM_MASK,
241                            psr | ESAI_xCCR_xPM(pm));
242
243 out_fp:
244         /* Bypass fp if not being required */
245         if (maxfp <= 1)
246                 return 0;
247
248         regmap_update_bits(esai_priv->regmap, REG_ESAI_xCCR(tx),
249                            ESAI_xCCR_xFP_MASK, ESAI_xCCR_xFP(fp));
250
251         return 0;
252 }
253
254 /**
255  * fsl_esai_set_dai_sysclk - configure the clock frequency of MCLK (HCKT/HCKR)
256  * @dai: pointer to DAI
257  * @clk_id: The clock source of HCKT/HCKR
258  *        (Input from outside; output from inside, FSYS or EXTAL)
259  * @freq: The required clock rate of HCKT/HCKR
260  * @dir: The clock direction of HCKT/HCKR
261  *
262  * Note: If the direction is input, we do not care about clk_id.
263  */
264 static int fsl_esai_set_dai_sysclk(struct snd_soc_dai *dai, int clk_id,
265                                    unsigned int freq, int dir)
266 {
267         struct fsl_esai *esai_priv = snd_soc_dai_get_drvdata(dai);
268         struct clk *clksrc = esai_priv->extalclk;
269         bool tx = (clk_id <= ESAI_HCKT_EXTAL || esai_priv->synchronous);
270         bool in = dir == SND_SOC_CLOCK_IN;
271         u32 ratio, ecr = 0;
272         unsigned long clk_rate;
273         int ret;
274
275         if (freq == 0) {
276                 dev_err(dai->dev, "%sput freq of HCK%c should not be 0Hz\n",
277                         in ? "in" : "out", tx ? 'T' : 'R');
278                 return -EINVAL;
279         }
280
281         /* Bypass divider settings if the requirement doesn't change */
282         if (freq == esai_priv->hck_rate[tx] && dir == esai_priv->hck_dir[tx])
283                 return 0;
284
285         /* sck_div can be only bypassed if ETO/ERO=0 and SNC_SOC_CLOCK_OUT */
286         esai_priv->sck_div[tx] = true;
287
288         /* Set the direction of HCKT/HCKR pins */
289         regmap_update_bits(esai_priv->regmap, REG_ESAI_xCCR(tx),
290                            ESAI_xCCR_xHCKD, in ? 0 : ESAI_xCCR_xHCKD);
291
292         if (in)
293                 goto out;
294
295         switch (clk_id) {
296         case ESAI_HCKT_FSYS:
297         case ESAI_HCKR_FSYS:
298                 clksrc = esai_priv->fsysclk;
299                 break;
300         case ESAI_HCKT_EXTAL:
301                 ecr |= ESAI_ECR_ETI;
302                 break;
303         case ESAI_HCKR_EXTAL:
304                 ecr |= esai_priv->synchronous ? ESAI_ECR_ETI : ESAI_ECR_ERI;
305                 break;
306         default:
307                 return -EINVAL;
308         }
309
310         if (IS_ERR(clksrc)) {
311                 dev_err(dai->dev, "no assigned %s clock\n",
312                                 clk_id % 2 ? "extal" : "fsys");
313                 return PTR_ERR(clksrc);
314         }
315         clk_rate = clk_get_rate(clksrc);
316
317         ratio = clk_rate / freq;
318         if (ratio * freq > clk_rate)
319                 ret = ratio * freq - clk_rate;
320         else if (ratio * freq < clk_rate)
321                 ret = clk_rate - ratio * freq;
322         else
323                 ret = 0;
324
325         /* Block if clock source can not be divided into the required rate */
326         if (ret != 0 && clk_rate / ret < 1000) {
327                 dev_err(dai->dev, "failed to derive required HCK%c rate\n",
328                                 tx ? 'T' : 'R');
329                 return -EINVAL;
330         }
331
332         /* Only EXTAL source can be output directly without using PSR and PM */
333         if (ratio == 1 && clksrc == esai_priv->extalclk) {
334                 /* Bypass all the dividers if not being needed */
335                 ecr |= tx ? ESAI_ECR_ETO : ESAI_ECR_ERO;
336                 goto out;
337         } else if (ratio < 2) {
338                 /* The ratio should be no less than 2 if using other sources */
339                 dev_err(dai->dev, "failed to derive required HCK%c rate\n",
340                                 tx ? 'T' : 'R');
341                 return -EINVAL;
342         }
343
344         ret = fsl_esai_divisor_cal(dai, tx, ratio, false, 0);
345         if (ret)
346                 return ret;
347
348         esai_priv->sck_div[tx] = false;
349
350 out:
351         esai_priv->hck_dir[tx] = dir;
352         esai_priv->hck_rate[tx] = freq;
353
354         regmap_update_bits(esai_priv->regmap, REG_ESAI_ECR,
355                            tx ? ESAI_ECR_ETI | ESAI_ECR_ETO :
356                            ESAI_ECR_ERI | ESAI_ECR_ERO, ecr);
357
358         return 0;
359 }
360
361 /**
362  * fsl_esai_set_bclk - configure the related dividers according to the bclk rate
363  * @dai: pointer to DAI
364  * @tx: direction boolean
365  * @freq: bclk freq
366  */
367 static int fsl_esai_set_bclk(struct snd_soc_dai *dai, bool tx, u32 freq)
368 {
369         struct fsl_esai *esai_priv = snd_soc_dai_get_drvdata(dai);
370         u32 hck_rate = esai_priv->hck_rate[tx];
371         u32 sub, ratio = hck_rate / freq;
372         int ret;
373
374         /* Don't apply for fully slave mode or unchanged bclk */
375         if (esai_priv->slave_mode || esai_priv->sck_rate[tx] == freq)
376                 return 0;
377
378         if (ratio * freq > hck_rate)
379                 sub = ratio * freq - hck_rate;
380         else if (ratio * freq < hck_rate)
381                 sub = hck_rate - ratio * freq;
382         else
383                 sub = 0;
384
385         /* Block if clock source can not be divided into the required rate */
386         if (sub != 0 && hck_rate / sub < 1000) {
387                 dev_err(dai->dev, "failed to derive required SCK%c rate\n",
388                                 tx ? 'T' : 'R');
389                 return -EINVAL;
390         }
391
392         /* The ratio should be contented by FP alone if bypassing PM and PSR */
393         if (!esai_priv->sck_div[tx] && (ratio > 16 || ratio == 0)) {
394                 dev_err(dai->dev, "the ratio is out of range (1 ~ 16)\n");
395                 return -EINVAL;
396         }
397
398         ret = fsl_esai_divisor_cal(dai, tx, ratio, true,
399                         esai_priv->sck_div[tx] ? 0 : ratio);
400         if (ret)
401                 return ret;
402
403         /* Save current bclk rate */
404         esai_priv->sck_rate[tx] = freq;
405
406         return 0;
407 }
408
409 static int fsl_esai_set_dai_tdm_slot(struct snd_soc_dai *dai, u32 tx_mask,
410                                      u32 rx_mask, int slots, int slot_width)
411 {
412         struct fsl_esai *esai_priv = snd_soc_dai_get_drvdata(dai);
413
414         regmap_update_bits(esai_priv->regmap, REG_ESAI_TCCR,
415                            ESAI_xCCR_xDC_MASK, ESAI_xCCR_xDC(slots));
416
417         regmap_update_bits(esai_priv->regmap, REG_ESAI_RCCR,
418                            ESAI_xCCR_xDC_MASK, ESAI_xCCR_xDC(slots));
419
420         esai_priv->slot_width = slot_width;
421         esai_priv->slots = slots;
422         esai_priv->tx_mask = tx_mask;
423         esai_priv->rx_mask = rx_mask;
424
425         return 0;
426 }
427
428 static int fsl_esai_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt)
429 {
430         struct fsl_esai *esai_priv = snd_soc_dai_get_drvdata(dai);
431         u32 xcr = 0, xccr = 0, mask;
432
433         /* DAI mode */
434         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
435         case SND_SOC_DAIFMT_I2S:
436                 /* Data on rising edge of bclk, frame low, 1clk before data */
437                 xcr |= ESAI_xCR_xFSR;
438                 xccr |= ESAI_xCCR_xFSP | ESAI_xCCR_xCKP | ESAI_xCCR_xHCKP;
439                 break;
440         case SND_SOC_DAIFMT_LEFT_J:
441                 /* Data on rising edge of bclk, frame high */
442                 xccr |= ESAI_xCCR_xCKP | ESAI_xCCR_xHCKP;
443                 break;
444         case SND_SOC_DAIFMT_RIGHT_J:
445                 /* Data on rising edge of bclk, frame high, right aligned */
446                 xccr |= ESAI_xCCR_xCKP | ESAI_xCCR_xHCKP;
447                 xcr  |= ESAI_xCR_xWA;
448                 break;
449         case SND_SOC_DAIFMT_DSP_A:
450                 /* Data on rising edge of bclk, frame high, 1clk before data */
451                 xcr |= ESAI_xCR_xFSL | ESAI_xCR_xFSR;
452                 xccr |= ESAI_xCCR_xCKP | ESAI_xCCR_xHCKP;
453                 break;
454         case SND_SOC_DAIFMT_DSP_B:
455                 /* Data on rising edge of bclk, frame high */
456                 xcr |= ESAI_xCR_xFSL;
457                 xccr |= ESAI_xCCR_xCKP | ESAI_xCCR_xHCKP;
458                 break;
459         default:
460                 return -EINVAL;
461         }
462
463         /* DAI clock inversion */
464         switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
465         case SND_SOC_DAIFMT_NB_NF:
466                 /* Nothing to do for both normal cases */
467                 break;
468         case SND_SOC_DAIFMT_IB_NF:
469                 /* Invert bit clock */
470                 xccr ^= ESAI_xCCR_xCKP | ESAI_xCCR_xHCKP;
471                 break;
472         case SND_SOC_DAIFMT_NB_IF:
473                 /* Invert frame clock */
474                 xccr ^= ESAI_xCCR_xFSP;
475                 break;
476         case SND_SOC_DAIFMT_IB_IF:
477                 /* Invert both clocks */
478                 xccr ^= ESAI_xCCR_xCKP | ESAI_xCCR_xHCKP | ESAI_xCCR_xFSP;
479                 break;
480         default:
481                 return -EINVAL;
482         }
483
484         esai_priv->slave_mode = false;
485
486         /* DAI clock master masks */
487         switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
488         case SND_SOC_DAIFMT_CBM_CFM:
489                 esai_priv->slave_mode = true;
490                 break;
491         case SND_SOC_DAIFMT_CBS_CFM:
492                 xccr |= ESAI_xCCR_xCKD;
493                 break;
494         case SND_SOC_DAIFMT_CBM_CFS:
495                 xccr |= ESAI_xCCR_xFSD;
496                 break;
497         case SND_SOC_DAIFMT_CBS_CFS:
498                 xccr |= ESAI_xCCR_xFSD | ESAI_xCCR_xCKD;
499                 break;
500         default:
501                 return -EINVAL;
502         }
503
504         mask = ESAI_xCR_xFSL | ESAI_xCR_xFSR | ESAI_xCR_xWA;
505         regmap_update_bits(esai_priv->regmap, REG_ESAI_TCR, mask, xcr);
506         regmap_update_bits(esai_priv->regmap, REG_ESAI_RCR, mask, xcr);
507
508         mask = ESAI_xCCR_xCKP | ESAI_xCCR_xHCKP | ESAI_xCCR_xFSP |
509                 ESAI_xCCR_xFSD | ESAI_xCCR_xCKD;
510         regmap_update_bits(esai_priv->regmap, REG_ESAI_TCCR, mask, xccr);
511         regmap_update_bits(esai_priv->regmap, REG_ESAI_RCCR, mask, xccr);
512
513         return 0;
514 }
515
516 static int fsl_esai_startup(struct snd_pcm_substream *substream,
517                             struct snd_soc_dai *dai)
518 {
519         struct fsl_esai *esai_priv = snd_soc_dai_get_drvdata(dai);
520
521         if (!snd_soc_dai_active(dai)) {
522                 /* Set synchronous mode */
523                 regmap_update_bits(esai_priv->regmap, REG_ESAI_SAICR,
524                                    ESAI_SAICR_SYNC, esai_priv->synchronous ?
525                                    ESAI_SAICR_SYNC : 0);
526
527                 /* Set a default slot number -- 2 */
528                 regmap_update_bits(esai_priv->regmap, REG_ESAI_TCCR,
529                                    ESAI_xCCR_xDC_MASK, ESAI_xCCR_xDC(2));
530                 regmap_update_bits(esai_priv->regmap, REG_ESAI_RCCR,
531                                    ESAI_xCCR_xDC_MASK, ESAI_xCCR_xDC(2));
532         }
533
534         return 0;
535
536 }
537
538 static int fsl_esai_hw_params(struct snd_pcm_substream *substream,
539                               struct snd_pcm_hw_params *params,
540                               struct snd_soc_dai *dai)
541 {
542         struct fsl_esai *esai_priv = snd_soc_dai_get_drvdata(dai);
543         bool tx = substream->stream == SNDRV_PCM_STREAM_PLAYBACK;
544         u32 width = params_width(params);
545         u32 channels = params_channels(params);
546         u32 pins = DIV_ROUND_UP(channels, esai_priv->slots);
547         u32 slot_width = width;
548         u32 bclk, mask, val;
549         int ret;
550
551         /* Override slot_width if being specifically set */
552         if (esai_priv->slot_width)
553                 slot_width = esai_priv->slot_width;
554
555         bclk = params_rate(params) * slot_width * esai_priv->slots;
556
557         ret = fsl_esai_set_bclk(dai, esai_priv->synchronous || tx, bclk);
558         if (ret)
559                 return ret;
560
561         mask = ESAI_xCR_xSWS_MASK;
562         val = ESAI_xCR_xSWS(slot_width, width);
563
564         regmap_update_bits(esai_priv->regmap, REG_ESAI_xCR(tx), mask, val);
565         /* Recording in synchronous mode needs to set TCR also */
566         if (!tx && esai_priv->synchronous)
567                 regmap_update_bits(esai_priv->regmap, REG_ESAI_TCR, mask, val);
568
569         /* Use Normal mode to support monaural audio */
570         regmap_update_bits(esai_priv->regmap, REG_ESAI_xCR(tx),
571                            ESAI_xCR_xMOD_MASK, params_channels(params) > 1 ?
572                            ESAI_xCR_xMOD_NETWORK : 0);
573
574         regmap_update_bits(esai_priv->regmap, REG_ESAI_xFCR(tx),
575                            ESAI_xFCR_xFR_MASK, ESAI_xFCR_xFR);
576
577         mask = ESAI_xFCR_xFR_MASK | ESAI_xFCR_xWA_MASK | ESAI_xFCR_xFWM_MASK |
578               (tx ? ESAI_xFCR_TE_MASK | ESAI_xFCR_TIEN : ESAI_xFCR_RE_MASK);
579         val = ESAI_xFCR_xWA(width) | ESAI_xFCR_xFWM(esai_priv->fifo_depth) |
580              (tx ? ESAI_xFCR_TE(pins) | ESAI_xFCR_TIEN : ESAI_xFCR_RE(pins));
581
582         regmap_update_bits(esai_priv->regmap, REG_ESAI_xFCR(tx), mask, val);
583
584         if (tx)
585                 regmap_update_bits(esai_priv->regmap, REG_ESAI_TCR,
586                                 ESAI_xCR_PADC, ESAI_xCR_PADC);
587
588         /* Remove ESAI personal reset by configuring ESAI_PCRC and ESAI_PRRC */
589         regmap_update_bits(esai_priv->regmap, REG_ESAI_PRRC,
590                            ESAI_PRRC_PDC_MASK, ESAI_PRRC_PDC(ESAI_GPIO));
591         regmap_update_bits(esai_priv->regmap, REG_ESAI_PCRC,
592                            ESAI_PCRC_PC_MASK, ESAI_PCRC_PC(ESAI_GPIO));
593         return 0;
594 }
595
596 static int fsl_esai_hw_init(struct fsl_esai *esai_priv)
597 {
598         struct platform_device *pdev = esai_priv->pdev;
599         int ret;
600
601         /* Reset ESAI unit */
602         ret = regmap_update_bits(esai_priv->regmap, REG_ESAI_ECR,
603                                  ESAI_ECR_ESAIEN_MASK | ESAI_ECR_ERST_MASK,
604                                  ESAI_ECR_ESAIEN | ESAI_ECR_ERST);
605         if (ret) {
606                 dev_err(&pdev->dev, "failed to reset ESAI: %d\n", ret);
607                 return ret;
608         }
609
610         /*
611          * We need to enable ESAI so as to access some of its registers.
612          * Otherwise, we would fail to dump regmap from user space.
613          */
614         ret = regmap_update_bits(esai_priv->regmap, REG_ESAI_ECR,
615                                  ESAI_ECR_ESAIEN_MASK | ESAI_ECR_ERST_MASK,
616                                  ESAI_ECR_ESAIEN);
617         if (ret) {
618                 dev_err(&pdev->dev, "failed to enable ESAI: %d\n", ret);
619                 return ret;
620         }
621
622         regmap_update_bits(esai_priv->regmap, REG_ESAI_PRRC,
623                            ESAI_PRRC_PDC_MASK, 0);
624         regmap_update_bits(esai_priv->regmap, REG_ESAI_PCRC,
625                            ESAI_PCRC_PC_MASK, 0);
626
627         return 0;
628 }
629
630 static int fsl_esai_register_restore(struct fsl_esai *esai_priv)
631 {
632         int ret;
633
634         /* FIFO reset for safety */
635         regmap_update_bits(esai_priv->regmap, REG_ESAI_TFCR,
636                            ESAI_xFCR_xFR, ESAI_xFCR_xFR);
637         regmap_update_bits(esai_priv->regmap, REG_ESAI_RFCR,
638                            ESAI_xFCR_xFR, ESAI_xFCR_xFR);
639
640         regcache_mark_dirty(esai_priv->regmap);
641         ret = regcache_sync(esai_priv->regmap);
642         if (ret)
643                 return ret;
644
645         /* FIFO reset done */
646         regmap_update_bits(esai_priv->regmap, REG_ESAI_TFCR, ESAI_xFCR_xFR, 0);
647         regmap_update_bits(esai_priv->regmap, REG_ESAI_RFCR, ESAI_xFCR_xFR, 0);
648
649         return 0;
650 }
651
652 static void fsl_esai_trigger_start(struct fsl_esai *esai_priv, bool tx)
653 {
654         u8 i, channels = esai_priv->channels[tx];
655         u32 pins = DIV_ROUND_UP(channels, esai_priv->slots);
656         u32 mask;
657
658         regmap_update_bits(esai_priv->regmap, REG_ESAI_xFCR(tx),
659                            ESAI_xFCR_xFEN_MASK, ESAI_xFCR_xFEN);
660
661         /* Write initial words reqiured by ESAI as normal procedure */
662         for (i = 0; tx && i < channels; i++)
663                 regmap_write(esai_priv->regmap, REG_ESAI_ETDR, 0x0);
664
665         /*
666          * When set the TE/RE in the end of enablement flow, there
667          * will be channel swap issue for multi data line case.
668          * In order to workaround this issue, we switch the bit
669          * enablement sequence to below sequence
670          * 1) clear the xSMB & xSMA: which is done in probe and
671          *                           stop state.
672          * 2) set TE/RE
673          * 3) set xSMB
674          * 4) set xSMA:  xSMA is the last one in this flow, which
675          *               will trigger esai to start.
676          */
677         regmap_update_bits(esai_priv->regmap, REG_ESAI_xCR(tx),
678                            tx ? ESAI_xCR_TE_MASK : ESAI_xCR_RE_MASK,
679                            tx ? ESAI_xCR_TE(pins) : ESAI_xCR_RE(pins));
680         mask = tx ? esai_priv->tx_mask : esai_priv->rx_mask;
681
682         regmap_update_bits(esai_priv->regmap, REG_ESAI_xSMB(tx),
683                            ESAI_xSMB_xS_MASK, ESAI_xSMB_xS(mask));
684         regmap_update_bits(esai_priv->regmap, REG_ESAI_xSMA(tx),
685                            ESAI_xSMA_xS_MASK, ESAI_xSMA_xS(mask));
686
687         /* Enable Exception interrupt */
688         regmap_update_bits(esai_priv->regmap, REG_ESAI_xCR(tx),
689                            ESAI_xCR_xEIE_MASK, ESAI_xCR_xEIE);
690 }
691
692 static void fsl_esai_trigger_stop(struct fsl_esai *esai_priv, bool tx)
693 {
694         regmap_update_bits(esai_priv->regmap, REG_ESAI_xCR(tx),
695                            ESAI_xCR_xEIE_MASK, 0);
696
697         regmap_update_bits(esai_priv->regmap, REG_ESAI_xCR(tx),
698                            tx ? ESAI_xCR_TE_MASK : ESAI_xCR_RE_MASK, 0);
699         regmap_update_bits(esai_priv->regmap, REG_ESAI_xSMA(tx),
700                            ESAI_xSMA_xS_MASK, 0);
701         regmap_update_bits(esai_priv->regmap, REG_ESAI_xSMB(tx),
702                            ESAI_xSMB_xS_MASK, 0);
703
704         /* Disable and reset FIFO */
705         regmap_update_bits(esai_priv->regmap, REG_ESAI_xFCR(tx),
706                            ESAI_xFCR_xFR | ESAI_xFCR_xFEN, ESAI_xFCR_xFR);
707         regmap_update_bits(esai_priv->regmap, REG_ESAI_xFCR(tx),
708                            ESAI_xFCR_xFR, 0);
709 }
710
711 static void fsl_esai_hw_reset(struct work_struct *work)
712 {
713         struct fsl_esai *esai_priv = container_of(work, struct fsl_esai, work);
714         bool tx = true, rx = false, enabled[2];
715         unsigned long lock_flags;
716         u32 tfcr, rfcr;
717
718         spin_lock_irqsave(&esai_priv->lock, lock_flags);
719         /* Save the registers */
720         regmap_read(esai_priv->regmap, REG_ESAI_TFCR, &tfcr);
721         regmap_read(esai_priv->regmap, REG_ESAI_RFCR, &rfcr);
722         enabled[tx] = tfcr & ESAI_xFCR_xFEN;
723         enabled[rx] = rfcr & ESAI_xFCR_xFEN;
724
725         /* Stop the tx & rx */
726         fsl_esai_trigger_stop(esai_priv, tx);
727         fsl_esai_trigger_stop(esai_priv, rx);
728
729         /* Reset the esai, and ignore return value */
730         fsl_esai_hw_init(esai_priv);
731
732         /* Enforce ESAI personal resets for both TX and RX */
733         regmap_update_bits(esai_priv->regmap, REG_ESAI_TCR,
734                            ESAI_xCR_xPR_MASK, ESAI_xCR_xPR);
735         regmap_update_bits(esai_priv->regmap, REG_ESAI_RCR,
736                            ESAI_xCR_xPR_MASK, ESAI_xCR_xPR);
737
738         /* Restore registers by regcache_sync, and ignore return value */
739         fsl_esai_register_restore(esai_priv);
740
741         /* Remove ESAI personal resets by configuring PCRC and PRRC also */
742         regmap_update_bits(esai_priv->regmap, REG_ESAI_TCR,
743                            ESAI_xCR_xPR_MASK, 0);
744         regmap_update_bits(esai_priv->regmap, REG_ESAI_RCR,
745                            ESAI_xCR_xPR_MASK, 0);
746         regmap_update_bits(esai_priv->regmap, REG_ESAI_PRRC,
747                            ESAI_PRRC_PDC_MASK, ESAI_PRRC_PDC(ESAI_GPIO));
748         regmap_update_bits(esai_priv->regmap, REG_ESAI_PCRC,
749                            ESAI_PCRC_PC_MASK, ESAI_PCRC_PC(ESAI_GPIO));
750
751         /* Restart tx / rx, if they already enabled */
752         if (enabled[tx])
753                 fsl_esai_trigger_start(esai_priv, tx);
754         if (enabled[rx])
755                 fsl_esai_trigger_start(esai_priv, rx);
756
757         spin_unlock_irqrestore(&esai_priv->lock, lock_flags);
758 }
759
760 static int fsl_esai_trigger(struct snd_pcm_substream *substream, int cmd,
761                             struct snd_soc_dai *dai)
762 {
763         struct fsl_esai *esai_priv = snd_soc_dai_get_drvdata(dai);
764         bool tx = substream->stream == SNDRV_PCM_STREAM_PLAYBACK;
765         unsigned long lock_flags;
766
767         esai_priv->channels[tx] = substream->runtime->channels;
768
769         switch (cmd) {
770         case SNDRV_PCM_TRIGGER_START:
771         case SNDRV_PCM_TRIGGER_RESUME:
772         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
773                 spin_lock_irqsave(&esai_priv->lock, lock_flags);
774                 fsl_esai_trigger_start(esai_priv, tx);
775                 spin_unlock_irqrestore(&esai_priv->lock, lock_flags);
776                 break;
777         case SNDRV_PCM_TRIGGER_SUSPEND:
778         case SNDRV_PCM_TRIGGER_STOP:
779         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
780                 spin_lock_irqsave(&esai_priv->lock, lock_flags);
781                 fsl_esai_trigger_stop(esai_priv, tx);
782                 spin_unlock_irqrestore(&esai_priv->lock, lock_flags);
783                 break;
784         default:
785                 return -EINVAL;
786         }
787
788         return 0;
789 }
790
791 static const struct snd_soc_dai_ops fsl_esai_dai_ops = {
792         .startup = fsl_esai_startup,
793         .trigger = fsl_esai_trigger,
794         .hw_params = fsl_esai_hw_params,
795         .set_sysclk = fsl_esai_set_dai_sysclk,
796         .set_fmt = fsl_esai_set_dai_fmt,
797         .set_tdm_slot = fsl_esai_set_dai_tdm_slot,
798 };
799
800 static int fsl_esai_dai_probe(struct snd_soc_dai *dai)
801 {
802         struct fsl_esai *esai_priv = snd_soc_dai_get_drvdata(dai);
803
804         snd_soc_dai_init_dma_data(dai, &esai_priv->dma_params_tx,
805                                   &esai_priv->dma_params_rx);
806
807         return 0;
808 }
809
810 static struct snd_soc_dai_driver fsl_esai_dai = {
811         .probe = fsl_esai_dai_probe,
812         .playback = {
813                 .stream_name = "CPU-Playback",
814                 .channels_min = 1,
815                 .channels_max = 12,
816                 .rates = SNDRV_PCM_RATE_8000_192000,
817                 .formats = FSL_ESAI_FORMATS,
818         },
819         .capture = {
820                 .stream_name = "CPU-Capture",
821                 .channels_min = 1,
822                 .channels_max = 8,
823                 .rates = SNDRV_PCM_RATE_8000_192000,
824                 .formats = FSL_ESAI_FORMATS,
825         },
826         .ops = &fsl_esai_dai_ops,
827 };
828
829 static const struct snd_soc_component_driver fsl_esai_component = {
830         .name           = "fsl-esai",
831 };
832
833 static const struct reg_default fsl_esai_reg_defaults[] = {
834         {REG_ESAI_ETDR,  0x00000000},
835         {REG_ESAI_ECR,   0x00000000},
836         {REG_ESAI_TFCR,  0x00000000},
837         {REG_ESAI_RFCR,  0x00000000},
838         {REG_ESAI_TX0,   0x00000000},
839         {REG_ESAI_TX1,   0x00000000},
840         {REG_ESAI_TX2,   0x00000000},
841         {REG_ESAI_TX3,   0x00000000},
842         {REG_ESAI_TX4,   0x00000000},
843         {REG_ESAI_TX5,   0x00000000},
844         {REG_ESAI_TSR,   0x00000000},
845         {REG_ESAI_SAICR, 0x00000000},
846         {REG_ESAI_TCR,   0x00000000},
847         {REG_ESAI_TCCR,  0x00000000},
848         {REG_ESAI_RCR,   0x00000000},
849         {REG_ESAI_RCCR,  0x00000000},
850         {REG_ESAI_TSMA,  0x0000ffff},
851         {REG_ESAI_TSMB,  0x0000ffff},
852         {REG_ESAI_RSMA,  0x0000ffff},
853         {REG_ESAI_RSMB,  0x0000ffff},
854         {REG_ESAI_PRRC,  0x00000000},
855         {REG_ESAI_PCRC,  0x00000000},
856 };
857
858 static bool fsl_esai_readable_reg(struct device *dev, unsigned int reg)
859 {
860         switch (reg) {
861         case REG_ESAI_ERDR:
862         case REG_ESAI_ECR:
863         case REG_ESAI_ESR:
864         case REG_ESAI_TFCR:
865         case REG_ESAI_TFSR:
866         case REG_ESAI_RFCR:
867         case REG_ESAI_RFSR:
868         case REG_ESAI_RX0:
869         case REG_ESAI_RX1:
870         case REG_ESAI_RX2:
871         case REG_ESAI_RX3:
872         case REG_ESAI_SAISR:
873         case REG_ESAI_SAICR:
874         case REG_ESAI_TCR:
875         case REG_ESAI_TCCR:
876         case REG_ESAI_RCR:
877         case REG_ESAI_RCCR:
878         case REG_ESAI_TSMA:
879         case REG_ESAI_TSMB:
880         case REG_ESAI_RSMA:
881         case REG_ESAI_RSMB:
882         case REG_ESAI_PRRC:
883         case REG_ESAI_PCRC:
884                 return true;
885         default:
886                 return false;
887         }
888 }
889
890 static bool fsl_esai_volatile_reg(struct device *dev, unsigned int reg)
891 {
892         switch (reg) {
893         case REG_ESAI_ERDR:
894         case REG_ESAI_ESR:
895         case REG_ESAI_TFSR:
896         case REG_ESAI_RFSR:
897         case REG_ESAI_RX0:
898         case REG_ESAI_RX1:
899         case REG_ESAI_RX2:
900         case REG_ESAI_RX3:
901         case REG_ESAI_SAISR:
902                 return true;
903         default:
904                 return false;
905         }
906 }
907
908 static bool fsl_esai_writeable_reg(struct device *dev, unsigned int reg)
909 {
910         switch (reg) {
911         case REG_ESAI_ETDR:
912         case REG_ESAI_ECR:
913         case REG_ESAI_TFCR:
914         case REG_ESAI_RFCR:
915         case REG_ESAI_TX0:
916         case REG_ESAI_TX1:
917         case REG_ESAI_TX2:
918         case REG_ESAI_TX3:
919         case REG_ESAI_TX4:
920         case REG_ESAI_TX5:
921         case REG_ESAI_TSR:
922         case REG_ESAI_SAICR:
923         case REG_ESAI_TCR:
924         case REG_ESAI_TCCR:
925         case REG_ESAI_RCR:
926         case REG_ESAI_RCCR:
927         case REG_ESAI_TSMA:
928         case REG_ESAI_TSMB:
929         case REG_ESAI_RSMA:
930         case REG_ESAI_RSMB:
931         case REG_ESAI_PRRC:
932         case REG_ESAI_PCRC:
933                 return true;
934         default:
935                 return false;
936         }
937 }
938
939 static const struct regmap_config fsl_esai_regmap_config = {
940         .reg_bits = 32,
941         .reg_stride = 4,
942         .val_bits = 32,
943
944         .max_register = REG_ESAI_PCRC,
945         .reg_defaults = fsl_esai_reg_defaults,
946         .num_reg_defaults = ARRAY_SIZE(fsl_esai_reg_defaults),
947         .readable_reg = fsl_esai_readable_reg,
948         .volatile_reg = fsl_esai_volatile_reg,
949         .writeable_reg = fsl_esai_writeable_reg,
950         .cache_type = REGCACHE_FLAT,
951 };
952
953 static int fsl_esai_probe(struct platform_device *pdev)
954 {
955         struct device_node *np = pdev->dev.of_node;
956         struct fsl_esai *esai_priv;
957         struct resource *res;
958         const __be32 *iprop;
959         void __iomem *regs;
960         int irq, ret;
961
962         esai_priv = devm_kzalloc(&pdev->dev, sizeof(*esai_priv), GFP_KERNEL);
963         if (!esai_priv)
964                 return -ENOMEM;
965
966         esai_priv->pdev = pdev;
967         snprintf(esai_priv->name, sizeof(esai_priv->name), "%pOFn", np);
968
969         esai_priv->soc = of_device_get_match_data(&pdev->dev);
970         if (!esai_priv->soc) {
971                 dev_err(&pdev->dev, "failed to get soc data\n");
972                 return -ENODEV;
973         }
974
975         /* Get the addresses and IRQ */
976         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
977         regs = devm_ioremap_resource(&pdev->dev, res);
978         if (IS_ERR(regs))
979                 return PTR_ERR(regs);
980
981         esai_priv->regmap = devm_regmap_init_mmio_clk(&pdev->dev,
982                         "core", regs, &fsl_esai_regmap_config);
983         if (IS_ERR(esai_priv->regmap)) {
984                 dev_err(&pdev->dev, "failed to init regmap: %ld\n",
985                                 PTR_ERR(esai_priv->regmap));
986                 return PTR_ERR(esai_priv->regmap);
987         }
988
989         esai_priv->coreclk = devm_clk_get(&pdev->dev, "core");
990         if (IS_ERR(esai_priv->coreclk)) {
991                 dev_err(&pdev->dev, "failed to get core clock: %ld\n",
992                                 PTR_ERR(esai_priv->coreclk));
993                 return PTR_ERR(esai_priv->coreclk);
994         }
995
996         esai_priv->extalclk = devm_clk_get(&pdev->dev, "extal");
997         if (IS_ERR(esai_priv->extalclk))
998                 dev_warn(&pdev->dev, "failed to get extal clock: %ld\n",
999                                 PTR_ERR(esai_priv->extalclk));
1000
1001         esai_priv->fsysclk = devm_clk_get(&pdev->dev, "fsys");
1002         if (IS_ERR(esai_priv->fsysclk))
1003                 dev_warn(&pdev->dev, "failed to get fsys clock: %ld\n",
1004                                 PTR_ERR(esai_priv->fsysclk));
1005
1006         esai_priv->spbaclk = devm_clk_get(&pdev->dev, "spba");
1007         if (IS_ERR(esai_priv->spbaclk))
1008                 dev_warn(&pdev->dev, "failed to get spba clock: %ld\n",
1009                                 PTR_ERR(esai_priv->spbaclk));
1010
1011         irq = platform_get_irq(pdev, 0);
1012         if (irq < 0)
1013                 return irq;
1014
1015         ret = devm_request_irq(&pdev->dev, irq, esai_isr, IRQF_SHARED,
1016                                esai_priv->name, esai_priv);
1017         if (ret) {
1018                 dev_err(&pdev->dev, "failed to claim irq %u\n", irq);
1019                 return ret;
1020         }
1021
1022         /* Set a default slot number */
1023         esai_priv->slots = 2;
1024
1025         /* Set a default master/slave state */
1026         esai_priv->slave_mode = true;
1027
1028         /* Determine the FIFO depth */
1029         iprop = of_get_property(np, "fsl,fifo-depth", NULL);
1030         if (iprop)
1031                 esai_priv->fifo_depth = be32_to_cpup(iprop);
1032         else
1033                 esai_priv->fifo_depth = 64;
1034
1035         esai_priv->dma_params_tx.maxburst = 16;
1036         esai_priv->dma_params_rx.maxburst = 16;
1037         esai_priv->dma_params_tx.addr = res->start + REG_ESAI_ETDR;
1038         esai_priv->dma_params_rx.addr = res->start + REG_ESAI_ERDR;
1039
1040         esai_priv->synchronous =
1041                 of_property_read_bool(np, "fsl,esai-synchronous");
1042
1043         /* Implement full symmetry for synchronous mode */
1044         if (esai_priv->synchronous) {
1045                 fsl_esai_dai.symmetric_rates = 1;
1046                 fsl_esai_dai.symmetric_channels = 1;
1047                 fsl_esai_dai.symmetric_samplebits = 1;
1048         }
1049
1050         dev_set_drvdata(&pdev->dev, esai_priv);
1051
1052         spin_lock_init(&esai_priv->lock);
1053         ret = fsl_esai_hw_init(esai_priv);
1054         if (ret)
1055                 return ret;
1056
1057         esai_priv->tx_mask = 0xFFFFFFFF;
1058         esai_priv->rx_mask = 0xFFFFFFFF;
1059
1060         /* Clear the TSMA, TSMB, RSMA, RSMB */
1061         regmap_write(esai_priv->regmap, REG_ESAI_TSMA, 0);
1062         regmap_write(esai_priv->regmap, REG_ESAI_TSMB, 0);
1063         regmap_write(esai_priv->regmap, REG_ESAI_RSMA, 0);
1064         regmap_write(esai_priv->regmap, REG_ESAI_RSMB, 0);
1065
1066         ret = devm_snd_soc_register_component(&pdev->dev, &fsl_esai_component,
1067                                               &fsl_esai_dai, 1);
1068         if (ret) {
1069                 dev_err(&pdev->dev, "failed to register DAI: %d\n", ret);
1070                 return ret;
1071         }
1072
1073         INIT_WORK(&esai_priv->work, fsl_esai_hw_reset);
1074
1075         pm_runtime_enable(&pdev->dev);
1076
1077         regcache_cache_only(esai_priv->regmap, true);
1078
1079         ret = imx_pcm_dma_init(pdev, IMX_ESAI_DMABUF_SIZE);
1080         if (ret)
1081                 dev_err(&pdev->dev, "failed to init imx pcm dma: %d\n", ret);
1082
1083         return ret;
1084 }
1085
1086 static int fsl_esai_remove(struct platform_device *pdev)
1087 {
1088         struct fsl_esai *esai_priv = platform_get_drvdata(pdev);
1089
1090         pm_runtime_disable(&pdev->dev);
1091         cancel_work_sync(&esai_priv->work);
1092
1093         return 0;
1094 }
1095
1096 static const struct of_device_id fsl_esai_dt_ids[] = {
1097         { .compatible = "fsl,imx35-esai", .data = &fsl_esai_imx35 },
1098         { .compatible = "fsl,vf610-esai", .data = &fsl_esai_vf610 },
1099         { .compatible = "fsl,imx6ull-esai", .data = &fsl_esai_imx6ull },
1100         {}
1101 };
1102 MODULE_DEVICE_TABLE(of, fsl_esai_dt_ids);
1103
1104 #ifdef CONFIG_PM
1105 static int fsl_esai_runtime_resume(struct device *dev)
1106 {
1107         struct fsl_esai *esai = dev_get_drvdata(dev);
1108         int ret;
1109
1110         /*
1111          * Some platforms might use the same bit to gate all three or two of
1112          * clocks, so keep all clocks open/close at the same time for safety
1113          */
1114         ret = clk_prepare_enable(esai->coreclk);
1115         if (ret)
1116                 return ret;
1117         if (!IS_ERR(esai->spbaclk)) {
1118                 ret = clk_prepare_enable(esai->spbaclk);
1119                 if (ret)
1120                         goto err_spbaclk;
1121         }
1122         if (!IS_ERR(esai->extalclk)) {
1123                 ret = clk_prepare_enable(esai->extalclk);
1124                 if (ret)
1125                         goto err_extalclk;
1126         }
1127         if (!IS_ERR(esai->fsysclk)) {
1128                 ret = clk_prepare_enable(esai->fsysclk);
1129                 if (ret)
1130                         goto err_fsysclk;
1131         }
1132
1133         regcache_cache_only(esai->regmap, false);
1134
1135         ret = fsl_esai_register_restore(esai);
1136         if (ret)
1137                 goto err_regcache_sync;
1138
1139         return 0;
1140
1141 err_regcache_sync:
1142         if (!IS_ERR(esai->fsysclk))
1143                 clk_disable_unprepare(esai->fsysclk);
1144 err_fsysclk:
1145         if (!IS_ERR(esai->extalclk))
1146                 clk_disable_unprepare(esai->extalclk);
1147 err_extalclk:
1148         if (!IS_ERR(esai->spbaclk))
1149                 clk_disable_unprepare(esai->spbaclk);
1150 err_spbaclk:
1151         clk_disable_unprepare(esai->coreclk);
1152
1153         return ret;
1154 }
1155
1156 static int fsl_esai_runtime_suspend(struct device *dev)
1157 {
1158         struct fsl_esai *esai = dev_get_drvdata(dev);
1159
1160         regcache_cache_only(esai->regmap, true);
1161
1162         if (!IS_ERR(esai->fsysclk))
1163                 clk_disable_unprepare(esai->fsysclk);
1164         if (!IS_ERR(esai->extalclk))
1165                 clk_disable_unprepare(esai->extalclk);
1166         if (!IS_ERR(esai->spbaclk))
1167                 clk_disable_unprepare(esai->spbaclk);
1168         clk_disable_unprepare(esai->coreclk);
1169
1170         return 0;
1171 }
1172 #endif /* CONFIG_PM */
1173
1174 static const struct dev_pm_ops fsl_esai_pm_ops = {
1175         SET_RUNTIME_PM_OPS(fsl_esai_runtime_suspend,
1176                            fsl_esai_runtime_resume,
1177                            NULL)
1178         SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
1179                                 pm_runtime_force_resume)
1180 };
1181
1182 static struct platform_driver fsl_esai_driver = {
1183         .probe = fsl_esai_probe,
1184         .remove = fsl_esai_remove,
1185         .driver = {
1186                 .name = "fsl-esai-dai",
1187                 .pm = &fsl_esai_pm_ops,
1188                 .of_match_table = fsl_esai_dt_ids,
1189         },
1190 };
1191
1192 module_platform_driver(fsl_esai_driver);
1193
1194 MODULE_AUTHOR("Freescale Semiconductor, Inc.");
1195 MODULE_DESCRIPTION("Freescale ESAI CPU DAI driver");
1196 MODULE_LICENSE("GPL v2");
1197 MODULE_ALIAS("platform:fsl-esai-dai");