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