xref: /openbmc/linux/sound/soc/mxs/mxs-saif.c (revision 62477adf)
12a24f2ceSDong Aisheng /*
22a24f2ceSDong Aisheng  * Copyright 2011 Freescale Semiconductor, Inc.
32a24f2ceSDong Aisheng  *
42a24f2ceSDong Aisheng  * This program is free software; you can redistribute it and/or modify
52a24f2ceSDong Aisheng  * it under the terms of the GNU General Public License as published by
62a24f2ceSDong Aisheng  * the Free Software Foundation; either version 2 of the License, or
72a24f2ceSDong Aisheng  * (at your option) any later version.
82a24f2ceSDong Aisheng  *
92a24f2ceSDong Aisheng  * This program is distributed in the hope that it will be useful,
102a24f2ceSDong Aisheng  * but WITHOUT ANY WARRANTY; without even the implied warranty of
112a24f2ceSDong Aisheng  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
122a24f2ceSDong Aisheng  * GNU General Public License for more details.
132a24f2ceSDong Aisheng  *
142a24f2ceSDong Aisheng  * You should have received a copy of the GNU General Public License along
152a24f2ceSDong Aisheng  * with this program; if not, write to the Free Software Foundation, Inc.,
162a24f2ceSDong Aisheng  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
172a24f2ceSDong Aisheng  */
182a24f2ceSDong Aisheng 
192a24f2ceSDong Aisheng #include <linux/module.h>
202a24f2ceSDong Aisheng #include <linux/init.h>
2108641c7cSShawn Guo #include <linux/of.h>
2208641c7cSShawn Guo #include <linux/of_device.h>
232a24f2ceSDong Aisheng #include <linux/platform_device.h>
242a24f2ceSDong Aisheng #include <linux/slab.h>
252a24f2ceSDong Aisheng #include <linux/dma-mapping.h>
262a24f2ceSDong Aisheng #include <linux/clk.h>
272a24f2ceSDong Aisheng #include <linux/delay.h>
2876067540SDong Aisheng #include <linux/time.h>
292a24f2ceSDong Aisheng #include <sound/core.h>
302a24f2ceSDong Aisheng #include <sound/pcm.h>
312a24f2ceSDong Aisheng #include <sound/pcm_params.h>
322a24f2ceSDong Aisheng #include <sound/soc.h>
332a24f2ceSDong Aisheng #include <asm/mach-types.h>
342a24f2ceSDong Aisheng 
352a24f2ceSDong Aisheng #include "mxs-saif.h"
362a24f2ceSDong Aisheng 
37114fe75dSShawn Guo #define MXS_SET_ADDR	0x4
38114fe75dSShawn Guo #define MXS_CLR_ADDR	0x8
39114fe75dSShawn Guo 
402a24f2ceSDong Aisheng static struct mxs_saif *mxs_saif[2];
412a24f2ceSDong Aisheng 
4276067540SDong Aisheng /*
4376067540SDong Aisheng  * SAIF is a little different with other normal SOC DAIs on clock using.
4476067540SDong Aisheng  *
4576067540SDong Aisheng  * For MXS, two SAIF modules are instantiated on-chip.
4676067540SDong Aisheng  * Each SAIF has a set of clock pins and can be operating in master
4776067540SDong Aisheng  * mode simultaneously if they are connected to different off-chip codecs.
4876067540SDong Aisheng  * Also, one of the two SAIFs can master or drive the clock pins while the
4976067540SDong Aisheng  * other SAIF, in slave mode, receives clocking from the master SAIF.
5076067540SDong Aisheng  * This also means that both SAIFs must operate at the same sample rate.
5176067540SDong Aisheng  *
5276067540SDong Aisheng  * We abstract this as each saif has a master, the master could be
5376067540SDong Aisheng  * himself or other saifs. In the generic saif driver, saif does not need
5476067540SDong Aisheng  * to know the different clkmux. Saif only needs to know who is his master
5576067540SDong Aisheng  * and operating his master to generate the proper clock rate for him.
5676067540SDong Aisheng  * The master id is provided in mach-specific layer according to different
5776067540SDong Aisheng  * clkmux setting.
5876067540SDong Aisheng  */
5976067540SDong Aisheng 
602a24f2ceSDong Aisheng static int mxs_saif_set_dai_sysclk(struct snd_soc_dai *cpu_dai,
612a24f2ceSDong Aisheng 			int clk_id, unsigned int freq, int dir)
622a24f2ceSDong Aisheng {
632a24f2ceSDong Aisheng 	struct mxs_saif *saif = snd_soc_dai_get_drvdata(cpu_dai);
642a24f2ceSDong Aisheng 
652a24f2ceSDong Aisheng 	switch (clk_id) {
662a24f2ceSDong Aisheng 	case MXS_SAIF_MCLK:
672a24f2ceSDong Aisheng 		saif->mclk = freq;
682a24f2ceSDong Aisheng 		break;
692a24f2ceSDong Aisheng 	default:
702a24f2ceSDong Aisheng 		return -EINVAL;
712a24f2ceSDong Aisheng 	}
722a24f2ceSDong Aisheng 	return 0;
732a24f2ceSDong Aisheng }
742a24f2ceSDong Aisheng 
752a24f2ceSDong Aisheng /*
7676067540SDong Aisheng  * Since SAIF may work on EXTMASTER mode, IOW, it's working BITCLK&LRCLK
7776067540SDong Aisheng  * is provided by other SAIF, we provide a interface here to get its master
7876067540SDong Aisheng  * from its master_id.
7976067540SDong Aisheng  * Note that the master could be himself.
8076067540SDong Aisheng  */
8176067540SDong Aisheng static inline struct mxs_saif *mxs_saif_get_master(struct mxs_saif * saif)
8276067540SDong Aisheng {
8376067540SDong Aisheng 	return mxs_saif[saif->master_id];
8476067540SDong Aisheng }
8576067540SDong Aisheng 
8676067540SDong Aisheng /*
872a24f2ceSDong Aisheng  * Set SAIF clock and MCLK
882a24f2ceSDong Aisheng  */
892a24f2ceSDong Aisheng static int mxs_saif_set_clk(struct mxs_saif *saif,
902a24f2ceSDong Aisheng 				  unsigned int mclk,
912a24f2ceSDong Aisheng 				  unsigned int rate)
922a24f2ceSDong Aisheng {
932a24f2ceSDong Aisheng 	u32 scr;
942a24f2ceSDong Aisheng 	int ret;
9576067540SDong Aisheng 	struct mxs_saif *master_saif;
962a24f2ceSDong Aisheng 
9776067540SDong Aisheng 	dev_dbg(saif->dev, "mclk %d rate %d\n", mclk, rate);
9876067540SDong Aisheng 
9976067540SDong Aisheng 	/* Set master saif to generate proper clock */
10076067540SDong Aisheng 	master_saif = mxs_saif_get_master(saif);
10176067540SDong Aisheng 	if (!master_saif)
10276067540SDong Aisheng 		return -EINVAL;
10376067540SDong Aisheng 
10476067540SDong Aisheng 	dev_dbg(saif->dev, "master saif%d\n", master_saif->id);
10576067540SDong Aisheng 
10676067540SDong Aisheng 	/* Checking if can playback and capture simutaneously */
10776067540SDong Aisheng 	if (master_saif->ongoing && rate != master_saif->cur_rate) {
10876067540SDong Aisheng 		dev_err(saif->dev,
10976067540SDong Aisheng 			"can not change clock, master saif%d(rate %d) is ongoing\n",
11076067540SDong Aisheng 			master_saif->id, master_saif->cur_rate);
11176067540SDong Aisheng 		return -EINVAL;
11276067540SDong Aisheng 	}
11376067540SDong Aisheng 
11476067540SDong Aisheng 	scr = __raw_readl(master_saif->base + SAIF_CTRL);
1152a24f2ceSDong Aisheng 	scr &= ~BM_SAIF_CTRL_BITCLK_MULT_RATE;
1162a24f2ceSDong Aisheng 	scr &= ~BM_SAIF_CTRL_BITCLK_BASE_RATE;
1172a24f2ceSDong Aisheng 
1182a24f2ceSDong Aisheng 	/*
1192a24f2ceSDong Aisheng 	 * Set SAIF clock
1202a24f2ceSDong Aisheng 	 *
1212a24f2ceSDong Aisheng 	 * The SAIF clock should be either 384*fs or 512*fs.
1222a24f2ceSDong Aisheng 	 * If MCLK is used, the SAIF clk ratio need to match mclk ratio.
1232a24f2ceSDong Aisheng 	 *  For 32x mclk, set saif clk as 512*fs.
1242a24f2ceSDong Aisheng 	 *  For 48x mclk, set saif clk as 384*fs.
1252a24f2ceSDong Aisheng 	 *
1262a24f2ceSDong Aisheng 	 * If MCLK is not used, we just set saif clk to 512*fs.
1272a24f2ceSDong Aisheng 	 */
1286b35f924SFabio Estevam 	clk_prepare_enable(master_saif->clk);
1296b35f924SFabio Estevam 
13076067540SDong Aisheng 	if (master_saif->mclk_in_use) {
1312a24f2ceSDong Aisheng 		if (mclk % 32 == 0) {
1322a24f2ceSDong Aisheng 			scr &= ~BM_SAIF_CTRL_BITCLK_BASE_RATE;
13376067540SDong Aisheng 			ret = clk_set_rate(master_saif->clk, 512 * rate);
1342a24f2ceSDong Aisheng 		} else if (mclk % 48 == 0) {
1352a24f2ceSDong Aisheng 			scr |= BM_SAIF_CTRL_BITCLK_BASE_RATE;
13676067540SDong Aisheng 			ret = clk_set_rate(master_saif->clk, 384 * rate);
1372a24f2ceSDong Aisheng 		} else {
1382a24f2ceSDong Aisheng 			/* SAIF MCLK should be either 32x or 48x */
1396b35f924SFabio Estevam 			clk_disable_unprepare(master_saif->clk);
1402a24f2ceSDong Aisheng 			return -EINVAL;
1412a24f2ceSDong Aisheng 		}
1422a24f2ceSDong Aisheng 	} else {
14376067540SDong Aisheng 		ret = clk_set_rate(master_saif->clk, 512 * rate);
1442a24f2ceSDong Aisheng 		scr &= ~BM_SAIF_CTRL_BITCLK_BASE_RATE;
1452a24f2ceSDong Aisheng 	}
1462a24f2ceSDong Aisheng 
1476b35f924SFabio Estevam 	clk_disable_unprepare(master_saif->clk);
1486b35f924SFabio Estevam 
1492a24f2ceSDong Aisheng 	if (ret)
1502a24f2ceSDong Aisheng 		return ret;
1512a24f2ceSDong Aisheng 
15276067540SDong Aisheng 	master_saif->cur_rate = rate;
15376067540SDong Aisheng 
15476067540SDong Aisheng 	if (!master_saif->mclk_in_use) {
15576067540SDong Aisheng 		__raw_writel(scr, master_saif->base + SAIF_CTRL);
1562a24f2ceSDong Aisheng 		return 0;
1572a24f2ceSDong Aisheng 	}
1582a24f2ceSDong Aisheng 
1592a24f2ceSDong Aisheng 	/*
1602a24f2ceSDong Aisheng 	 * Program the over-sample rate for MCLK output
1612a24f2ceSDong Aisheng 	 *
1622a24f2ceSDong Aisheng 	 * The available MCLK range is 32x, 48x... 512x. The rate
1632a24f2ceSDong Aisheng 	 * could be from 8kHz to 192kH.
1642a24f2ceSDong Aisheng 	 */
1652a24f2ceSDong Aisheng 	switch (mclk / rate) {
1662a24f2ceSDong Aisheng 	case 32:
1672a24f2ceSDong Aisheng 		scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(4);
1682a24f2ceSDong Aisheng 		break;
1692a24f2ceSDong Aisheng 	case 64:
1702a24f2ceSDong Aisheng 		scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(3);
1712a24f2ceSDong Aisheng 		break;
1722a24f2ceSDong Aisheng 	case 128:
1732a24f2ceSDong Aisheng 		scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(2);
1742a24f2ceSDong Aisheng 		break;
1752a24f2ceSDong Aisheng 	case 256:
1762a24f2ceSDong Aisheng 		scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(1);
1772a24f2ceSDong Aisheng 		break;
1782a24f2ceSDong Aisheng 	case 512:
1792a24f2ceSDong Aisheng 		scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(0);
1802a24f2ceSDong Aisheng 		break;
1812a24f2ceSDong Aisheng 	case 48:
1822a24f2ceSDong Aisheng 		scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(3);
1832a24f2ceSDong Aisheng 		break;
1842a24f2ceSDong Aisheng 	case 96:
1852a24f2ceSDong Aisheng 		scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(2);
1862a24f2ceSDong Aisheng 		break;
1872a24f2ceSDong Aisheng 	case 192:
1882a24f2ceSDong Aisheng 		scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(1);
1892a24f2ceSDong Aisheng 		break;
1902a24f2ceSDong Aisheng 	case 384:
1912a24f2ceSDong Aisheng 		scr |= BF_SAIF_CTRL_BITCLK_MULT_RATE(0);
1922a24f2ceSDong Aisheng 		break;
1932a24f2ceSDong Aisheng 	default:
1942a24f2ceSDong Aisheng 		return -EINVAL;
1952a24f2ceSDong Aisheng 	}
1962a24f2ceSDong Aisheng 
19776067540SDong Aisheng 	__raw_writel(scr, master_saif->base + SAIF_CTRL);
1982a24f2ceSDong Aisheng 
1992a24f2ceSDong Aisheng 	return 0;
2002a24f2ceSDong Aisheng }
2012a24f2ceSDong Aisheng 
2022a24f2ceSDong Aisheng /*
2032a24f2ceSDong Aisheng  * Put and disable MCLK.
2042a24f2ceSDong Aisheng  */
2052a24f2ceSDong Aisheng int mxs_saif_put_mclk(unsigned int saif_id)
2062a24f2ceSDong Aisheng {
2072a24f2ceSDong Aisheng 	struct mxs_saif *saif = mxs_saif[saif_id];
2082a24f2ceSDong Aisheng 	u32 stat;
2092a24f2ceSDong Aisheng 
2102a24f2ceSDong Aisheng 	if (!saif)
2112a24f2ceSDong Aisheng 		return -EINVAL;
2122a24f2ceSDong Aisheng 
2132a24f2ceSDong Aisheng 	stat = __raw_readl(saif->base + SAIF_STAT);
2142a24f2ceSDong Aisheng 	if (stat & BM_SAIF_STAT_BUSY) {
2152a24f2ceSDong Aisheng 		dev_err(saif->dev, "error: busy\n");
2162a24f2ceSDong Aisheng 		return -EBUSY;
2172a24f2ceSDong Aisheng 	}
2182a24f2ceSDong Aisheng 
21967939b22SShawn Guo 	clk_disable_unprepare(saif->clk);
2202a24f2ceSDong Aisheng 
2212a24f2ceSDong Aisheng 	/* disable MCLK output */
2222a24f2ceSDong Aisheng 	__raw_writel(BM_SAIF_CTRL_CLKGATE,
2232a24f2ceSDong Aisheng 		saif->base + SAIF_CTRL + MXS_SET_ADDR);
2242a24f2ceSDong Aisheng 	__raw_writel(BM_SAIF_CTRL_RUN,
2252a24f2ceSDong Aisheng 		saif->base + SAIF_CTRL + MXS_CLR_ADDR);
2262a24f2ceSDong Aisheng 
2272a24f2ceSDong Aisheng 	saif->mclk_in_use = 0;
2282a24f2ceSDong Aisheng 	return 0;
2292a24f2ceSDong Aisheng }
230cf7d0f09SLothar Waßmann EXPORT_SYMBOL_GPL(mxs_saif_put_mclk);
2312a24f2ceSDong Aisheng 
2322a24f2ceSDong Aisheng /*
2332a24f2ceSDong Aisheng  * Get MCLK and set clock rate, then enable it
2342a24f2ceSDong Aisheng  *
2352a24f2ceSDong Aisheng  * This interface is used for codecs who are using MCLK provided
2362a24f2ceSDong Aisheng  * by saif.
2372a24f2ceSDong Aisheng  */
2382a24f2ceSDong Aisheng int mxs_saif_get_mclk(unsigned int saif_id, unsigned int mclk,
2392a24f2ceSDong Aisheng 					unsigned int rate)
2402a24f2ceSDong Aisheng {
2412a24f2ceSDong Aisheng 	struct mxs_saif *saif = mxs_saif[saif_id];
2422a24f2ceSDong Aisheng 	u32 stat;
2432a24f2ceSDong Aisheng 	int ret;
24476067540SDong Aisheng 	struct mxs_saif *master_saif;
2452a24f2ceSDong Aisheng 
2462a24f2ceSDong Aisheng 	if (!saif)
2472a24f2ceSDong Aisheng 		return -EINVAL;
2482a24f2ceSDong Aisheng 
249bbe8ff5eSDong Aisheng 	/* Clear Reset */
250bbe8ff5eSDong Aisheng 	__raw_writel(BM_SAIF_CTRL_SFTRST,
251bbe8ff5eSDong Aisheng 		saif->base + SAIF_CTRL + MXS_CLR_ADDR);
252bbe8ff5eSDong Aisheng 
253bbe8ff5eSDong Aisheng 	/* FIXME: need clear clk gate for register r/w */
254bbe8ff5eSDong Aisheng 	__raw_writel(BM_SAIF_CTRL_CLKGATE,
255bbe8ff5eSDong Aisheng 		saif->base + SAIF_CTRL + MXS_CLR_ADDR);
256bbe8ff5eSDong Aisheng 
25776067540SDong Aisheng 	master_saif = mxs_saif_get_master(saif);
25876067540SDong Aisheng 	if (saif != master_saif) {
25976067540SDong Aisheng 		dev_err(saif->dev, "can not get mclk from a non-master saif\n");
26076067540SDong Aisheng 		return -EINVAL;
26176067540SDong Aisheng 	}
26276067540SDong Aisheng 
2632a24f2ceSDong Aisheng 	stat = __raw_readl(saif->base + SAIF_STAT);
2642a24f2ceSDong Aisheng 	if (stat & BM_SAIF_STAT_BUSY) {
2652a24f2ceSDong Aisheng 		dev_err(saif->dev, "error: busy\n");
2662a24f2ceSDong Aisheng 		return -EBUSY;
2672a24f2ceSDong Aisheng 	}
2682a24f2ceSDong Aisheng 
2692a24f2ceSDong Aisheng 	saif->mclk_in_use = 1;
2702a24f2ceSDong Aisheng 	ret = mxs_saif_set_clk(saif, mclk, rate);
2712a24f2ceSDong Aisheng 	if (ret)
2722a24f2ceSDong Aisheng 		return ret;
2732a24f2ceSDong Aisheng 
27467939b22SShawn Guo 	ret = clk_prepare_enable(saif->clk);
2752a24f2ceSDong Aisheng 	if (ret)
2762a24f2ceSDong Aisheng 		return ret;
2772a24f2ceSDong Aisheng 
2782a24f2ceSDong Aisheng 	/* enable MCLK output */
2792a24f2ceSDong Aisheng 	__raw_writel(BM_SAIF_CTRL_RUN,
2802a24f2ceSDong Aisheng 		saif->base + SAIF_CTRL + MXS_SET_ADDR);
2812a24f2ceSDong Aisheng 
2822a24f2ceSDong Aisheng 	return 0;
2832a24f2ceSDong Aisheng }
284cf7d0f09SLothar Waßmann EXPORT_SYMBOL_GPL(mxs_saif_get_mclk);
2852a24f2ceSDong Aisheng 
2862a24f2ceSDong Aisheng /*
2872a24f2ceSDong Aisheng  * SAIF DAI format configuration.
2882a24f2ceSDong Aisheng  * Should only be called when port is inactive.
2892a24f2ceSDong Aisheng  */
2902a24f2ceSDong Aisheng static int mxs_saif_set_dai_fmt(struct snd_soc_dai *cpu_dai, unsigned int fmt)
2912a24f2ceSDong Aisheng {
2922a24f2ceSDong Aisheng 	u32 scr, stat;
2932a24f2ceSDong Aisheng 	u32 scr0;
2942a24f2ceSDong Aisheng 	struct mxs_saif *saif = snd_soc_dai_get_drvdata(cpu_dai);
2952a24f2ceSDong Aisheng 
2962a24f2ceSDong Aisheng 	stat = __raw_readl(saif->base + SAIF_STAT);
2972a24f2ceSDong Aisheng 	if (stat & BM_SAIF_STAT_BUSY) {
2982a24f2ceSDong Aisheng 		dev_err(cpu_dai->dev, "error: busy\n");
2992a24f2ceSDong Aisheng 		return -EBUSY;
3002a24f2ceSDong Aisheng 	}
3012a24f2ceSDong Aisheng 
3022a24f2ceSDong Aisheng 	scr0 = __raw_readl(saif->base + SAIF_CTRL);
3032a24f2ceSDong Aisheng 	scr0 = scr0 & ~BM_SAIF_CTRL_BITCLK_EDGE & ~BM_SAIF_CTRL_LRCLK_POLARITY \
3042a24f2ceSDong Aisheng 		& ~BM_SAIF_CTRL_JUSTIFY & ~BM_SAIF_CTRL_DELAY;
3052a24f2ceSDong Aisheng 	scr = 0;
3062a24f2ceSDong Aisheng 
3072a24f2ceSDong Aisheng 	/* DAI mode */
3082a24f2ceSDong Aisheng 	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
3092a24f2ceSDong Aisheng 	case SND_SOC_DAIFMT_I2S:
3102a24f2ceSDong Aisheng 		/* data frame low 1clk before data */
3112a24f2ceSDong Aisheng 		scr |= BM_SAIF_CTRL_DELAY;
3122a24f2ceSDong Aisheng 		scr &= ~BM_SAIF_CTRL_LRCLK_POLARITY;
3132a24f2ceSDong Aisheng 		break;
3142a24f2ceSDong Aisheng 	case SND_SOC_DAIFMT_LEFT_J:
3152a24f2ceSDong Aisheng 		/* data frame high with data */
3162a24f2ceSDong Aisheng 		scr &= ~BM_SAIF_CTRL_DELAY;
3172a24f2ceSDong Aisheng 		scr &= ~BM_SAIF_CTRL_LRCLK_POLARITY;
3182a24f2ceSDong Aisheng 		scr &= ~BM_SAIF_CTRL_JUSTIFY;
3192a24f2ceSDong Aisheng 		break;
3202a24f2ceSDong Aisheng 	default:
3212a24f2ceSDong Aisheng 		return -EINVAL;
3222a24f2ceSDong Aisheng 	}
3232a24f2ceSDong Aisheng 
3242a24f2ceSDong Aisheng 	/* DAI clock inversion */
3252a24f2ceSDong Aisheng 	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
3262a24f2ceSDong Aisheng 	case SND_SOC_DAIFMT_IB_IF:
3272a24f2ceSDong Aisheng 		scr |= BM_SAIF_CTRL_BITCLK_EDGE;
3282a24f2ceSDong Aisheng 		scr |= BM_SAIF_CTRL_LRCLK_POLARITY;
3292a24f2ceSDong Aisheng 		break;
3302a24f2ceSDong Aisheng 	case SND_SOC_DAIFMT_IB_NF:
3312a24f2ceSDong Aisheng 		scr |= BM_SAIF_CTRL_BITCLK_EDGE;
3322a24f2ceSDong Aisheng 		scr &= ~BM_SAIF_CTRL_LRCLK_POLARITY;
3332a24f2ceSDong Aisheng 		break;
3342a24f2ceSDong Aisheng 	case SND_SOC_DAIFMT_NB_IF:
3352a24f2ceSDong Aisheng 		scr &= ~BM_SAIF_CTRL_BITCLK_EDGE;
3362a24f2ceSDong Aisheng 		scr |= BM_SAIF_CTRL_LRCLK_POLARITY;
3372a24f2ceSDong Aisheng 		break;
3382a24f2ceSDong Aisheng 	case SND_SOC_DAIFMT_NB_NF:
3392a24f2ceSDong Aisheng 		scr &= ~BM_SAIF_CTRL_BITCLK_EDGE;
3402a24f2ceSDong Aisheng 		scr &= ~BM_SAIF_CTRL_LRCLK_POLARITY;
3412a24f2ceSDong Aisheng 		break;
3422a24f2ceSDong Aisheng 	}
3432a24f2ceSDong Aisheng 
3442a24f2ceSDong Aisheng 	/*
3452a24f2ceSDong Aisheng 	 * Note: We simply just support master mode since SAIF TX can only
3462a24f2ceSDong Aisheng 	 * work as master.
34776067540SDong Aisheng 	 * Here the master is relative to codec side.
34876067540SDong Aisheng 	 * Saif internally could be slave when working on EXTMASTER mode.
34976067540SDong Aisheng 	 * We just hide this to machine driver.
3502a24f2ceSDong Aisheng 	 */
3512a24f2ceSDong Aisheng 	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
3522a24f2ceSDong Aisheng 	case SND_SOC_DAIFMT_CBS_CFS:
35376067540SDong Aisheng 		if (saif->id == saif->master_id)
3542a24f2ceSDong Aisheng 			scr &= ~BM_SAIF_CTRL_SLAVE_MODE;
35576067540SDong Aisheng 		else
35676067540SDong Aisheng 			scr |= BM_SAIF_CTRL_SLAVE_MODE;
35776067540SDong Aisheng 
3582a24f2ceSDong Aisheng 		__raw_writel(scr | scr0, saif->base + SAIF_CTRL);
3592a24f2ceSDong Aisheng 		break;
3602a24f2ceSDong Aisheng 	default:
3612a24f2ceSDong Aisheng 		return -EINVAL;
3622a24f2ceSDong Aisheng 	}
3632a24f2ceSDong Aisheng 
3642a24f2ceSDong Aisheng 	return 0;
3652a24f2ceSDong Aisheng }
3662a24f2ceSDong Aisheng 
3672a24f2ceSDong Aisheng static int mxs_saif_startup(struct snd_pcm_substream *substream,
3682a24f2ceSDong Aisheng 			   struct snd_soc_dai *cpu_dai)
3692a24f2ceSDong Aisheng {
3702a24f2ceSDong Aisheng 	struct mxs_saif *saif = snd_soc_dai_get_drvdata(cpu_dai);
3712a24f2ceSDong Aisheng 
3722a24f2ceSDong Aisheng 	/* clear error status to 0 for each re-open */
3732a24f2ceSDong Aisheng 	saif->fifo_underrun = 0;
3742a24f2ceSDong Aisheng 	saif->fifo_overrun = 0;
3752a24f2ceSDong Aisheng 
3762a24f2ceSDong Aisheng 	/* Clear Reset for normal operations */
3772a24f2ceSDong Aisheng 	__raw_writel(BM_SAIF_CTRL_SFTRST,
3782a24f2ceSDong Aisheng 		saif->base + SAIF_CTRL + MXS_CLR_ADDR);
3792a24f2ceSDong Aisheng 
380bbe8ff5eSDong Aisheng 	/* clear clock gate */
381bbe8ff5eSDong Aisheng 	__raw_writel(BM_SAIF_CTRL_CLKGATE,
382bbe8ff5eSDong Aisheng 		saif->base + SAIF_CTRL + MXS_CLR_ADDR);
383bbe8ff5eSDong Aisheng 
3842a24f2ceSDong Aisheng 	return 0;
3852a24f2ceSDong Aisheng }
3862a24f2ceSDong Aisheng 
3872a24f2ceSDong Aisheng /*
3882a24f2ceSDong Aisheng  * Should only be called when port is inactive.
3892a24f2ceSDong Aisheng  * although can be called multiple times by upper layers.
3902a24f2ceSDong Aisheng  */
3912a24f2ceSDong Aisheng static int mxs_saif_hw_params(struct snd_pcm_substream *substream,
3922a24f2ceSDong Aisheng 			     struct snd_pcm_hw_params *params,
3932a24f2ceSDong Aisheng 			     struct snd_soc_dai *cpu_dai)
3942a24f2ceSDong Aisheng {
3952a24f2ceSDong Aisheng 	struct mxs_saif *saif = snd_soc_dai_get_drvdata(cpu_dai);
396c2e1d907SDong Aisheng 	struct mxs_saif *master_saif;
3972a24f2ceSDong Aisheng 	u32 scr, stat;
3982a24f2ceSDong Aisheng 	int ret;
3992a24f2ceSDong Aisheng 
400c2e1d907SDong Aisheng 	master_saif = mxs_saif_get_master(saif);
401c2e1d907SDong Aisheng 	if (!master_saif)
402c2e1d907SDong Aisheng 		return -EINVAL;
403c2e1d907SDong Aisheng 
4042a24f2ceSDong Aisheng 	/* mclk should already be set */
4052a24f2ceSDong Aisheng 	if (!saif->mclk && saif->mclk_in_use) {
4062a24f2ceSDong Aisheng 		dev_err(cpu_dai->dev, "set mclk first\n");
4072a24f2ceSDong Aisheng 		return -EINVAL;
4082a24f2ceSDong Aisheng 	}
4092a24f2ceSDong Aisheng 
4102a24f2ceSDong Aisheng 	stat = __raw_readl(saif->base + SAIF_STAT);
4112a24f2ceSDong Aisheng 	if (stat & BM_SAIF_STAT_BUSY) {
4122a24f2ceSDong Aisheng 		dev_err(cpu_dai->dev, "error: busy\n");
4132a24f2ceSDong Aisheng 		return -EBUSY;
4142a24f2ceSDong Aisheng 	}
4152a24f2ceSDong Aisheng 
4162a24f2ceSDong Aisheng 	/*
4172a24f2ceSDong Aisheng 	 * Set saif clk based on sample rate.
4182a24f2ceSDong Aisheng 	 * If mclk is used, we also set mclk, if not, saif->mclk is
4192a24f2ceSDong Aisheng 	 * default 0, means not used.
4202a24f2ceSDong Aisheng 	 */
4212a24f2ceSDong Aisheng 	ret = mxs_saif_set_clk(saif, saif->mclk, params_rate(params));
4222a24f2ceSDong Aisheng 	if (ret) {
4232a24f2ceSDong Aisheng 		dev_err(cpu_dai->dev, "unable to get proper clk\n");
4242a24f2ceSDong Aisheng 		return ret;
4252a24f2ceSDong Aisheng 	}
4262a24f2ceSDong Aisheng 
427c2e1d907SDong Aisheng 	/* prepare clk in hw_param, enable in trigger */
428c2e1d907SDong Aisheng 	clk_prepare(saif->clk);
429d0ba4c01SDong Aisheng 	if (saif != master_saif) {
430d0ba4c01SDong Aisheng 		/*
431d0ba4c01SDong Aisheng 		* Set an initial clock rate for the saif internal logic to work
432d0ba4c01SDong Aisheng 		* properly. This is important when working in EXTMASTER mode
433d0ba4c01SDong Aisheng 		* that uses the other saif's BITCLK&LRCLK but it still needs a
434d0ba4c01SDong Aisheng 		* basic clock which should be fast enough for the internal
435d0ba4c01SDong Aisheng 		* logic.
436d0ba4c01SDong Aisheng 		*/
437d0ba4c01SDong Aisheng 		clk_enable(saif->clk);
438d0ba4c01SDong Aisheng 		ret = clk_set_rate(saif->clk, 24000000);
439d0ba4c01SDong Aisheng 		clk_disable(saif->clk);
440d0ba4c01SDong Aisheng 		if (ret)
441d0ba4c01SDong Aisheng 			return ret;
442d0ba4c01SDong Aisheng 
443c2e1d907SDong Aisheng 		clk_prepare(master_saif->clk);
444d0ba4c01SDong Aisheng 	}
445c2e1d907SDong Aisheng 
4462a24f2ceSDong Aisheng 	scr = __raw_readl(saif->base + SAIF_CTRL);
4472a24f2ceSDong Aisheng 
4482a24f2ceSDong Aisheng 	scr &= ~BM_SAIF_CTRL_WORD_LENGTH;
4492a24f2ceSDong Aisheng 	scr &= ~BM_SAIF_CTRL_BITCLK_48XFS_ENABLE;
4502a24f2ceSDong Aisheng 	switch (params_format(params)) {
4512a24f2ceSDong Aisheng 	case SNDRV_PCM_FORMAT_S16_LE:
4522a24f2ceSDong Aisheng 		scr |= BF_SAIF_CTRL_WORD_LENGTH(0);
4532a24f2ceSDong Aisheng 		break;
4542a24f2ceSDong Aisheng 	case SNDRV_PCM_FORMAT_S20_3LE:
4552a24f2ceSDong Aisheng 		scr |= BF_SAIF_CTRL_WORD_LENGTH(4);
4562a24f2ceSDong Aisheng 		scr |= BM_SAIF_CTRL_BITCLK_48XFS_ENABLE;
4572a24f2ceSDong Aisheng 		break;
4582a24f2ceSDong Aisheng 	case SNDRV_PCM_FORMAT_S24_LE:
4592a24f2ceSDong Aisheng 		scr |= BF_SAIF_CTRL_WORD_LENGTH(8);
4602a24f2ceSDong Aisheng 		scr |= BM_SAIF_CTRL_BITCLK_48XFS_ENABLE;
4612a24f2ceSDong Aisheng 		break;
4622a24f2ceSDong Aisheng 	default:
4632a24f2ceSDong Aisheng 		return -EINVAL;
4642a24f2ceSDong Aisheng 	}
4652a24f2ceSDong Aisheng 
4662a24f2ceSDong Aisheng 	/* Tx/Rx config */
4672a24f2ceSDong Aisheng 	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
4682a24f2ceSDong Aisheng 		/* enable TX mode */
4692a24f2ceSDong Aisheng 		scr &= ~BM_SAIF_CTRL_READ_MODE;
4702a24f2ceSDong Aisheng 	} else {
4712a24f2ceSDong Aisheng 		/* enable RX mode */
4722a24f2ceSDong Aisheng 		scr |= BM_SAIF_CTRL_READ_MODE;
4732a24f2ceSDong Aisheng 	}
4742a24f2ceSDong Aisheng 
4752a24f2ceSDong Aisheng 	__raw_writel(scr, saif->base + SAIF_CTRL);
4762a24f2ceSDong Aisheng 	return 0;
4772a24f2ceSDong Aisheng }
4782a24f2ceSDong Aisheng 
4792a24f2ceSDong Aisheng static int mxs_saif_prepare(struct snd_pcm_substream *substream,
4802a24f2ceSDong Aisheng 			   struct snd_soc_dai *cpu_dai)
4812a24f2ceSDong Aisheng {
4822a24f2ceSDong Aisheng 	struct mxs_saif *saif = snd_soc_dai_get_drvdata(cpu_dai);
4832a24f2ceSDong Aisheng 
4842a24f2ceSDong Aisheng 	/* enable FIFO error irqs */
4852a24f2ceSDong Aisheng 	__raw_writel(BM_SAIF_CTRL_FIFO_ERROR_IRQ_EN,
4862a24f2ceSDong Aisheng 		saif->base + SAIF_CTRL + MXS_SET_ADDR);
4872a24f2ceSDong Aisheng 
4882a24f2ceSDong Aisheng 	return 0;
4892a24f2ceSDong Aisheng }
4902a24f2ceSDong Aisheng 
4912a24f2ceSDong Aisheng static int mxs_saif_trigger(struct snd_pcm_substream *substream, int cmd,
4922a24f2ceSDong Aisheng 				struct snd_soc_dai *cpu_dai)
4932a24f2ceSDong Aisheng {
4942a24f2ceSDong Aisheng 	struct mxs_saif *saif = snd_soc_dai_get_drvdata(cpu_dai);
49576067540SDong Aisheng 	struct mxs_saif *master_saif;
49676067540SDong Aisheng 	u32 delay;
49776067540SDong Aisheng 
49876067540SDong Aisheng 	master_saif = mxs_saif_get_master(saif);
49976067540SDong Aisheng 	if (!master_saif)
50076067540SDong Aisheng 		return -EINVAL;
5012a24f2ceSDong Aisheng 
5022a24f2ceSDong Aisheng 	switch (cmd) {
5032a24f2ceSDong Aisheng 	case SNDRV_PCM_TRIGGER_START:
5042a24f2ceSDong Aisheng 	case SNDRV_PCM_TRIGGER_RESUME:
5052a24f2ceSDong Aisheng 	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
5062a24f2ceSDong Aisheng 		dev_dbg(cpu_dai->dev, "start\n");
5072a24f2ceSDong Aisheng 
50876067540SDong Aisheng 		clk_enable(master_saif->clk);
50976067540SDong Aisheng 		if (!master_saif->mclk_in_use)
51076067540SDong Aisheng 			__raw_writel(BM_SAIF_CTRL_RUN,
51176067540SDong Aisheng 				master_saif->base + SAIF_CTRL + MXS_SET_ADDR);
51276067540SDong Aisheng 
51376067540SDong Aisheng 		/*
51476067540SDong Aisheng 		 * If the saif's master is not himself, we also need to enable
51576067540SDong Aisheng 		 * itself clk for its internal basic logic to work.
51676067540SDong Aisheng 		 */
51776067540SDong Aisheng 		if (saif != master_saif) {
5182a24f2ceSDong Aisheng 			clk_enable(saif->clk);
5192a24f2ceSDong Aisheng 			__raw_writel(BM_SAIF_CTRL_RUN,
5202a24f2ceSDong Aisheng 				saif->base + SAIF_CTRL + MXS_SET_ADDR);
52176067540SDong Aisheng 		}
5222a24f2ceSDong Aisheng 
5232a24f2ceSDong Aisheng 		if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
5242a24f2ceSDong Aisheng 			/*
525f55f1475SFabio Estevam 			 * write data to saif data register to trigger
526f55f1475SFabio Estevam 			 * the transfer.
527f55f1475SFabio Estevam 			 * For 24-bit format the 32-bit FIFO register stores
528f55f1475SFabio Estevam 			 * only one channel, so we need to write twice.
529f55f1475SFabio Estevam 			 * This is also safe for the other non 24-bit formats.
5302a24f2ceSDong Aisheng 			 */
5312a24f2ceSDong Aisheng 			__raw_writel(0, saif->base + SAIF_DATA);
532f55f1475SFabio Estevam 			__raw_writel(0, saif->base + SAIF_DATA);
5332a24f2ceSDong Aisheng 		} else {
5342a24f2ceSDong Aisheng 			/*
535f55f1475SFabio Estevam 			 * read data from saif data register to trigger
536f55f1475SFabio Estevam 			 * the receive.
537f55f1475SFabio Estevam 			 * For 24-bit format the 32-bit FIFO register stores
538f55f1475SFabio Estevam 			 * only one channel, so we need to read twice.
539f55f1475SFabio Estevam 			 * This is also safe for the other non 24-bit formats.
5402a24f2ceSDong Aisheng 			 */
5412a24f2ceSDong Aisheng 			__raw_readl(saif->base + SAIF_DATA);
542f55f1475SFabio Estevam 			__raw_readl(saif->base + SAIF_DATA);
5432a24f2ceSDong Aisheng 		}
5442a24f2ceSDong Aisheng 
54576067540SDong Aisheng 		master_saif->ongoing = 1;
54676067540SDong Aisheng 
54776067540SDong Aisheng 		dev_dbg(saif->dev, "CTRL 0x%x STAT 0x%x\n",
5482a24f2ceSDong Aisheng 			__raw_readl(saif->base + SAIF_CTRL),
5492a24f2ceSDong Aisheng 			__raw_readl(saif->base + SAIF_STAT));
5502a24f2ceSDong Aisheng 
55176067540SDong Aisheng 		dev_dbg(master_saif->dev, "CTRL 0x%x STAT 0x%x\n",
55276067540SDong Aisheng 			__raw_readl(master_saif->base + SAIF_CTRL),
55376067540SDong Aisheng 			__raw_readl(master_saif->base + SAIF_STAT));
5542a24f2ceSDong Aisheng 		break;
5552a24f2ceSDong Aisheng 	case SNDRV_PCM_TRIGGER_SUSPEND:
5562a24f2ceSDong Aisheng 	case SNDRV_PCM_TRIGGER_STOP:
5572a24f2ceSDong Aisheng 	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
5582a24f2ceSDong Aisheng 		dev_dbg(cpu_dai->dev, "stop\n");
5592a24f2ceSDong Aisheng 
56076067540SDong Aisheng 		/* wait a while for the current sample to complete */
56176067540SDong Aisheng 		delay = USEC_PER_SEC / master_saif->cur_rate;
56276067540SDong Aisheng 
56376067540SDong Aisheng 		if (!master_saif->mclk_in_use) {
56476067540SDong Aisheng 			__raw_writel(BM_SAIF_CTRL_RUN,
56576067540SDong Aisheng 				master_saif->base + SAIF_CTRL + MXS_CLR_ADDR);
56676067540SDong Aisheng 			udelay(delay);
56776067540SDong Aisheng 		}
56876067540SDong Aisheng 		clk_disable(master_saif->clk);
56976067540SDong Aisheng 
57076067540SDong Aisheng 		if (saif != master_saif) {
5712a24f2ceSDong Aisheng 			__raw_writel(BM_SAIF_CTRL_RUN,
5722a24f2ceSDong Aisheng 				saif->base + SAIF_CTRL + MXS_CLR_ADDR);
57376067540SDong Aisheng 			udelay(delay);
57476067540SDong Aisheng 			clk_disable(saif->clk);
57576067540SDong Aisheng 		}
57676067540SDong Aisheng 
57776067540SDong Aisheng 		master_saif->ongoing = 0;
5782a24f2ceSDong Aisheng 
5792a24f2ceSDong Aisheng 		break;
5802a24f2ceSDong Aisheng 	default:
5812a24f2ceSDong Aisheng 		return -EINVAL;
5822a24f2ceSDong Aisheng 	}
5832a24f2ceSDong Aisheng 
5842a24f2ceSDong Aisheng 	return 0;
5852a24f2ceSDong Aisheng }
5862a24f2ceSDong Aisheng 
5872a24f2ceSDong Aisheng #define MXS_SAIF_RATES		SNDRV_PCM_RATE_8000_192000
5882a24f2ceSDong Aisheng #define MXS_SAIF_FORMATS \
5892a24f2ceSDong Aisheng 	(SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
5902a24f2ceSDong Aisheng 	SNDRV_PCM_FMTBIT_S24_LE)
5912a24f2ceSDong Aisheng 
59285e7652dSLars-Peter Clausen static const struct snd_soc_dai_ops mxs_saif_dai_ops = {
5932a24f2ceSDong Aisheng 	.startup = mxs_saif_startup,
5942a24f2ceSDong Aisheng 	.trigger = mxs_saif_trigger,
5952a24f2ceSDong Aisheng 	.prepare = mxs_saif_prepare,
5962a24f2ceSDong Aisheng 	.hw_params = mxs_saif_hw_params,
5972a24f2ceSDong Aisheng 	.set_sysclk = mxs_saif_set_dai_sysclk,
5982a24f2ceSDong Aisheng 	.set_fmt = mxs_saif_set_dai_fmt,
5992a24f2ceSDong Aisheng };
6002a24f2ceSDong Aisheng 
6012a24f2ceSDong Aisheng static int mxs_saif_dai_probe(struct snd_soc_dai *dai)
6022a24f2ceSDong Aisheng {
6032a24f2ceSDong Aisheng 	struct mxs_saif *saif = dev_get_drvdata(dai->dev);
6042a24f2ceSDong Aisheng 
6052a24f2ceSDong Aisheng 	snd_soc_dai_set_drvdata(dai, saif);
6062a24f2ceSDong Aisheng 
6072a24f2ceSDong Aisheng 	return 0;
6082a24f2ceSDong Aisheng }
6092a24f2ceSDong Aisheng 
6102a24f2ceSDong Aisheng static struct snd_soc_dai_driver mxs_saif_dai = {
6112a24f2ceSDong Aisheng 	.name = "mxs-saif",
6122a24f2ceSDong Aisheng 	.probe = mxs_saif_dai_probe,
6132a24f2ceSDong Aisheng 	.playback = {
6142a24f2ceSDong Aisheng 		.channels_min = 2,
6152a24f2ceSDong Aisheng 		.channels_max = 2,
6162a24f2ceSDong Aisheng 		.rates = MXS_SAIF_RATES,
6172a24f2ceSDong Aisheng 		.formats = MXS_SAIF_FORMATS,
6182a24f2ceSDong Aisheng 	},
6192a24f2ceSDong Aisheng 	.capture = {
6202a24f2ceSDong Aisheng 		.channels_min = 2,
6212a24f2ceSDong Aisheng 		.channels_max = 2,
6222a24f2ceSDong Aisheng 		.rates = MXS_SAIF_RATES,
6232a24f2ceSDong Aisheng 		.formats = MXS_SAIF_FORMATS,
6242a24f2ceSDong Aisheng 	},
6252a24f2ceSDong Aisheng 	.ops = &mxs_saif_dai_ops,
6262a24f2ceSDong Aisheng };
6272a24f2ceSDong Aisheng 
628026240bbSKuninori Morimoto static const struct snd_soc_component_driver mxs_saif_component = {
629026240bbSKuninori Morimoto 	.name		= "mxs-saif",
630026240bbSKuninori Morimoto };
631026240bbSKuninori Morimoto 
6322a24f2ceSDong Aisheng static irqreturn_t mxs_saif_irq(int irq, void *dev_id)
6332a24f2ceSDong Aisheng {
6342a24f2ceSDong Aisheng 	struct mxs_saif *saif = dev_id;
6352a24f2ceSDong Aisheng 	unsigned int stat;
6362a24f2ceSDong Aisheng 
6372a24f2ceSDong Aisheng 	stat = __raw_readl(saif->base + SAIF_STAT);
6382a24f2ceSDong Aisheng 	if (!(stat & (BM_SAIF_STAT_FIFO_UNDERFLOW_IRQ |
6392a24f2ceSDong Aisheng 			BM_SAIF_STAT_FIFO_OVERFLOW_IRQ)))
6402a24f2ceSDong Aisheng 		return IRQ_NONE;
6412a24f2ceSDong Aisheng 
6422a24f2ceSDong Aisheng 	if (stat & BM_SAIF_STAT_FIFO_UNDERFLOW_IRQ) {
6432a24f2ceSDong Aisheng 		dev_dbg(saif->dev, "underrun!!! %d\n", ++saif->fifo_underrun);
6442a24f2ceSDong Aisheng 		__raw_writel(BM_SAIF_STAT_FIFO_UNDERFLOW_IRQ,
6452a24f2ceSDong Aisheng 				saif->base + SAIF_STAT + MXS_CLR_ADDR);
6462a24f2ceSDong Aisheng 	}
6472a24f2ceSDong Aisheng 
6482a24f2ceSDong Aisheng 	if (stat & BM_SAIF_STAT_FIFO_OVERFLOW_IRQ) {
6492a24f2ceSDong Aisheng 		dev_dbg(saif->dev, "overrun!!! %d\n", ++saif->fifo_overrun);
6502a24f2ceSDong Aisheng 		__raw_writel(BM_SAIF_STAT_FIFO_OVERFLOW_IRQ,
6512a24f2ceSDong Aisheng 				saif->base + SAIF_STAT + MXS_CLR_ADDR);
6522a24f2ceSDong Aisheng 	}
6532a24f2ceSDong Aisheng 
6542a24f2ceSDong Aisheng 	dev_dbg(saif->dev, "SAIF_CTRL %x SAIF_STAT %x\n",
6552a24f2ceSDong Aisheng 	       __raw_readl(saif->base + SAIF_CTRL),
6562a24f2ceSDong Aisheng 	       __raw_readl(saif->base + SAIF_STAT));
6572a24f2ceSDong Aisheng 
6582a24f2ceSDong Aisheng 	return IRQ_HANDLED;
6592a24f2ceSDong Aisheng }
6602a24f2ceSDong Aisheng 
661fd582736SBill Pemberton static int mxs_saif_probe(struct platform_device *pdev)
6622a24f2ceSDong Aisheng {
66308641c7cSShawn Guo 	struct device_node *np = pdev->dev.of_node;
66462477adfSShawn Guo 	struct resource *iores;
6652a24f2ceSDong Aisheng 	struct mxs_saif *saif;
6662a24f2ceSDong Aisheng 	int ret = 0;
6674498a3caSFabio Estevam 	struct device_node *master;
6682a24f2ceSDong Aisheng 
6694498a3caSFabio Estevam 	if (!np)
6700bb98ba2SJulia Lawall 		return -EINVAL;
6710bb98ba2SJulia Lawall 
672830eb876SJulia Lawall 	saif = devm_kzalloc(&pdev->dev, sizeof(*saif), GFP_KERNEL);
6732a24f2ceSDong Aisheng 	if (!saif)
6742a24f2ceSDong Aisheng 		return -ENOMEM;
6752a24f2ceSDong Aisheng 
676324a7fb0SFabio Estevam 	ret = of_alias_get_id(np, "saif");
677324a7fb0SFabio Estevam 	if (ret < 0)
678324a7fb0SFabio Estevam 		return ret;
679324a7fb0SFabio Estevam 	else
680324a7fb0SFabio Estevam 		saif->id = ret;
681324a7fb0SFabio Estevam 
68208641c7cSShawn Guo 	/*
68308641c7cSShawn Guo 	 * If there is no "fsl,saif-master" phandle, it's a saif
68408641c7cSShawn Guo 	 * master.  Otherwise, it's a slave and its phandle points
68508641c7cSShawn Guo 	 * to the master.
68608641c7cSShawn Guo 	 */
68708641c7cSShawn Guo 	master = of_parse_phandle(np, "fsl,saif-master", 0);
68808641c7cSShawn Guo 	if (!master) {
68908641c7cSShawn Guo 		saif->master_id = saif->id;
69008641c7cSShawn Guo 	} else {
691324a7fb0SFabio Estevam 		ret = of_alias_get_id(master, "saif");
692324a7fb0SFabio Estevam 		if (ret < 0)
693324a7fb0SFabio Estevam 			return ret;
694324a7fb0SFabio Estevam 		else
695324a7fb0SFabio Estevam 			saif->master_id = ret;
69608641c7cSShawn Guo 	}
69708641c7cSShawn Guo 
698324a7fb0SFabio Estevam 	if (saif->master_id >= ARRAY_SIZE(mxs_saif)) {
69977882580SDong Aisheng 		dev_err(&pdev->dev, "get wrong master id\n");
70076067540SDong Aisheng 		return -EINVAL;
70176067540SDong Aisheng 	}
70208641c7cSShawn Guo 
70308641c7cSShawn Guo 	mxs_saif[saif->id] = saif;
7042a24f2ceSDong Aisheng 
705730963f8SFabio Estevam 	saif->clk = devm_clk_get(&pdev->dev, NULL);
7062a24f2ceSDong Aisheng 	if (IS_ERR(saif->clk)) {
7072a24f2ceSDong Aisheng 		ret = PTR_ERR(saif->clk);
7082a24f2ceSDong Aisheng 		dev_err(&pdev->dev, "Cannot get the clock: %d\n",
7092a24f2ceSDong Aisheng 			ret);
710830eb876SJulia Lawall 		return ret;
7112a24f2ceSDong Aisheng 	}
7122a24f2ceSDong Aisheng 
713226d0f22SJulia Lawall 	iores = platform_get_resource(pdev, IORESOURCE_MEM, 0);
7142a24f2ceSDong Aisheng 
715b25b5aa0SThierry Reding 	saif->base = devm_ioremap_resource(&pdev->dev, iores);
716b25b5aa0SThierry Reding 	if (IS_ERR(saif->base))
717b25b5aa0SThierry Reding 		return PTR_ERR(saif->base);
7182a24f2ceSDong Aisheng 
7192a24f2ceSDong Aisheng 	saif->irq = platform_get_irq(pdev, 0);
7202a24f2ceSDong Aisheng 	if (saif->irq < 0) {
7212a24f2ceSDong Aisheng 		ret = saif->irq;
7222a24f2ceSDong Aisheng 		dev_err(&pdev->dev, "failed to get irq resource: %d\n",
7232a24f2ceSDong Aisheng 			ret);
724730963f8SFabio Estevam 		return ret;
7252a24f2ceSDong Aisheng 	}
7262a24f2ceSDong Aisheng 
7272a24f2ceSDong Aisheng 	saif->dev = &pdev->dev;
728830eb876SJulia Lawall 	ret = devm_request_irq(&pdev->dev, saif->irq, mxs_saif_irq, 0,
729830eb876SJulia Lawall 			       "mxs-saif", saif);
7302a24f2ceSDong Aisheng 	if (ret) {
7312a24f2ceSDong Aisheng 		dev_err(&pdev->dev, "failed to request irq\n");
732730963f8SFabio Estevam 		return ret;
7332a24f2ceSDong Aisheng 	}
7342a24f2ceSDong Aisheng 
7352a24f2ceSDong Aisheng 	platform_set_drvdata(pdev, saif);
7362a24f2ceSDong Aisheng 
737026240bbSKuninori Morimoto 	ret = snd_soc_register_component(&pdev->dev, &mxs_saif_component,
738026240bbSKuninori Morimoto 					 &mxs_saif_dai, 1);
7392a24f2ceSDong Aisheng 	if (ret) {
7402a24f2ceSDong Aisheng 		dev_err(&pdev->dev, "register DAI failed\n");
741730963f8SFabio Estevam 		return ret;
7422a24f2ceSDong Aisheng 	}
7432a24f2ceSDong Aisheng 
7444da3fe78SShawn Guo 	ret = mxs_pcm_platform_register(&pdev->dev);
7452a24f2ceSDong Aisheng 	if (ret) {
7464da3fe78SShawn Guo 		dev_err(&pdev->dev, "register PCM failed: %d\n", ret);
7474da3fe78SShawn Guo 		goto failed_pdev_alloc;
7482a24f2ceSDong Aisheng 	}
7492a24f2ceSDong Aisheng 
7502a24f2ceSDong Aisheng 	return 0;
7512a24f2ceSDong Aisheng 
7522a24f2ceSDong Aisheng failed_pdev_alloc:
753026240bbSKuninori Morimoto 	snd_soc_unregister_component(&pdev->dev);
7542a24f2ceSDong Aisheng 
7552a24f2ceSDong Aisheng 	return ret;
7562a24f2ceSDong Aisheng }
7572a24f2ceSDong Aisheng 
758fd582736SBill Pemberton static int mxs_saif_remove(struct platform_device *pdev)
7592a24f2ceSDong Aisheng {
7604da3fe78SShawn Guo 	mxs_pcm_platform_unregister(&pdev->dev);
761026240bbSKuninori Morimoto 	snd_soc_unregister_component(&pdev->dev);
7622a24f2ceSDong Aisheng 
7632a24f2ceSDong Aisheng 	return 0;
7642a24f2ceSDong Aisheng }
7652a24f2ceSDong Aisheng 
76608641c7cSShawn Guo static const struct of_device_id mxs_saif_dt_ids[] = {
76708641c7cSShawn Guo 	{ .compatible = "fsl,imx28-saif", },
76808641c7cSShawn Guo 	{ /* sentinel */ }
76908641c7cSShawn Guo };
77008641c7cSShawn Guo MODULE_DEVICE_TABLE(of, mxs_saif_dt_ids);
77108641c7cSShawn Guo 
7722a24f2ceSDong Aisheng static struct platform_driver mxs_saif_driver = {
7732a24f2ceSDong Aisheng 	.probe = mxs_saif_probe,
774fd582736SBill Pemberton 	.remove = mxs_saif_remove,
7752a24f2ceSDong Aisheng 
7762a24f2ceSDong Aisheng 	.driver = {
7772a24f2ceSDong Aisheng 		.name = "mxs-saif",
7782a24f2ceSDong Aisheng 		.owner = THIS_MODULE,
77908641c7cSShawn Guo 		.of_match_table = mxs_saif_dt_ids,
7802a24f2ceSDong Aisheng 	},
7812a24f2ceSDong Aisheng };
7822a24f2ceSDong Aisheng 
78385aa0960SAxel Lin module_platform_driver(mxs_saif_driver);
7842a24f2ceSDong Aisheng 
7852a24f2ceSDong Aisheng MODULE_AUTHOR("Freescale Semiconductor, Inc.");
7862a24f2ceSDong Aisheng MODULE_DESCRIPTION("MXS ASoC SAIF driver");
7872a24f2ceSDong Aisheng MODULE_LICENSE("GPL");
7889f4c3f1cSFabio Estevam MODULE_ALIAS("platform:mxs-saif");
789