xref: /openbmc/linux/sound/soc/sh/rcar/src.c (revision ab2049f9de72c901c07eec25eff74dae2e82df7e)
1ba9c949fSKuninori Morimoto /*
2ba9c949fSKuninori Morimoto  * Renesas R-Car SRC support
3ba9c949fSKuninori Morimoto  *
4ba9c949fSKuninori Morimoto  * Copyright (C) 2013 Renesas Solutions Corp.
5ba9c949fSKuninori Morimoto  * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
6ba9c949fSKuninori Morimoto  *
7ba9c949fSKuninori Morimoto  * This program is free software; you can redistribute it and/or modify
8ba9c949fSKuninori Morimoto  * it under the terms of the GNU General Public License version 2 as
9ba9c949fSKuninori Morimoto  * published by the Free Software Foundation.
10ba9c949fSKuninori Morimoto  */
11ba9c949fSKuninori Morimoto #include "rsnd.h"
12ba9c949fSKuninori Morimoto 
138aefda50SKuninori Morimoto #define SRC_NAME "src"
148aefda50SKuninori Morimoto 
15cfcefe01SKuninori Morimoto /* SRCx_STATUS */
16cfcefe01SKuninori Morimoto #define OUF_SRCO	((1 << 12) | (1 << 13))
17cfcefe01SKuninori Morimoto #define OUF_SRCI	((1 <<  9) | (1 <<  8))
18cfcefe01SKuninori Morimoto 
19cfcefe01SKuninori Morimoto /* SCU_SYSTEM_STATUS0/1 */
20cfcefe01SKuninori Morimoto #define OUF_SRC(id)	((1 << (id + 16)) | (1 << id))
21cfcefe01SKuninori Morimoto 
22ba9c949fSKuninori Morimoto struct rsnd_src {
23ba9c949fSKuninori Morimoto 	struct rsnd_mod mod;
24940e9479SKuninori Morimoto 	struct rsnd_mod *dma;
2543cb6954SKuninori Morimoto 	struct rsnd_kctrl_cfg_s sen;  /* sync convert enable */
2643cb6954SKuninori Morimoto 	struct rsnd_kctrl_cfg_s sync; /* sync convert */
273b7843ffSKuninori Morimoto 	u32 convert_rate; /* sampling rate convert */
28adf6a681SKuninori Morimoto 	int irq;
29ba9c949fSKuninori Morimoto };
30ba9c949fSKuninori Morimoto 
31ba9c949fSKuninori Morimoto #define RSND_SRC_NAME_SIZE 16
32ba9c949fSKuninori Morimoto 
33adf6a681SKuninori Morimoto #define rsnd_src_get(priv, id) ((struct rsnd_src *)(priv->src) + id)
34232c00b6SKuninori Morimoto #define rsnd_src_to_dma(src) ((src)->dma)
35da599fd3SKuninori Morimoto #define rsnd_src_nr(priv) ((priv)->src_nr)
36*ab2049f9SKuninori Morimoto #define rsnd_src_sync_is_enabled(mod) (rsnd_mod_to_src(mod)->sen.val)
3782e76ed3SKuninori Morimoto 
38ba9c949fSKuninori Morimoto #define rsnd_mod_to_src(_mod)				\
39ba9c949fSKuninori Morimoto 	container_of((_mod), struct rsnd_src, mod)
40ba9c949fSKuninori Morimoto 
41ba9c949fSKuninori Morimoto #define for_each_rsnd_src(pos, priv, i)				\
42ba9c949fSKuninori Morimoto 	for ((i) = 0;						\
43ba9c949fSKuninori Morimoto 	     ((i) < rsnd_src_nr(priv)) &&			\
44ba9c949fSKuninori Morimoto 	     ((pos) = (struct rsnd_src *)(priv)->src + i);	\
45ba9c949fSKuninori Morimoto 	     i++)
46ba9c949fSKuninori Morimoto 
47ba9c949fSKuninori Morimoto 
48ba9c949fSKuninori Morimoto /*
49ba9c949fSKuninori Morimoto  *		image of SRC (Sampling Rate Converter)
50ba9c949fSKuninori Morimoto  *
51ba9c949fSKuninori Morimoto  * 96kHz   <-> +-----+	48kHz	+-----+	 48kHz	+-------+
52ba9c949fSKuninori Morimoto  * 48kHz   <-> | SRC | <------>	| SSI |	<----->	| codec |
53ba9c949fSKuninori Morimoto  * 44.1kHz <-> +-----+		+-----+		+-------+
54ba9c949fSKuninori Morimoto  * ...
55ba9c949fSKuninori Morimoto  *
56ba9c949fSKuninori Morimoto  */
57ba9c949fSKuninori Morimoto 
58ba9c949fSKuninori Morimoto /*
59ba9c949fSKuninori Morimoto  * src.c is caring...
60ba9c949fSKuninori Morimoto  *
61ba9c949fSKuninori Morimoto  * Gen1
62ba9c949fSKuninori Morimoto  *
63ba9c949fSKuninori Morimoto  * [mem] -> [SRU] -> [SSI]
64ba9c949fSKuninori Morimoto  *        |--------|
65ba9c949fSKuninori Morimoto  *
66ba9c949fSKuninori Morimoto  * Gen2
67ba9c949fSKuninori Morimoto  *
68ba9c949fSKuninori Morimoto  * [mem] -> [SRC] -> [SSIU] -> [SSI]
69ba9c949fSKuninori Morimoto  *        |-----------------|
70ba9c949fSKuninori Morimoto  */
71ba9c949fSKuninori Morimoto 
7298efeeaeSKuninori Morimoto static void rsnd_src_activation(struct rsnd_mod *mod)
73379febfdSKuninori Morimoto {
74379febfdSKuninori Morimoto 	rsnd_mod_write(mod, SRC_SWRSR, 0);
75379febfdSKuninori Morimoto 	rsnd_mod_write(mod, SRC_SWRSR, 1);
76379febfdSKuninori Morimoto }
77379febfdSKuninori Morimoto 
78475a361aSKuninori Morimoto static void rsnd_src_halt(struct rsnd_mod *mod)
79475a361aSKuninori Morimoto {
80475a361aSKuninori Morimoto 	rsnd_mod_write(mod, SRC_SRCIR, 1);
81475a361aSKuninori Morimoto 	rsnd_mod_write(mod, SRC_SWRSR, 0);
82475a361aSKuninori Morimoto }
83475a361aSKuninori Morimoto 
849b99e9a7SKuninori Morimoto static struct dma_chan *rsnd_src_dma_req(struct rsnd_dai_stream *io,
859b99e9a7SKuninori Morimoto 					 struct rsnd_mod *mod)
8672adc61fSKuninori Morimoto {
8772adc61fSKuninori Morimoto 	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
8872adc61fSKuninori Morimoto 	int is_play = rsnd_io_is_play(io);
8972adc61fSKuninori Morimoto 
9072adc61fSKuninori Morimoto 	return rsnd_dma_request_channel(rsnd_src_of_node(priv),
9172adc61fSKuninori Morimoto 					mod,
9272adc61fSKuninori Morimoto 					is_play ? "rx" : "tx");
9372adc61fSKuninori Morimoto }
9472adc61fSKuninori Morimoto 
9588c61cffSKuninori Morimoto static u32 rsnd_src_convert_rate(struct rsnd_dai_stream *io,
961a9be9eeSKuninori Morimoto 				 struct rsnd_mod *mod)
9743cb6954SKuninori Morimoto {
9843cb6954SKuninori Morimoto 	struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
991a9be9eeSKuninori Morimoto 	struct rsnd_src *src = rsnd_mod_to_src(mod);
10043cb6954SKuninori Morimoto 	u32 convert_rate;
10143cb6954SKuninori Morimoto 
10243cb6954SKuninori Morimoto 	if (!runtime)
10343cb6954SKuninori Morimoto 		return 0;
10443cb6954SKuninori Morimoto 
105*ab2049f9SKuninori Morimoto 	if (!rsnd_src_sync_is_enabled(mod))
10643cb6954SKuninori Morimoto 		return src->convert_rate;
10743cb6954SKuninori Morimoto 
10843cb6954SKuninori Morimoto 	convert_rate = src->sync.val;
10943cb6954SKuninori Morimoto 
11043cb6954SKuninori Morimoto 	if (!convert_rate)
11143cb6954SKuninori Morimoto 		convert_rate = src->convert_rate;
11243cb6954SKuninori Morimoto 
11343cb6954SKuninori Morimoto 	if (!convert_rate)
11443cb6954SKuninori Morimoto 		convert_rate = runtime->rate;
11543cb6954SKuninori Morimoto 
11643cb6954SKuninori Morimoto 	return convert_rate;
11743cb6954SKuninori Morimoto }
11843cb6954SKuninori Morimoto 
119ba9c949fSKuninori Morimoto unsigned int rsnd_src_get_ssi_rate(struct rsnd_priv *priv,
120ba9c949fSKuninori Morimoto 				   struct rsnd_dai_stream *io,
121ba9c949fSKuninori Morimoto 				   struct snd_pcm_runtime *runtime)
122ba9c949fSKuninori Morimoto {
123b1eac430SKuninori Morimoto 	struct rsnd_mod *src_mod = rsnd_io_to_mod_src(io);
124b1eac430SKuninori Morimoto 	unsigned int rate = 0;
125ba9c949fSKuninori Morimoto 
126ba9c949fSKuninori Morimoto 	/*
127ba9c949fSKuninori Morimoto 	 * return convert rate if SRC is used,
128ba9c949fSKuninori Morimoto 	 * otherwise, return runtime->rate as usual
129ba9c949fSKuninori Morimoto 	 */
1301a9be9eeSKuninori Morimoto 	if (src_mod)
1311a9be9eeSKuninori Morimoto 		rate = rsnd_src_convert_rate(io, src_mod);
132b1eac430SKuninori Morimoto 
133ba9c949fSKuninori Morimoto 	if (!rate)
134ba9c949fSKuninori Morimoto 		rate = runtime->rate;
135ba9c949fSKuninori Morimoto 
136ba9c949fSKuninori Morimoto 	return rate;
137ba9c949fSKuninori Morimoto }
138ba9c949fSKuninori Morimoto 
1393b7843ffSKuninori Morimoto static int rsnd_src_hw_params(struct rsnd_mod *mod,
1402c0fac19SKuninori Morimoto 			      struct rsnd_dai_stream *io,
1413b7843ffSKuninori Morimoto 			      struct snd_pcm_substream *substream,
1423b7843ffSKuninori Morimoto 			      struct snd_pcm_hw_params *fe_params)
1433b7843ffSKuninori Morimoto {
1443b7843ffSKuninori Morimoto 	struct rsnd_src *src = rsnd_mod_to_src(mod);
1453b7843ffSKuninori Morimoto 	struct snd_soc_pcm_runtime *fe = substream->private_data;
1463b7843ffSKuninori Morimoto 
1473b7843ffSKuninori Morimoto 	/*
1483b7843ffSKuninori Morimoto 	 * SRC assumes that it is used under DPCM if user want to use
1493b7843ffSKuninori Morimoto 	 * sampling rate convert. Then, SRC should be FE.
1503b7843ffSKuninori Morimoto 	 * And then, this function will be called *after* BE settings.
1513b7843ffSKuninori Morimoto 	 * this means, each BE already has fixuped hw_params.
1523b7843ffSKuninori Morimoto 	 * see
1533b7843ffSKuninori Morimoto 	 *	dpcm_fe_dai_hw_params()
1543b7843ffSKuninori Morimoto 	 *	dpcm_be_dai_hw_params()
1553b7843ffSKuninori Morimoto 	 */
1563b7843ffSKuninori Morimoto 	if (fe->dai_link->dynamic) {
1573b7843ffSKuninori Morimoto 		int stream = substream->stream;
1583b7843ffSKuninori Morimoto 		struct snd_soc_dpcm *dpcm;
1593b7843ffSKuninori Morimoto 		struct snd_pcm_hw_params *be_params;
1603b7843ffSKuninori Morimoto 
1613b7843ffSKuninori Morimoto 		list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1623b7843ffSKuninori Morimoto 			be_params = &dpcm->hw_params;
1633b7843ffSKuninori Morimoto 
1643b7843ffSKuninori Morimoto 			if (params_rate(fe_params) != params_rate(be_params))
1653b7843ffSKuninori Morimoto 				src->convert_rate = params_rate(be_params);
1663b7843ffSKuninori Morimoto 		}
1673b7843ffSKuninori Morimoto 	}
1683b7843ffSKuninori Morimoto 
1693b7843ffSKuninori Morimoto 	return 0;
1703b7843ffSKuninori Morimoto }
1713b7843ffSKuninori Morimoto 
17275916f65SKuninori Morimoto static void rsnd_src_set_convert_rate(struct rsnd_dai_stream *io,
17375916f65SKuninori Morimoto 				      struct rsnd_mod *mod)
174ba9c949fSKuninori Morimoto {
17575916f65SKuninori Morimoto 	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
176cfcefe01SKuninori Morimoto 	struct device *dev = rsnd_priv_to_dev(priv);
17775916f65SKuninori Morimoto 	struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
1781a9be9eeSKuninori Morimoto 	u32 convert_rate = rsnd_src_convert_rate(io, mod);
17975916f65SKuninori Morimoto 	u32 ifscr, fsrate, adinr;
18075916f65SKuninori Morimoto 	u32 cr, route;
18175916f65SKuninori Morimoto 	u32 bsdsr, bsisr;
18275916f65SKuninori Morimoto 	uint ratio;
183ba9c949fSKuninori Morimoto 
18475916f65SKuninori Morimoto 	if (!runtime)
18575916f65SKuninori Morimoto 		return;
186ba9c949fSKuninori Morimoto 
18775916f65SKuninori Morimoto 	/* 6 - 1/6 are very enough ratio for SRC_BSDSR */
18875916f65SKuninori Morimoto 	if (!convert_rate)
18975916f65SKuninori Morimoto 		ratio = 0;
19075916f65SKuninori Morimoto 	else if (convert_rate > runtime->rate)
19175916f65SKuninori Morimoto 		ratio = 100 * convert_rate / runtime->rate;
19275916f65SKuninori Morimoto 	else
19375916f65SKuninori Morimoto 		ratio = 100 * runtime->rate / convert_rate;
194cfcefe01SKuninori Morimoto 
19575916f65SKuninori Morimoto 	if (ratio > 600) {
19675916f65SKuninori Morimoto 		dev_err(dev, "FSO/FSI ratio error\n");
19775916f65SKuninori Morimoto 		return;
198ba9c949fSKuninori Morimoto 	}
199ba9c949fSKuninori Morimoto 
200ba9c949fSKuninori Morimoto 	/*
20175916f65SKuninori Morimoto 	 *	SRC_ADINR
202ba9c949fSKuninori Morimoto 	 */
203c45f7263SKuninori Morimoto 	adinr = rsnd_get_adinr_bit(mod, io) |
204eed76bb8SKuninori Morimoto 		rsnd_runtime_channel_original(io);
20575916f65SKuninori Morimoto 
20675916f65SKuninori Morimoto 	/*
20775916f65SKuninori Morimoto 	 *	SRC_IFSCR / SRC_IFSVR
20875916f65SKuninori Morimoto 	 */
20975916f65SKuninori Morimoto 	ifscr = 0;
21075916f65SKuninori Morimoto 	fsrate = 0;
21175916f65SKuninori Morimoto 	if (convert_rate) {
21275916f65SKuninori Morimoto 		ifscr = 1;
21375916f65SKuninori Morimoto 		fsrate = 0x0400000 / convert_rate * runtime->rate;
21475916f65SKuninori Morimoto 	}
21575916f65SKuninori Morimoto 
21675916f65SKuninori Morimoto 	/*
21775916f65SKuninori Morimoto 	 *	SRC_SRCCR / SRC_ROUTE_MODE0
21875916f65SKuninori Morimoto 	 */
21975916f65SKuninori Morimoto 	cr	= 0x00011110;
22075916f65SKuninori Morimoto 	route	= 0x0;
22175916f65SKuninori Morimoto 	if (convert_rate) {
22275916f65SKuninori Morimoto 		route	= 0x1;
22375916f65SKuninori Morimoto 
224*ab2049f9SKuninori Morimoto 		if (rsnd_src_sync_is_enabled(mod)) {
22575916f65SKuninori Morimoto 			cr |= 0x1;
22675916f65SKuninori Morimoto 			route |= rsnd_io_is_play(io) ?
22775916f65SKuninori Morimoto 				(0x1 << 24) : (0x1 << 25);
22875916f65SKuninori Morimoto 		}
22975916f65SKuninori Morimoto 	}
23075916f65SKuninori Morimoto 
23175916f65SKuninori Morimoto 	/*
23275916f65SKuninori Morimoto 	 * SRC_BSDSR / SRC_BSISR
23375916f65SKuninori Morimoto 	 */
23475916f65SKuninori Morimoto 	switch (rsnd_mod_id(mod)) {
23575916f65SKuninori Morimoto 	case 5:
23675916f65SKuninori Morimoto 	case 6:
23775916f65SKuninori Morimoto 	case 7:
23875916f65SKuninori Morimoto 	case 8:
23975916f65SKuninori Morimoto 		bsdsr = 0x02400000; /* 6 - 1/6 */
24075916f65SKuninori Morimoto 		bsisr = 0x00100060; /* 6 - 1/6 */
24175916f65SKuninori Morimoto 		break;
24275916f65SKuninori Morimoto 	default:
24375916f65SKuninori Morimoto 		bsdsr = 0x01800000; /* 6 - 1/6 */
24475916f65SKuninori Morimoto 		bsisr = 0x00100060 ;/* 6 - 1/6 */
24575916f65SKuninori Morimoto 		break;
24675916f65SKuninori Morimoto 	}
24775916f65SKuninori Morimoto 
2480fbab951SKuninori Morimoto 	rsnd_mod_write(mod, SRC_ROUTE_MODE0, route);
2490fbab951SKuninori Morimoto 
25075916f65SKuninori Morimoto 	rsnd_mod_write(mod, SRC_SRCIR, 1);	/* initialize */
25175916f65SKuninori Morimoto 	rsnd_mod_write(mod, SRC_ADINR, adinr);
25275916f65SKuninori Morimoto 	rsnd_mod_write(mod, SRC_IFSCR, ifscr);
25375916f65SKuninori Morimoto 	rsnd_mod_write(mod, SRC_IFSVR, fsrate);
25475916f65SKuninori Morimoto 	rsnd_mod_write(mod, SRC_SRCCR, cr);
25575916f65SKuninori Morimoto 	rsnd_mod_write(mod, SRC_BSDSR, bsdsr);
25675916f65SKuninori Morimoto 	rsnd_mod_write(mod, SRC_BSISR, bsisr);
25775916f65SKuninori Morimoto 	rsnd_mod_write(mod, SRC_SRCIR, 0);	/* cancel initialize */
25875916f65SKuninori Morimoto 
259bf4e8d7cSKuninori Morimoto 	rsnd_mod_write(mod, SRC_I_BUSIF_MODE, 1);
260bf4e8d7cSKuninori Morimoto 	rsnd_mod_write(mod, SRC_O_BUSIF_MODE, 1);
26175916f65SKuninori Morimoto 	rsnd_mod_write(mod, SRC_BUSIF_DALIGN, rsnd_get_dalign(mod, io));
26275916f65SKuninori Morimoto 
26375916f65SKuninori Morimoto 	if (convert_rate)
26475916f65SKuninori Morimoto 		rsnd_adg_set_convert_clk_gen2(mod, io,
26575916f65SKuninori Morimoto 					      runtime->rate,
26675916f65SKuninori Morimoto 					      convert_rate);
26775916f65SKuninori Morimoto 	else
26875916f65SKuninori Morimoto 		rsnd_adg_set_convert_timing_gen2(mod, io);
26975916f65SKuninori Morimoto }
27075916f65SKuninori Morimoto 
271b5b442abSKuninori Morimoto static int rsnd_src_irq(struct rsnd_mod *mod,
272b5b442abSKuninori Morimoto 			struct rsnd_dai_stream *io,
273b5b442abSKuninori Morimoto 			struct rsnd_priv *priv,
274b5b442abSKuninori Morimoto 			int enable)
275cfcefe01SKuninori Morimoto {
276cfcefe01SKuninori Morimoto 	struct rsnd_src *src = rsnd_mod_to_src(mod);
277cfcefe01SKuninori Morimoto 	u32 sys_int_val, int_val, sys_int_mask;
278adf6a681SKuninori Morimoto 	int irq = src->irq;
279cfcefe01SKuninori Morimoto 	int id = rsnd_mod_id(mod);
280cfcefe01SKuninori Morimoto 
281cfcefe01SKuninori Morimoto 	sys_int_val =
282cfcefe01SKuninori Morimoto 	sys_int_mask = OUF_SRC(id);
283cfcefe01SKuninori Morimoto 	int_val = 0x3300;
284cfcefe01SKuninori Morimoto 
285cfcefe01SKuninori Morimoto 	/*
286cfcefe01SKuninori Morimoto 	 * IRQ is not supported on non-DT
287cfcefe01SKuninori Morimoto 	 * see
28875916f65SKuninori Morimoto 	 *	rsnd_src_probe_()
289cfcefe01SKuninori Morimoto 	 */
290cfcefe01SKuninori Morimoto 	if ((irq <= 0) || !enable) {
291cfcefe01SKuninori Morimoto 		sys_int_val = 0;
292cfcefe01SKuninori Morimoto 		int_val = 0;
293cfcefe01SKuninori Morimoto 	}
294cfcefe01SKuninori Morimoto 
2951a1bf58aSKuninori Morimoto 	/*
2961a1bf58aSKuninori Morimoto 	 * WORKAROUND
2971a1bf58aSKuninori Morimoto 	 *
298*ab2049f9SKuninori Morimoto 	 * ignore over flow error when rsnd_src_sync_is_enabled()
2991a1bf58aSKuninori Morimoto 	 */
300*ab2049f9SKuninori Morimoto 	if (rsnd_src_sync_is_enabled(mod))
3011a1bf58aSKuninori Morimoto 		sys_int_val = sys_int_val & 0xffff;
3021a1bf58aSKuninori Morimoto 
303cfcefe01SKuninori Morimoto 	rsnd_mod_write(mod, SRC_INT_ENABLE0, int_val);
304cfcefe01SKuninori Morimoto 	rsnd_mod_bset(mod, SCU_SYS_INT_EN0, sys_int_mask, sys_int_val);
305cfcefe01SKuninori Morimoto 	rsnd_mod_bset(mod, SCU_SYS_INT_EN1, sys_int_mask, sys_int_val);
306b5b442abSKuninori Morimoto 
307b5b442abSKuninori Morimoto 	return 0;
308cfcefe01SKuninori Morimoto }
309cfcefe01SKuninori Morimoto 
3108cc225f7SKuninori Morimoto static void rsnd_src_status_clear(struct rsnd_mod *mod)
311cfcefe01SKuninori Morimoto {
312cfcefe01SKuninori Morimoto 	u32 val = OUF_SRC(rsnd_mod_id(mod));
313cfcefe01SKuninori Morimoto 
314cfcefe01SKuninori Morimoto 	rsnd_mod_bset(mod, SCU_SYS_STATUS0, val, val);
315cfcefe01SKuninori Morimoto 	rsnd_mod_bset(mod, SCU_SYS_STATUS1, val, val);
316cfcefe01SKuninori Morimoto }
317cfcefe01SKuninori Morimoto 
3186a25c8daSKuninori Morimoto static bool rsnd_src_error_occurred(struct rsnd_mod *mod)
319cfcefe01SKuninori Morimoto {
3201a1bf58aSKuninori Morimoto 	u32 val0, val1;
321cfcefe01SKuninori Morimoto 	bool ret = false;
322cfcefe01SKuninori Morimoto 
3231a1bf58aSKuninori Morimoto 	val0 = val1 = OUF_SRC(rsnd_mod_id(mod));
3241a1bf58aSKuninori Morimoto 
3251a1bf58aSKuninori Morimoto 	/*
3261a1bf58aSKuninori Morimoto 	 * WORKAROUND
3271a1bf58aSKuninori Morimoto 	 *
328*ab2049f9SKuninori Morimoto 	 * ignore over flow error when rsnd_src_sync_is_enabled()
3291a1bf58aSKuninori Morimoto 	 */
330*ab2049f9SKuninori Morimoto 	if (rsnd_src_sync_is_enabled(mod))
3311a1bf58aSKuninori Morimoto 		val0 = val0 & 0xffff;
3321a1bf58aSKuninori Morimoto 
3331a1bf58aSKuninori Morimoto 	if ((rsnd_mod_read(mod, SCU_SYS_STATUS0) & val0) ||
3346a25c8daSKuninori Morimoto 	    (rsnd_mod_read(mod, SCU_SYS_STATUS1) & val1))
335cfcefe01SKuninori Morimoto 		ret = true;
336cfcefe01SKuninori Morimoto 
337cfcefe01SKuninori Morimoto 	return ret;
338cfcefe01SKuninori Morimoto }
339cfcefe01SKuninori Morimoto 
34075916f65SKuninori Morimoto static int rsnd_src_start(struct rsnd_mod *mod,
341497debaaSKuninori Morimoto 			  struct rsnd_dai_stream *io,
342497debaaSKuninori Morimoto 			  struct rsnd_priv *priv)
343cfcefe01SKuninori Morimoto {
3441a1bf58aSKuninori Morimoto 	u32 val;
3451a1bf58aSKuninori Morimoto 
3461a1bf58aSKuninori Morimoto 	/*
3471a1bf58aSKuninori Morimoto 	 * WORKAROUND
3481a1bf58aSKuninori Morimoto 	 *
3491a1bf58aSKuninori Morimoto 	 * Enable SRC output if you want to use sync convert together with DVC
3501a1bf58aSKuninori Morimoto 	 */
351*ab2049f9SKuninori Morimoto 	val = (rsnd_io_to_mod_dvc(io) && !rsnd_src_sync_is_enabled(mod)) ?
3521a1bf58aSKuninori Morimoto 		0x01 : 0x11;
353cfcefe01SKuninori Morimoto 
354cfcefe01SKuninori Morimoto 	rsnd_mod_write(mod, SRC_CTRL, val);
355cfcefe01SKuninori Morimoto 
35675916f65SKuninori Morimoto 	return 0;
35775916f65SKuninori Morimoto }
358cfcefe01SKuninori Morimoto 
35975916f65SKuninori Morimoto static int rsnd_src_stop(struct rsnd_mod *mod,
36075916f65SKuninori Morimoto 			 struct rsnd_dai_stream *io,
36175916f65SKuninori Morimoto 			 struct rsnd_priv *priv)
36275916f65SKuninori Morimoto {
36331739a68SKuninori Morimoto 	rsnd_mod_write(mod, SRC_CTRL, 0);
364cfcefe01SKuninori Morimoto 
365cfcefe01SKuninori Morimoto 	return 0;
366cfcefe01SKuninori Morimoto }
367cfcefe01SKuninori Morimoto 
36875916f65SKuninori Morimoto static int rsnd_src_init(struct rsnd_mod *mod,
369497debaaSKuninori Morimoto 			 struct rsnd_dai_stream *io,
370497debaaSKuninori Morimoto 			 struct rsnd_priv *priv)
371cfcefe01SKuninori Morimoto {
37275916f65SKuninori Morimoto 	struct rsnd_src *src = rsnd_mod_to_src(mod);
373cfcefe01SKuninori Morimoto 
37475916f65SKuninori Morimoto 	rsnd_mod_power_on(mod);
375cfcefe01SKuninori Morimoto 
37698efeeaeSKuninori Morimoto 	rsnd_src_activation(mod);
377cfcefe01SKuninori Morimoto 
37875916f65SKuninori Morimoto 	rsnd_src_set_convert_rate(io, mod);
37975916f65SKuninori Morimoto 
3808cc225f7SKuninori Morimoto 	rsnd_src_status_clear(mod);
38175916f65SKuninori Morimoto 
38275916f65SKuninori Morimoto 	/* reset sync convert_rate */
38375916f65SKuninori Morimoto 	src->sync.val = 0;
38475916f65SKuninori Morimoto 
38575916f65SKuninori Morimoto 	return 0;
386cfcefe01SKuninori Morimoto }
387cfcefe01SKuninori Morimoto 
38875916f65SKuninori Morimoto static int rsnd_src_quit(struct rsnd_mod *mod,
389b761bf27SKuninori Morimoto 			 struct rsnd_dai_stream *io,
390b761bf27SKuninori Morimoto 			 struct rsnd_priv *priv)
391b761bf27SKuninori Morimoto {
39275916f65SKuninori Morimoto 	struct rsnd_src *src = rsnd_mod_to_src(mod);
39375916f65SKuninori Morimoto 
394475a361aSKuninori Morimoto 	rsnd_src_halt(mod);
395475a361aSKuninori Morimoto 
39675916f65SKuninori Morimoto 	rsnd_mod_power_off(mod);
39775916f65SKuninori Morimoto 
39875916f65SKuninori Morimoto 	src->convert_rate = 0;
39975916f65SKuninori Morimoto 
40075916f65SKuninori Morimoto 	/* reset sync convert_rate */
40175916f65SKuninori Morimoto 	src->sync.val = 0;
40275916f65SKuninori Morimoto 
40375916f65SKuninori Morimoto 	return 0;
404b761bf27SKuninori Morimoto }
405b761bf27SKuninori Morimoto 
40675916f65SKuninori Morimoto static void __rsnd_src_interrupt(struct rsnd_mod *mod,
40788c61cffSKuninori Morimoto 				 struct rsnd_dai_stream *io)
408cfcefe01SKuninori Morimoto {
40902299d98SKuninori Morimoto 	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
4106a25c8daSKuninori Morimoto 	bool stop = false;
411cfcefe01SKuninori Morimoto 
41202299d98SKuninori Morimoto 	spin_lock(&priv->lock);
41302299d98SKuninori Morimoto 
41402299d98SKuninori Morimoto 	/* ignore all cases if not working */
415d5bbe7deSKuninori Morimoto 	if (!rsnd_io_is_working(io))
41675916f65SKuninori Morimoto 		goto rsnd_src_interrupt_out;
417cfcefe01SKuninori Morimoto 
4186a25c8daSKuninori Morimoto 	if (rsnd_src_error_occurred(mod))
4196a25c8daSKuninori Morimoto 		stop = true;
42088c61cffSKuninori Morimoto 
4218cc225f7SKuninori Morimoto 	rsnd_src_status_clear(mod);
42275916f65SKuninori Morimoto rsnd_src_interrupt_out:
4238cc225f7SKuninori Morimoto 
42402299d98SKuninori Morimoto 	spin_unlock(&priv->lock);
4256a25c8daSKuninori Morimoto 
4266a25c8daSKuninori Morimoto 	if (stop)
4276a25c8daSKuninori Morimoto 		snd_pcm_stop_xrun(io->substream);
42888c61cffSKuninori Morimoto }
42988c61cffSKuninori Morimoto 
43075916f65SKuninori Morimoto static irqreturn_t rsnd_src_interrupt(int irq, void *data)
43188c61cffSKuninori Morimoto {
43288c61cffSKuninori Morimoto 	struct rsnd_mod *mod = data;
43388c61cffSKuninori Morimoto 
43475916f65SKuninori Morimoto 	rsnd_mod_interrupt(mod, __rsnd_src_interrupt);
435cfcefe01SKuninori Morimoto 
436cfcefe01SKuninori Morimoto 	return IRQ_HANDLED;
437cfcefe01SKuninori Morimoto }
438cfcefe01SKuninori Morimoto 
43975916f65SKuninori Morimoto static int rsnd_src_probe_(struct rsnd_mod *mod,
4402c0fac19SKuninori Morimoto 			   struct rsnd_dai_stream *io,
441690602fcSKuninori Morimoto 			   struct rsnd_priv *priv)
442ba9c949fSKuninori Morimoto {
443ba9c949fSKuninori Morimoto 	struct rsnd_src *src = rsnd_mod_to_src(mod);
444ba9c949fSKuninori Morimoto 	struct device *dev = rsnd_priv_to_dev(priv);
445adf6a681SKuninori Morimoto 	int irq = src->irq;
446ba9c949fSKuninori Morimoto 	int ret;
447ba9c949fSKuninori Morimoto 
448cfcefe01SKuninori Morimoto 	if (irq > 0) {
449cfcefe01SKuninori Morimoto 		/*
450cfcefe01SKuninori Morimoto 		 * IRQ is not supported on non-DT
451cfcefe01SKuninori Morimoto 		 * see
452b5b442abSKuninori Morimoto 		 *	rsnd_src_irq()
453cfcefe01SKuninori Morimoto 		 */
454cfcefe01SKuninori Morimoto 		ret = devm_request_irq(dev, irq,
45575916f65SKuninori Morimoto 				       rsnd_src_interrupt,
456cfcefe01SKuninori Morimoto 				       IRQF_SHARED,
457cfcefe01SKuninori Morimoto 				       dev_name(dev), mod);
458cfcefe01SKuninori Morimoto 		if (ret)
459b543b52aSKuninori Morimoto 			return ret;
460cfcefe01SKuninori Morimoto 	}
461cfcefe01SKuninori Morimoto 
462355cb84fSKuninori Morimoto 	ret = rsnd_dma_attach(io, mod, &src->dma, 0);
463cfcefe01SKuninori Morimoto 
464cfcefe01SKuninori Morimoto 	return ret;
465ba9c949fSKuninori Morimoto }
466ba9c949fSKuninori Morimoto 
46775916f65SKuninori Morimoto static int rsnd_src_pcm_new(struct rsnd_mod *mod,
4682c0fac19SKuninori Morimoto 			    struct rsnd_dai_stream *io,
46943cb6954SKuninori Morimoto 			    struct snd_soc_pcm_runtime *rtd)
47043cb6954SKuninori Morimoto {
47143cb6954SKuninori Morimoto 	struct rsnd_src *src = rsnd_mod_to_src(mod);
47243cb6954SKuninori Morimoto 	int ret;
47343cb6954SKuninori Morimoto 
47443cb6954SKuninori Morimoto 	/*
47543cb6954SKuninori Morimoto 	 * enable SRC sync convert if possible
47643cb6954SKuninori Morimoto 	 */
47743cb6954SKuninori Morimoto 
47843cb6954SKuninori Morimoto 	/*
47961a219feSKuninori Morimoto 	 * It can't use SRC Synchronous convert
48061a219feSKuninori Morimoto 	 * when Capture if it uses CMD
4817115cb91SKuninori Morimoto 	 */
48261a219feSKuninori Morimoto 	if (rsnd_io_to_mod_cmd(io) && !rsnd_io_is_play(io))
4837115cb91SKuninori Morimoto 		return 0;
4847115cb91SKuninori Morimoto 
4857115cb91SKuninori Morimoto 	/*
48643cb6954SKuninori Morimoto 	 * enable sync convert
48743cb6954SKuninori Morimoto 	 */
488b65a7cccSKuninori Morimoto 	ret = rsnd_kctrl_new_s(mod, io, rtd,
48943cb6954SKuninori Morimoto 			       rsnd_io_is_play(io) ?
49043cb6954SKuninori Morimoto 			       "SRC Out Rate Switch" :
49143cb6954SKuninori Morimoto 			       "SRC In Rate Switch",
49275916f65SKuninori Morimoto 			       rsnd_src_set_convert_rate,
49343cb6954SKuninori Morimoto 			       &src->sen, 1);
49443cb6954SKuninori Morimoto 	if (ret < 0)
49543cb6954SKuninori Morimoto 		return ret;
49643cb6954SKuninori Morimoto 
497b65a7cccSKuninori Morimoto 	ret = rsnd_kctrl_new_s(mod, io, rtd,
49843cb6954SKuninori Morimoto 			       rsnd_io_is_play(io) ?
49943cb6954SKuninori Morimoto 			       "SRC Out Rate" :
50043cb6954SKuninori Morimoto 			       "SRC In Rate",
50175916f65SKuninori Morimoto 			       rsnd_src_set_convert_rate,
50243cb6954SKuninori Morimoto 			       &src->sync, 192000);
50343cb6954SKuninori Morimoto 
50443cb6954SKuninori Morimoto 	return ret;
50543cb6954SKuninori Morimoto }
50643cb6954SKuninori Morimoto 
50775916f65SKuninori Morimoto static struct rsnd_mod_ops rsnd_src_ops = {
5088aefda50SKuninori Morimoto 	.name	= SRC_NAME,
50972adc61fSKuninori Morimoto 	.dma_req = rsnd_src_dma_req,
51075916f65SKuninori Morimoto 	.probe	= rsnd_src_probe_,
51175916f65SKuninori Morimoto 	.init	= rsnd_src_init,
51275916f65SKuninori Morimoto 	.quit	= rsnd_src_quit,
51375916f65SKuninori Morimoto 	.start	= rsnd_src_start,
51475916f65SKuninori Morimoto 	.stop	= rsnd_src_stop,
515b5b442abSKuninori Morimoto 	.irq	= rsnd_src_irq,
5163b7843ffSKuninori Morimoto 	.hw_params = rsnd_src_hw_params,
51775916f65SKuninori Morimoto 	.pcm_new = rsnd_src_pcm_new,
518ba9c949fSKuninori Morimoto };
519ba9c949fSKuninori Morimoto 
520ba9c949fSKuninori Morimoto struct rsnd_mod *rsnd_src_mod_get(struct rsnd_priv *priv, int id)
521ba9c949fSKuninori Morimoto {
522ba9c949fSKuninori Morimoto 	if (WARN_ON(id < 0 || id >= rsnd_src_nr(priv)))
523ba9c949fSKuninori Morimoto 		id = 0;
524ba9c949fSKuninori Morimoto 
525adf6a681SKuninori Morimoto 	return rsnd_mod_get(rsnd_src_get(priv, id));
52690e8e50fSKuninori Morimoto }
52790e8e50fSKuninori Morimoto 
5282ea6b074SKuninori Morimoto int rsnd_src_probe(struct rsnd_priv *priv)
529ba9c949fSKuninori Morimoto {
530adf6a681SKuninori Morimoto 	struct device_node *node;
531adf6a681SKuninori Morimoto 	struct device_node *np;
532ba9c949fSKuninori Morimoto 	struct device *dev = rsnd_priv_to_dev(priv);
533ba9c949fSKuninori Morimoto 	struct rsnd_src *src;
534ba9c949fSKuninori Morimoto 	struct clk *clk;
535ba9c949fSKuninori Morimoto 	char name[RSND_SRC_NAME_SIZE];
5362f78dd7fSKuninori Morimoto 	int i, nr, ret;
537ba9c949fSKuninori Morimoto 
538e8e7b7bdSKuninori Morimoto 	/* This driver doesn't support Gen1 at this point */
539e8e7b7bdSKuninori Morimoto 	if (rsnd_is_gen1(priv))
540e8e7b7bdSKuninori Morimoto 		return 0;
541033e7ed8SKuninori Morimoto 
542adf6a681SKuninori Morimoto 	node = rsnd_src_of_node(priv);
543adf6a681SKuninori Morimoto 	if (!node)
544adf6a681SKuninori Morimoto 		return 0; /* not used is not error */
54590e8e50fSKuninori Morimoto 
546adf6a681SKuninori Morimoto 	nr = of_get_child_count(node);
547adf6a681SKuninori Morimoto 	if (!nr) {
548adf6a681SKuninori Morimoto 		ret = -EINVAL;
549adf6a681SKuninori Morimoto 		goto rsnd_src_probe_done;
550adf6a681SKuninori Morimoto 	}
551ba9c949fSKuninori Morimoto 
552ba9c949fSKuninori Morimoto 	src	= devm_kzalloc(dev, sizeof(*src) * nr, GFP_KERNEL);
553adf6a681SKuninori Morimoto 	if (!src) {
554adf6a681SKuninori Morimoto 		ret = -ENOMEM;
555adf6a681SKuninori Morimoto 		goto rsnd_src_probe_done;
556adf6a681SKuninori Morimoto 	}
557ba9c949fSKuninori Morimoto 
558ba9c949fSKuninori Morimoto 	priv->src_nr	= nr;
559ba9c949fSKuninori Morimoto 	priv->src	= src;
560ba9c949fSKuninori Morimoto 
561adf6a681SKuninori Morimoto 	i = 0;
562adf6a681SKuninori Morimoto 	for_each_child_of_node(node, np) {
563adf6a681SKuninori Morimoto 		src = rsnd_src_get(priv, i);
564adf6a681SKuninori Morimoto 
5658aefda50SKuninori Morimoto 		snprintf(name, RSND_SRC_NAME_SIZE, "%s.%d",
5668aefda50SKuninori Morimoto 			 SRC_NAME, i);
567ba9c949fSKuninori Morimoto 
568adf6a681SKuninori Morimoto 		src->irq = irq_of_parse_and_map(np, 0);
569adf6a681SKuninori Morimoto 		if (!src->irq) {
570adf6a681SKuninori Morimoto 			ret = -EINVAL;
571adf6a681SKuninori Morimoto 			goto rsnd_src_probe_done;
572adf6a681SKuninori Morimoto 		}
573ba9c949fSKuninori Morimoto 
574adf6a681SKuninori Morimoto 		clk = devm_clk_get(dev, name);
575adf6a681SKuninori Morimoto 		if (IS_ERR(clk)) {
576adf6a681SKuninori Morimoto 			ret = PTR_ERR(clk);
577adf6a681SKuninori Morimoto 			goto rsnd_src_probe_done;
578adf6a681SKuninori Morimoto 		}
579ba9c949fSKuninori Morimoto 
580e8e7b7bdSKuninori Morimoto 		ret = rsnd_mod_init(priv, rsnd_mod_get(src),
5815ba17b42SKuninori Morimoto 				    &rsnd_src_ops, clk, rsnd_mod_get_status,
5825ba17b42SKuninori Morimoto 				    RSND_MOD_SRC, i);
5832f78dd7fSKuninori Morimoto 		if (ret)
584adf6a681SKuninori Morimoto 			goto rsnd_src_probe_done;
585adf6a681SKuninori Morimoto 
586adf6a681SKuninori Morimoto 		i++;
587ba9c949fSKuninori Morimoto 	}
588ba9c949fSKuninori Morimoto 
589adf6a681SKuninori Morimoto 	ret = 0;
590adf6a681SKuninori Morimoto 
591adf6a681SKuninori Morimoto rsnd_src_probe_done:
592adf6a681SKuninori Morimoto 	of_node_put(node);
593adf6a681SKuninori Morimoto 
594adf6a681SKuninori Morimoto 	return ret;
595ba9c949fSKuninori Morimoto }
5962f78dd7fSKuninori Morimoto 
5972ea6b074SKuninori Morimoto void rsnd_src_remove(struct rsnd_priv *priv)
5982f78dd7fSKuninori Morimoto {
5992f78dd7fSKuninori Morimoto 	struct rsnd_src *src;
6002f78dd7fSKuninori Morimoto 	int i;
6012f78dd7fSKuninori Morimoto 
6022f78dd7fSKuninori Morimoto 	for_each_rsnd_src(src, priv, i) {
603b76e218aSKuninori Morimoto 		rsnd_mod_quit(rsnd_mod_get(src));
6042f78dd7fSKuninori Morimoto 	}
6052f78dd7fSKuninori Morimoto }
606