blob: 14152f6f70ddccaada89a26176c6b9437e814b06 [file] [log] [blame]
Dong Aisheng2a24f2c2011-07-21 12:36:56 +08001/*
2 * Copyright 2011 Freescale Semiconductor, Inc.
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; either version 2 of the License, or
7 * (at your option) any later version.
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
13 *
14 * You should have received a copy of the GNU General Public License along
15 * with this program; if not, write to the Free Software Foundation, Inc.,
16 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
17 */
18
19#include <linux/module.h>
20#include <linux/init.h>
Shawn Guo08641c72012-05-11 22:24:17 +080021#include <linux/of.h>
22#include <linux/of_device.h>
Dong Aisheng2a24f2c2011-07-21 12:36:56 +080023#include <linux/platform_device.h>
24#include <linux/slab.h>
25#include <linux/dma-mapping.h>
26#include <linux/clk.h>
Shawn Guo7c9e6152013-07-01 16:16:10 +080027#include <linux/clk-provider.h>
Dong Aisheng2a24f2c2011-07-21 12:36:56 +080028#include <linux/delay.h>
Dong Aisheng76067542011-09-07 20:51:50 +080029#include <linux/time.h>
Dong Aisheng2a24f2c2011-07-21 12:36:56 +080030#include <sound/core.h>
31#include <sound/pcm.h>
32#include <sound/pcm_params.h>
33#include <sound/soc.h>
Dong Aisheng2a24f2c2011-07-21 12:36:56 +080034
35#include "mxs-saif.h"
36
Shawn Guo114fe752013-03-28 23:21:16 +080037#define MXS_SET_ADDR 0x4
38#define MXS_CLR_ADDR 0x8
39
Dong Aisheng2a24f2c2011-07-21 12:36:56 +080040static struct mxs_saif *mxs_saif[2];
41
Dong Aisheng76067542011-09-07 20:51:50 +080042/*
43 * SAIF is a little different with other normal SOC DAIs on clock using.
44 *
45 * For MXS, two SAIF modules are instantiated on-chip.
46 * Each SAIF has a set of clock pins and can be operating in master
47 * mode simultaneously if they are connected to different off-chip codecs.
48 * Also, one of the two SAIFs can master or drive the clock pins while the
49 * other SAIF, in slave mode, receives clocking from the master SAIF.
50 * This also means that both SAIFs must operate at the same sample rate.
51 *
52 * We abstract this as each saif has a master, the master could be
53 * himself or other saifs. In the generic saif driver, saif does not need
54 * to know the different clkmux. Saif only needs to know who is his master
55 * and operating his master to generate the proper clock rate for him.
56 * The master id is provided in mach-specific layer according to different
57 * clkmux setting.
58 */
59
Dong Aisheng2a24f2c2011-07-21 12:36:56 +080060static int mxs_saif_set_dai_sysclk(struct snd_soc_dai *cpu_dai,
61 int clk_id, unsigned int freq, int dir)
62{
63 struct mxs_saif *saif = snd_soc_dai_get_drvdata(cpu_dai);
64
65 switch (clk_id) {
66 case MXS_SAIF_MCLK:
67 saif->mclk = freq;
68 break;
69 default:
70 return -EINVAL;
71 }
72 return 0;
73}
74
75/*
Dong Aisheng76067542011-09-07 20:51:50 +080076 * Since SAIF may work on EXTMASTER mode, IOW, it's working BITCLK&LRCLK
77 * is provided by other SAIF, we provide a interface here to get its master
78 * from its master_id.
79 * Note that the master could be himself.
80 */
81static inline struct mxs_saif *mxs_saif_get_master(struct mxs_saif * saif)
82{
83 return mxs_saif[saif->master_id];
84}
85
86/*
Dong Aisheng2a24f2c2011-07-21 12:36:56 +080087 * Set SAIF clock and MCLK
88 */
89static int mxs_saif_set_clk(struct mxs_saif *saif,
90 unsigned int mclk,
91 unsigned int rate)
92{
93 u32 scr;
94 int ret;
Dong Aisheng76067542011-09-07 20:51:50 +080095 struct mxs_saif *master_saif;
Dong Aisheng2a24f2c2011-07-21 12:36:56 +080096
Dong Aisheng76067542011-09-07 20:51:50 +080097 dev_dbg(saif->dev, "mclk %d rate %d\n", mclk, rate);
98
99 /* Set master saif to generate proper clock */
100 master_saif = mxs_saif_get_master(saif);
101 if (!master_saif)
102 return -EINVAL;
103
104 dev_dbg(saif->dev, "master saif%d\n", master_saif->id);
105
106 /* Checking if can playback and capture simutaneously */
107 if (master_saif->ongoing && rate != master_saif->cur_rate) {
108 dev_err(saif->dev,
109 "can not change clock, master saif%d(rate %d) is ongoing\n",
110 master_saif->id, master_saif->cur_rate);
111 return -EINVAL;
112 }
113
114 scr = __raw_readl(master_saif->base + SAIF_CTRL);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800115 scr &= ~BM_SAIF_CTRL_BITCLK_MULT_RATE;
116 scr &= ~BM_SAIF_CTRL_BITCLK_BASE_RATE;
117
118 /*
119 * Set SAIF clock
120 *
121 * The SAIF clock should be either 384*fs or 512*fs.
122 * If MCLK is used, the SAIF clk ratio need to match mclk ratio.
123 * For 32x mclk, set saif clk as 512*fs.
124 * For 48x mclk, set saif clk as 384*fs.
125 *
126 * If MCLK is not used, we just set saif clk to 512*fs.
127 */
Fabio Estevam6b35f922012-01-19 10:23:22 -0200128 clk_prepare_enable(master_saif->clk);
129
Dong Aisheng76067542011-09-07 20:51:50 +0800130 if (master_saif->mclk_in_use) {
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800131 if (mclk % 32 == 0) {
132 scr &= ~BM_SAIF_CTRL_BITCLK_BASE_RATE;
Dong Aisheng76067542011-09-07 20:51:50 +0800133 ret = clk_set_rate(master_saif->clk, 512 * rate);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800134 } else if (mclk % 48 == 0) {
135 scr |= BM_SAIF_CTRL_BITCLK_BASE_RATE;
Dong Aisheng76067542011-09-07 20:51:50 +0800136 ret = clk_set_rate(master_saif->clk, 384 * rate);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800137 } else {
138 /* SAIF MCLK should be either 32x or 48x */
Fabio Estevam6b35f922012-01-19 10:23:22 -0200139 clk_disable_unprepare(master_saif->clk);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800140 return -EINVAL;
141 }
142 } else {
Dong Aisheng76067542011-09-07 20:51:50 +0800143 ret = clk_set_rate(master_saif->clk, 512 * rate);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800144 scr &= ~BM_SAIF_CTRL_BITCLK_BASE_RATE;
145 }
146
Fabio Estevam6b35f922012-01-19 10:23:22 -0200147 clk_disable_unprepare(master_saif->clk);
148
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800149 if (ret)
150 return ret;
151
Dong Aisheng76067542011-09-07 20:51:50 +0800152 master_saif->cur_rate = rate;
153
154 if (!master_saif->mclk_in_use) {
155 __raw_writel(scr, master_saif->base + SAIF_CTRL);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800156 return 0;
157 }
158
159 /*
160 * Program the over-sample rate for MCLK output
161 *
162 * The available MCLK range is 32x, 48x... 512x. The rate
163 * could be from 8kHz to 192kH.
164 */
165 switch (mclk / rate) {
166 case 32:
167 scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(4);
168 break;
169 case 64:
170 scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(3);
171 break;
172 case 128:
173 scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(2);
174 break;
175 case 256:
176 scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(1);
177 break;
178 case 512:
179 scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(0);
180 break;
181 case 48:
182 scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(3);
183 break;
184 case 96:
185 scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(2);
186 break;
187 case 192:
188 scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(1);
189 break;
190 case 384:
191 scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(0);
192 break;
193 default:
194 return -EINVAL;
195 }
196
Dong Aisheng76067542011-09-07 20:51:50 +0800197 __raw_writel(scr, master_saif->base + SAIF_CTRL);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800198
199 return 0;
200}
201
202/*
203 * Put and disable MCLK.
204 */
205int mxs_saif_put_mclk(unsigned int saif_id)
206{
207 struct mxs_saif *saif = mxs_saif[saif_id];
208 u32 stat;
209
210 if (!saif)
211 return -EINVAL;
212
213 stat = __raw_readl(saif->base + SAIF_STAT);
214 if (stat & BM_SAIF_STAT_BUSY) {
215 dev_err(saif->dev, "error: busy\n");
216 return -EBUSY;
217 }
218
Shawn Guo67939b22011-12-20 14:15:44 +0800219 clk_disable_unprepare(saif->clk);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800220
221 /* disable MCLK output */
222 __raw_writel(BM_SAIF_CTRL_CLKGATE,
223 saif->base + SAIF_CTRL + MXS_SET_ADDR);
224 __raw_writel(BM_SAIF_CTRL_RUN,
225 saif->base + SAIF_CTRL + MXS_CLR_ADDR);
226
227 saif->mclk_in_use = 0;
228 return 0;
229}
Lothar Waßmanncf7d0f02012-11-22 13:31:09 +0100230EXPORT_SYMBOL_GPL(mxs_saif_put_mclk);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800231
232/*
233 * Get MCLK and set clock rate, then enable it
234 *
235 * This interface is used for codecs who are using MCLK provided
236 * by saif.
237 */
238int mxs_saif_get_mclk(unsigned int saif_id, unsigned int mclk,
239 unsigned int rate)
240{
241 struct mxs_saif *saif = mxs_saif[saif_id];
242 u32 stat;
243 int ret;
Dong Aisheng76067542011-09-07 20:51:50 +0800244 struct mxs_saif *master_saif;
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800245
246 if (!saif)
247 return -EINVAL;
248
Dong Aishengbbe8ff52011-08-21 23:45:40 +0800249 /* Clear Reset */
250 __raw_writel(BM_SAIF_CTRL_SFTRST,
251 saif->base + SAIF_CTRL + MXS_CLR_ADDR);
252
253 /* FIXME: need clear clk gate for register r/w */
254 __raw_writel(BM_SAIF_CTRL_CLKGATE,
255 saif->base + SAIF_CTRL + MXS_CLR_ADDR);
256
Dong Aisheng76067542011-09-07 20:51:50 +0800257 master_saif = mxs_saif_get_master(saif);
258 if (saif != master_saif) {
259 dev_err(saif->dev, "can not get mclk from a non-master saif\n");
260 return -EINVAL;
261 }
262
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800263 stat = __raw_readl(saif->base + SAIF_STAT);
264 if (stat & BM_SAIF_STAT_BUSY) {
265 dev_err(saif->dev, "error: busy\n");
266 return -EBUSY;
267 }
268
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800269 saif->mclk_in_use = 1;
270 ret = mxs_saif_set_clk(saif, mclk, rate);
271 if (ret)
272 return ret;
273
Shawn Guo67939b22011-12-20 14:15:44 +0800274 ret = clk_prepare_enable(saif->clk);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800275 if (ret)
276 return ret;
277
278 /* enable MCLK output */
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800279 __raw_writel(BM_SAIF_CTRL_RUN,
280 saif->base + SAIF_CTRL + MXS_SET_ADDR);
281
282 return 0;
283}
Lothar Waßmanncf7d0f02012-11-22 13:31:09 +0100284EXPORT_SYMBOL_GPL(mxs_saif_get_mclk);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800285
286/*
287 * SAIF DAI format configuration.
288 * Should only be called when port is inactive.
289 */
290static int mxs_saif_set_dai_fmt(struct snd_soc_dai *cpu_dai, unsigned int fmt)
291{
292 u32 scr, stat;
293 u32 scr0;
294 struct mxs_saif *saif = snd_soc_dai_get_drvdata(cpu_dai);
295
296 stat = __raw_readl(saif->base + SAIF_STAT);
297 if (stat & BM_SAIF_STAT_BUSY) {
298 dev_err(cpu_dai->dev, "error: busy\n");
299 return -EBUSY;
300 }
301
302 scr0 = __raw_readl(saif->base + SAIF_CTRL);
303 scr0 = scr0 & ~BM_SAIF_CTRL_BITCLK_EDGE & ~BM_SAIF_CTRL_LRCLK_POLARITY \
304 & ~BM_SAIF_CTRL_JUSTIFY & ~BM_SAIF_CTRL_DELAY;
305 scr = 0;
306
307 /* DAI mode */
308 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
309 case SND_SOC_DAIFMT_I2S:
310 /* data frame low 1clk before data */
311 scr |= BM_SAIF_CTRL_DELAY;
312 scr &= ~BM_SAIF_CTRL_LRCLK_POLARITY;
313 break;
314 case SND_SOC_DAIFMT_LEFT_J:
315 /* data frame high with data */
316 scr &= ~BM_SAIF_CTRL_DELAY;
317 scr &= ~BM_SAIF_CTRL_LRCLK_POLARITY;
318 scr &= ~BM_SAIF_CTRL_JUSTIFY;
319 break;
320 default:
321 return -EINVAL;
322 }
323
324 /* DAI clock inversion */
325 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
326 case SND_SOC_DAIFMT_IB_IF:
327 scr |= BM_SAIF_CTRL_BITCLK_EDGE;
328 scr |= BM_SAIF_CTRL_LRCLK_POLARITY;
329 break;
330 case SND_SOC_DAIFMT_IB_NF:
331 scr |= BM_SAIF_CTRL_BITCLK_EDGE;
332 scr &= ~BM_SAIF_CTRL_LRCLK_POLARITY;
333 break;
334 case SND_SOC_DAIFMT_NB_IF:
335 scr &= ~BM_SAIF_CTRL_BITCLK_EDGE;
336 scr |= BM_SAIF_CTRL_LRCLK_POLARITY;
337 break;
338 case SND_SOC_DAIFMT_NB_NF:
339 scr &= ~BM_SAIF_CTRL_BITCLK_EDGE;
340 scr &= ~BM_SAIF_CTRL_LRCLK_POLARITY;
341 break;
342 }
343
344 /*
345 * Note: We simply just support master mode since SAIF TX can only
346 * work as master.
Dong Aisheng76067542011-09-07 20:51:50 +0800347 * Here the master is relative to codec side.
348 * Saif internally could be slave when working on EXTMASTER mode.
349 * We just hide this to machine driver.
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800350 */
351 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
352 case SND_SOC_DAIFMT_CBS_CFS:
Dong Aisheng76067542011-09-07 20:51:50 +0800353 if (saif->id == saif->master_id)
354 scr &= ~BM_SAIF_CTRL_SLAVE_MODE;
355 else
356 scr |= BM_SAIF_CTRL_SLAVE_MODE;
357
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800358 __raw_writel(scr | scr0, saif->base + SAIF_CTRL);
359 break;
360 default:
361 return -EINVAL;
362 }
363
364 return 0;
365}
366
367static int mxs_saif_startup(struct snd_pcm_substream *substream,
368 struct snd_soc_dai *cpu_dai)
369{
370 struct mxs_saif *saif = snd_soc_dai_get_drvdata(cpu_dai);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800371
372 /* clear error status to 0 for each re-open */
373 saif->fifo_underrun = 0;
374 saif->fifo_overrun = 0;
375
376 /* Clear Reset for normal operations */
377 __raw_writel(BM_SAIF_CTRL_SFTRST,
378 saif->base + SAIF_CTRL + MXS_CLR_ADDR);
379
Dong Aishengbbe8ff52011-08-21 23:45:40 +0800380 /* clear clock gate */
381 __raw_writel(BM_SAIF_CTRL_CLKGATE,
382 saif->base + SAIF_CTRL + MXS_CLR_ADDR);
383
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800384 return 0;
385}
386
387/*
388 * Should only be called when port is inactive.
389 * although can be called multiple times by upper layers.
390 */
391static int mxs_saif_hw_params(struct snd_pcm_substream *substream,
392 struct snd_pcm_hw_params *params,
393 struct snd_soc_dai *cpu_dai)
394{
395 struct mxs_saif *saif = snd_soc_dai_get_drvdata(cpu_dai);
Dong Aishengc2e1d902012-07-20 17:20:24 +0800396 struct mxs_saif *master_saif;
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800397 u32 scr, stat;
398 int ret;
399
Dong Aishengc2e1d902012-07-20 17:20:24 +0800400 master_saif = mxs_saif_get_master(saif);
401 if (!master_saif)
402 return -EINVAL;
403
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800404 /* mclk should already be set */
405 if (!saif->mclk && saif->mclk_in_use) {
406 dev_err(cpu_dai->dev, "set mclk first\n");
407 return -EINVAL;
408 }
409
410 stat = __raw_readl(saif->base + SAIF_STAT);
411 if (stat & BM_SAIF_STAT_BUSY) {
412 dev_err(cpu_dai->dev, "error: busy\n");
413 return -EBUSY;
414 }
415
416 /*
417 * Set saif clk based on sample rate.
418 * If mclk is used, we also set mclk, if not, saif->mclk is
419 * default 0, means not used.
420 */
421 ret = mxs_saif_set_clk(saif, saif->mclk, params_rate(params));
422 if (ret) {
423 dev_err(cpu_dai->dev, "unable to get proper clk\n");
424 return ret;
425 }
426
Dong Aishengc2e1d902012-07-20 17:20:24 +0800427 /* prepare clk in hw_param, enable in trigger */
428 clk_prepare(saif->clk);
Dong Aishengd0ba4c02012-07-20 17:20:25 +0800429 if (saif != master_saif) {
430 /*
431 * Set an initial clock rate for the saif internal logic to work
432 * properly. This is important when working in EXTMASTER mode
433 * that uses the other saif's BITCLK&LRCLK but it still needs a
434 * basic clock which should be fast enough for the internal
435 * logic.
436 */
437 clk_enable(saif->clk);
438 ret = clk_set_rate(saif->clk, 24000000);
439 clk_disable(saif->clk);
440 if (ret)
441 return ret;
442
Dong Aishengc2e1d902012-07-20 17:20:24 +0800443 clk_prepare(master_saif->clk);
Dong Aishengd0ba4c02012-07-20 17:20:25 +0800444 }
Dong Aishengc2e1d902012-07-20 17:20:24 +0800445
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800446 scr = __raw_readl(saif->base + SAIF_CTRL);
447
448 scr &= ~BM_SAIF_CTRL_WORD_LENGTH;
449 scr &= ~BM_SAIF_CTRL_BITCLK_48XFS_ENABLE;
450 switch (params_format(params)) {
451 case SNDRV_PCM_FORMAT_S16_LE:
452 scr |= BF_SAIF_CTRL_WORD_LENGTH(0);
453 break;
454 case SNDRV_PCM_FORMAT_S20_3LE:
455 scr |= BF_SAIF_CTRL_WORD_LENGTH(4);
456 scr |= BM_SAIF_CTRL_BITCLK_48XFS_ENABLE;
457 break;
458 case SNDRV_PCM_FORMAT_S24_LE:
459 scr |= BF_SAIF_CTRL_WORD_LENGTH(8);
460 scr |= BM_SAIF_CTRL_BITCLK_48XFS_ENABLE;
461 break;
462 default:
463 return -EINVAL;
464 }
465
466 /* Tx/Rx config */
467 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
468 /* enable TX mode */
469 scr &= ~BM_SAIF_CTRL_READ_MODE;
470 } else {
471 /* enable RX mode */
472 scr |= BM_SAIF_CTRL_READ_MODE;
473 }
474
475 __raw_writel(scr, saif->base + SAIF_CTRL);
476 return 0;
477}
478
479static int mxs_saif_prepare(struct snd_pcm_substream *substream,
480 struct snd_soc_dai *cpu_dai)
481{
482 struct mxs_saif *saif = snd_soc_dai_get_drvdata(cpu_dai);
483
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800484 /* enable FIFO error irqs */
485 __raw_writel(BM_SAIF_CTRL_FIFO_ERROR_IRQ_EN,
486 saif->base + SAIF_CTRL + MXS_SET_ADDR);
487
488 return 0;
489}
490
491static int mxs_saif_trigger(struct snd_pcm_substream *substream, int cmd,
492 struct snd_soc_dai *cpu_dai)
493{
494 struct mxs_saif *saif = snd_soc_dai_get_drvdata(cpu_dai);
Dong Aisheng76067542011-09-07 20:51:50 +0800495 struct mxs_saif *master_saif;
496 u32 delay;
497
498 master_saif = mxs_saif_get_master(saif);
499 if (!master_saif)
500 return -EINVAL;
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800501
502 switch (cmd) {
503 case SNDRV_PCM_TRIGGER_START:
504 case SNDRV_PCM_TRIGGER_RESUME:
505 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
506 dev_dbg(cpu_dai->dev, "start\n");
507
Dong Aisheng76067542011-09-07 20:51:50 +0800508 clk_enable(master_saif->clk);
509 if (!master_saif->mclk_in_use)
510 __raw_writel(BM_SAIF_CTRL_RUN,
511 master_saif->base + SAIF_CTRL + MXS_SET_ADDR);
512
513 /*
514 * If the saif's master is not himself, we also need to enable
515 * itself clk for its internal basic logic to work.
516 */
517 if (saif != master_saif) {
518 clk_enable(saif->clk);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800519 __raw_writel(BM_SAIF_CTRL_RUN,
520 saif->base + SAIF_CTRL + MXS_SET_ADDR);
Dong Aisheng76067542011-09-07 20:51:50 +0800521 }
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800522
523 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
524 /*
Fabio Estevamf55f1472012-11-01 15:57:11 -0200525 * write data to saif data register to trigger
526 * the transfer.
527 * For 24-bit format the 32-bit FIFO register stores
528 * only one channel, so we need to write twice.
529 * This is also safe for the other non 24-bit formats.
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800530 */
531 __raw_writel(0, saif->base + SAIF_DATA);
Fabio Estevamf55f1472012-11-01 15:57:11 -0200532 __raw_writel(0, saif->base + SAIF_DATA);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800533 } else {
534 /*
Fabio Estevamf55f1472012-11-01 15:57:11 -0200535 * read data from saif data register to trigger
536 * the receive.
537 * For 24-bit format the 32-bit FIFO register stores
538 * only one channel, so we need to read twice.
539 * This is also safe for the other non 24-bit formats.
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800540 */
541 __raw_readl(saif->base + SAIF_DATA);
Fabio Estevamf55f1472012-11-01 15:57:11 -0200542 __raw_readl(saif->base + SAIF_DATA);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800543 }
544
Dong Aisheng76067542011-09-07 20:51:50 +0800545 master_saif->ongoing = 1;
546
547 dev_dbg(saif->dev, "CTRL 0x%x STAT 0x%x\n",
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800548 __raw_readl(saif->base + SAIF_CTRL),
549 __raw_readl(saif->base + SAIF_STAT));
550
Dong Aisheng76067542011-09-07 20:51:50 +0800551 dev_dbg(master_saif->dev, "CTRL 0x%x STAT 0x%x\n",
552 __raw_readl(master_saif->base + SAIF_CTRL),
553 __raw_readl(master_saif->base + SAIF_STAT));
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800554 break;
555 case SNDRV_PCM_TRIGGER_SUSPEND:
556 case SNDRV_PCM_TRIGGER_STOP:
557 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
558 dev_dbg(cpu_dai->dev, "stop\n");
559
Dong Aisheng76067542011-09-07 20:51:50 +0800560 /* wait a while for the current sample to complete */
561 delay = USEC_PER_SEC / master_saif->cur_rate;
562
563 if (!master_saif->mclk_in_use) {
564 __raw_writel(BM_SAIF_CTRL_RUN,
565 master_saif->base + SAIF_CTRL + MXS_CLR_ADDR);
566 udelay(delay);
567 }
568 clk_disable(master_saif->clk);
569
570 if (saif != master_saif) {
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800571 __raw_writel(BM_SAIF_CTRL_RUN,
572 saif->base + SAIF_CTRL + MXS_CLR_ADDR);
Dong Aisheng76067542011-09-07 20:51:50 +0800573 udelay(delay);
574 clk_disable(saif->clk);
575 }
576
577 master_saif->ongoing = 0;
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800578
579 break;
580 default:
581 return -EINVAL;
582 }
583
584 return 0;
585}
586
587#define MXS_SAIF_RATES SNDRV_PCM_RATE_8000_192000
588#define MXS_SAIF_FORMATS \
589 (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
590 SNDRV_PCM_FMTBIT_S24_LE)
591
Lars-Peter Clausen85e76522011-11-23 11:40:40 +0100592static const struct snd_soc_dai_ops mxs_saif_dai_ops = {
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800593 .startup = mxs_saif_startup,
594 .trigger = mxs_saif_trigger,
595 .prepare = mxs_saif_prepare,
596 .hw_params = mxs_saif_hw_params,
597 .set_sysclk = mxs_saif_set_dai_sysclk,
598 .set_fmt = mxs_saif_set_dai_fmt,
599};
600
601static int mxs_saif_dai_probe(struct snd_soc_dai *dai)
602{
603 struct mxs_saif *saif = dev_get_drvdata(dai->dev);
604
605 snd_soc_dai_set_drvdata(dai, saif);
606
607 return 0;
608}
609
610static struct snd_soc_dai_driver mxs_saif_dai = {
611 .name = "mxs-saif",
612 .probe = mxs_saif_dai_probe,
613 .playback = {
614 .channels_min = 2,
615 .channels_max = 2,
616 .rates = MXS_SAIF_RATES,
617 .formats = MXS_SAIF_FORMATS,
618 },
619 .capture = {
620 .channels_min = 2,
621 .channels_max = 2,
622 .rates = MXS_SAIF_RATES,
623 .formats = MXS_SAIF_FORMATS,
624 },
625 .ops = &mxs_saif_dai_ops,
626};
627
Kuninori Morimoto026240b2013-03-21 03:33:02 -0700628static const struct snd_soc_component_driver mxs_saif_component = {
629 .name = "mxs-saif",
630};
631
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800632static irqreturn_t mxs_saif_irq(int irq, void *dev_id)
633{
634 struct mxs_saif *saif = dev_id;
635 unsigned int stat;
636
637 stat = __raw_readl(saif->base + SAIF_STAT);
638 if (!(stat & (BM_SAIF_STAT_FIFO_UNDERFLOW_IRQ |
639 BM_SAIF_STAT_FIFO_OVERFLOW_IRQ)))
640 return IRQ_NONE;
641
642 if (stat & BM_SAIF_STAT_FIFO_UNDERFLOW_IRQ) {
643 dev_dbg(saif->dev, "underrun!!! %d\n", ++saif->fifo_underrun);
644 __raw_writel(BM_SAIF_STAT_FIFO_UNDERFLOW_IRQ,
645 saif->base + SAIF_STAT + MXS_CLR_ADDR);
646 }
647
648 if (stat & BM_SAIF_STAT_FIFO_OVERFLOW_IRQ) {
649 dev_dbg(saif->dev, "overrun!!! %d\n", ++saif->fifo_overrun);
650 __raw_writel(BM_SAIF_STAT_FIFO_OVERFLOW_IRQ,
651 saif->base + SAIF_STAT + MXS_CLR_ADDR);
652 }
653
654 dev_dbg(saif->dev, "SAIF_CTRL %x SAIF_STAT %x\n",
655 __raw_readl(saif->base + SAIF_CTRL),
656 __raw_readl(saif->base + SAIF_STAT));
657
658 return IRQ_HANDLED;
659}
660
Shawn Guo7c9e6152013-07-01 16:16:10 +0800661static int mxs_saif_mclk_init(struct platform_device *pdev)
662{
663 struct mxs_saif *saif = platform_get_drvdata(pdev);
664 struct device_node *np = pdev->dev.of_node;
665 struct clk *clk;
666 int ret;
667
668 clk = clk_register_divider(&pdev->dev, "mxs_saif_mclk",
669 __clk_get_name(saif->clk), 0,
670 saif->base + SAIF_CTRL,
671 BP_SAIF_CTRL_BITCLK_MULT_RATE, 3,
672 0, NULL);
673 if (IS_ERR(clk)) {
674 ret = PTR_ERR(clk);
675 if (ret == -EEXIST)
676 return 0;
677 dev_err(&pdev->dev, "failed to register mclk: %d\n", ret);
678 return PTR_ERR(clk);
679 }
680
681 ret = of_clk_add_provider(np, of_clk_src_simple_get, clk);
682 if (ret)
683 return ret;
684
685 return 0;
686}
687
Bill Pembertonfd582732012-12-07 09:26:27 -0500688static int mxs_saif_probe(struct platform_device *pdev)
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800689{
Shawn Guo08641c72012-05-11 22:24:17 +0800690 struct device_node *np = pdev->dev.of_node;
Shawn Guo62477ad2013-05-13 13:30:56 +0800691 struct resource *iores;
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800692 struct mxs_saif *saif;
693 int ret = 0;
Fabio Estevam4498a3c2012-11-14 18:28:58 -0200694 struct device_node *master;
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800695
Fabio Estevam4498a3c2012-11-14 18:28:58 -0200696 if (!np)
Julia Lawall0bb98ba2011-08-21 13:18:45 +0200697 return -EINVAL;
698
Julia Lawall830eb872012-02-10 09:17:01 +0100699 saif = devm_kzalloc(&pdev->dev, sizeof(*saif), GFP_KERNEL);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800700 if (!saif)
701 return -ENOMEM;
702
Fabio Estevam324a7fb2013-01-08 10:45:04 -0200703 ret = of_alias_get_id(np, "saif");
704 if (ret < 0)
705 return ret;
706 else
707 saif->id = ret;
708
Fabio Estevam4498a3c2012-11-14 18:28:58 -0200709 /*
710 * If there is no "fsl,saif-master" phandle, it's a saif
711 * master. Otherwise, it's a slave and its phandle points
712 * to the master.
713 */
714 master = of_parse_phandle(np, "fsl,saif-master", 0);
715 if (!master) {
716 saif->master_id = saif->id;
Dong Aisheng77882582011-11-22 23:52:21 +0800717 } else {
Fabio Estevam324a7fb2013-01-08 10:45:04 -0200718 ret = of_alias_get_id(master, "saif");
719 if (ret < 0)
720 return ret;
721 else
722 saif->master_id = ret;
Dong Aisheng76067542011-09-07 20:51:50 +0800723 }
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800724
Fabio Estevam324a7fb2013-01-08 10:45:04 -0200725 if (saif->master_id >= ARRAY_SIZE(mxs_saif)) {
Shawn Guo08641c72012-05-11 22:24:17 +0800726 dev_err(&pdev->dev, "get wrong master id\n");
727 return -EINVAL;
728 }
729
730 mxs_saif[saif->id] = saif;
731
Fabio Estevam730963f2012-08-07 01:29:43 -0300732 saif->clk = devm_clk_get(&pdev->dev, NULL);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800733 if (IS_ERR(saif->clk)) {
734 ret = PTR_ERR(saif->clk);
735 dev_err(&pdev->dev, "Cannot get the clock: %d\n",
736 ret);
Julia Lawall830eb872012-02-10 09:17:01 +0100737 return ret;
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800738 }
739
Julia Lawall226d0f22011-10-18 17:06:39 +0200740 iores = platform_get_resource(pdev, IORESOURCE_MEM, 0);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800741
Thierry Redingb25b5aa2013-01-21 11:09:26 +0100742 saif->base = devm_ioremap_resource(&pdev->dev, iores);
743 if (IS_ERR(saif->base))
744 return PTR_ERR(saif->base);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800745
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800746 saif->irq = platform_get_irq(pdev, 0);
747 if (saif->irq < 0) {
748 ret = saif->irq;
749 dev_err(&pdev->dev, "failed to get irq resource: %d\n",
750 ret);
Fabio Estevam730963f2012-08-07 01:29:43 -0300751 return ret;
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800752 }
753
754 saif->dev = &pdev->dev;
Julia Lawall830eb872012-02-10 09:17:01 +0100755 ret = devm_request_irq(&pdev->dev, saif->irq, mxs_saif_irq, 0,
756 "mxs-saif", saif);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800757 if (ret) {
758 dev_err(&pdev->dev, "failed to request irq\n");
Fabio Estevam730963f2012-08-07 01:29:43 -0300759 return ret;
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800760 }
761
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800762 platform_set_drvdata(pdev, saif);
763
Shawn Guo7c9e6152013-07-01 16:16:10 +0800764 /* We only support saif0 being tx and clock master */
765 if (saif->id == 0) {
766 ret = mxs_saif_mclk_init(pdev);
767 if (ret)
768 dev_warn(&pdev->dev, "failed to init clocks\n");
769 }
770
Sachin Kamatfcd70eb2013-09-17 10:20:09 +0530771 ret = devm_snd_soc_register_component(&pdev->dev, &mxs_saif_component,
772 &mxs_saif_dai, 1);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800773 if (ret) {
774 dev_err(&pdev->dev, "register DAI failed\n");
Fabio Estevam730963f2012-08-07 01:29:43 -0300775 return ret;
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800776 }
777
Shawn Guo4da3fe72012-05-11 22:24:16 +0800778 ret = mxs_pcm_platform_register(&pdev->dev);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800779 if (ret) {
Shawn Guo4da3fe72012-05-11 22:24:16 +0800780 dev_err(&pdev->dev, "register PCM failed: %d\n", ret);
Sachin Kamatfcd70eb2013-09-17 10:20:09 +0530781 return ret;
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800782 }
783
784 return 0;
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800785}
786
Bill Pembertonfd582732012-12-07 09:26:27 -0500787static int mxs_saif_remove(struct platform_device *pdev)
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800788{
Shawn Guo4da3fe72012-05-11 22:24:16 +0800789 mxs_pcm_platform_unregister(&pdev->dev);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800790
791 return 0;
792}
793
Shawn Guo08641c72012-05-11 22:24:17 +0800794static const struct of_device_id mxs_saif_dt_ids[] = {
795 { .compatible = "fsl,imx28-saif", },
796 { /* sentinel */ }
797};
798MODULE_DEVICE_TABLE(of, mxs_saif_dt_ids);
799
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800800static struct platform_driver mxs_saif_driver = {
801 .probe = mxs_saif_probe,
Bill Pembertonfd582732012-12-07 09:26:27 -0500802 .remove = mxs_saif_remove,
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800803
804 .driver = {
805 .name = "mxs-saif",
806 .owner = THIS_MODULE,
Shawn Guo08641c72012-05-11 22:24:17 +0800807 .of_match_table = mxs_saif_dt_ids,
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800808 },
809};
810
Axel Lin85aa0962011-11-24 14:21:29 +0800811module_platform_driver(mxs_saif_driver);
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800812
Dong Aisheng2a24f2c2011-07-21 12:36:56 +0800813MODULE_AUTHOR("Freescale Semiconductor, Inc.");
814MODULE_DESCRIPTION("MXS ASoC SAIF driver");
815MODULE_LICENSE("GPL");
Fabio Estevam9f4c3f12012-10-31 01:20:05 -0200816MODULE_ALIAS("platform:mxs-saif");