12ba28053SFabio Estevam // SPDX-License-Identifier: GPL-2.0 22ba28053SFabio Estevam // 32ba28053SFabio Estevam // Freescale ASRC ALSA SoC Digital Audio Interface (DAI) driver 42ba28053SFabio Estevam // 52ba28053SFabio Estevam // Copyright (C) 2014 Freescale Semiconductor, Inc. 62ba28053SFabio Estevam // 72ba28053SFabio Estevam // Author: Nicolin Chen <nicoleotsuka@gmail.com> 83117bb31SNicolin Chen 93117bb31SNicolin Chen #include <linux/clk.h> 103117bb31SNicolin Chen #include <linux/delay.h> 113117bb31SNicolin Chen #include <linux/dma-mapping.h> 123117bb31SNicolin Chen #include <linux/module.h> 133117bb31SNicolin Chen #include <linux/of_platform.h> 143117bb31SNicolin Chen #include <linux/platform_data/dma-imx.h> 153117bb31SNicolin Chen #include <linux/pm_runtime.h> 163117bb31SNicolin Chen #include <sound/dmaengine_pcm.h> 173117bb31SNicolin Chen #include <sound/pcm_params.h> 183117bb31SNicolin Chen 193117bb31SNicolin Chen #include "fsl_asrc.h" 203117bb31SNicolin Chen 213117bb31SNicolin Chen #define IDEAL_RATIO_DECIMAL_DEPTH 26 223117bb31SNicolin Chen 233117bb31SNicolin Chen #define pair_err(fmt, ...) \ 247470704dSShengjiu Wang dev_err(&asrc->pdev->dev, "Pair %c: " fmt, 'A' + index, ##__VA_ARGS__) 253117bb31SNicolin Chen 263117bb31SNicolin Chen #define pair_dbg(fmt, ...) \ 277470704dSShengjiu Wang dev_dbg(&asrc->pdev->dev, "Pair %c: " fmt, 'A' + index, ##__VA_ARGS__) 283117bb31SNicolin Chen 293117bb31SNicolin Chen /* Corresponding to process_option */ 30d281bf5dSS.j. Wang static unsigned int supported_asrc_rate[] = { 31d281bf5dSS.j. Wang 5512, 8000, 11025, 12000, 16000, 22050, 24000, 32000, 44100, 48000, 32d281bf5dSS.j. Wang 64000, 88200, 96000, 128000, 176400, 192000, 333117bb31SNicolin Chen }; 343117bb31SNicolin Chen 35d281bf5dSS.j. Wang static struct snd_pcm_hw_constraint_list fsl_asrc_rate_constraints = { 36d281bf5dSS.j. Wang .count = ARRAY_SIZE(supported_asrc_rate), 37d281bf5dSS.j. Wang .list = supported_asrc_rate, 383117bb31SNicolin Chen }; 393117bb31SNicolin Chen 403117bb31SNicolin Chen /** 413117bb31SNicolin Chen * The following tables map the relationship between asrc_inclk/asrc_outclk in 423117bb31SNicolin Chen * fsl_asrc.h and the registers of ASRCSR 433117bb31SNicolin Chen */ 44c05f10f2SShengjiu Wang static unsigned char input_clk_map_imx35[ASRC_CLK_MAP_LEN] = { 453117bb31SNicolin Chen 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 0xa, 0xb, 0xc, 0xd, 0xe, 0xf, 46c05f10f2SShengjiu Wang 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 47c05f10f2SShengjiu Wang 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 483117bb31SNicolin Chen }; 493117bb31SNicolin Chen 50c05f10f2SShengjiu Wang static unsigned char output_clk_map_imx35[ASRC_CLK_MAP_LEN] = { 513117bb31SNicolin Chen 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 0xa, 0xb, 0xc, 0xd, 0xe, 0xf, 52c05f10f2SShengjiu Wang 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 53c05f10f2SShengjiu Wang 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 543117bb31SNicolin Chen }; 553117bb31SNicolin Chen 563117bb31SNicolin Chen /* i.MX53 uses the same map for input and output */ 57c05f10f2SShengjiu Wang static unsigned char input_clk_map_imx53[ASRC_CLK_MAP_LEN] = { 583117bb31SNicolin Chen /* 0x0 0x1 0x2 0x3 0x4 0x5 0x6 0x7 0x8 0x9 0xa 0xb 0xc 0xd 0xe 0xf */ 593117bb31SNicolin Chen 0x0, 0x1, 0x2, 0x7, 0x4, 0x5, 0x6, 0x3, 0x8, 0x9, 0xa, 0xb, 0xc, 0xf, 0xe, 0xd, 60c05f10f2SShengjiu Wang 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 61c05f10f2SShengjiu Wang 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 623117bb31SNicolin Chen }; 633117bb31SNicolin Chen 64c05f10f2SShengjiu Wang static unsigned char output_clk_map_imx53[ASRC_CLK_MAP_LEN] = { 653117bb31SNicolin Chen /* 0x0 0x1 0x2 0x3 0x4 0x5 0x6 0x7 0x8 0x9 0xa 0xb 0xc 0xd 0xe 0xf */ 663117bb31SNicolin Chen 0x8, 0x9, 0xa, 0x7, 0xc, 0x5, 0x6, 0xb, 0x0, 0x1, 0x2, 0x3, 0x4, 0xf, 0xe, 0xd, 67c05f10f2SShengjiu Wang 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 68c05f10f2SShengjiu Wang 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 693117bb31SNicolin Chen }; 703117bb31SNicolin Chen 71c05f10f2SShengjiu Wang /** 72c05f10f2SShengjiu Wang * i.MX8QM/i.MX8QXP uses the same map for input and output. 73c05f10f2SShengjiu Wang * clk_map_imx8qm[0] is for i.MX8QM asrc0 74c05f10f2SShengjiu Wang * clk_map_imx8qm[1] is for i.MX8QM asrc1 75c05f10f2SShengjiu Wang * clk_map_imx8qxp[0] is for i.MX8QXP asrc0 76c05f10f2SShengjiu Wang * clk_map_imx8qxp[1] is for i.MX8QXP asrc1 77c05f10f2SShengjiu Wang */ 78c05f10f2SShengjiu Wang static unsigned char clk_map_imx8qm[2][ASRC_CLK_MAP_LEN] = { 79c05f10f2SShengjiu Wang { 80c05f10f2SShengjiu Wang 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0x0, 81c05f10f2SShengjiu Wang 0x0, 0x1, 0x2, 0x3, 0x4, 0x5, 0x6, 0x7, 0x8, 0x9, 0xa, 0xb, 0xc, 0xd, 0xe, 0xf, 82c05f10f2SShengjiu Wang 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 83c05f10f2SShengjiu Wang }, 84c05f10f2SShengjiu Wang { 85c05f10f2SShengjiu Wang 0xf, 0xf, 0xf, 0xf, 0xf, 0x7, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0x0, 86c05f10f2SShengjiu Wang 0x0, 0x1, 0x2, 0x3, 0xb, 0xc, 0xf, 0xf, 0xd, 0xe, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 87c05f10f2SShengjiu Wang 0x4, 0x5, 0x6, 0xf, 0x8, 0x9, 0xa, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 88c05f10f2SShengjiu Wang }, 89c05f10f2SShengjiu Wang }; 90c05f10f2SShengjiu Wang 91c05f10f2SShengjiu Wang static unsigned char clk_map_imx8qxp[2][ASRC_CLK_MAP_LEN] = { 92c05f10f2SShengjiu Wang { 93c05f10f2SShengjiu Wang 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0x0, 94c05f10f2SShengjiu Wang 0x0, 0x1, 0x2, 0x3, 0x4, 0x5, 0x6, 0xf, 0x7, 0x8, 0x9, 0xa, 0xb, 0xc, 0xf, 0xf, 95c05f10f2SShengjiu Wang 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 96c05f10f2SShengjiu Wang }, 97c05f10f2SShengjiu Wang { 98c05f10f2SShengjiu Wang 0xf, 0xf, 0xf, 0xf, 0xf, 0x7, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0x0, 99c05f10f2SShengjiu Wang 0x0, 0x1, 0x2, 0x3, 0x7, 0x8, 0xf, 0xf, 0x9, 0xa, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 100c05f10f2SShengjiu Wang 0xf, 0xf, 0x6, 0xf, 0xf, 0xf, 0xa, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 0xf, 101c05f10f2SShengjiu Wang }, 102c05f10f2SShengjiu Wang }; 1033117bb31SNicolin Chen 1043117bb31SNicolin Chen /** 1054aecaa0aSS.j. Wang * Select the pre-processing and post-processing options 1064aecaa0aSS.j. Wang * Make sure to exclude following unsupported cases before 1074aecaa0aSS.j. Wang * calling this function: 1084aecaa0aSS.j. Wang * 1) inrate > 8.125 * outrate 1094aecaa0aSS.j. Wang * 2) inrate > 16.125 * outrate 1104aecaa0aSS.j. Wang * 1114aecaa0aSS.j. Wang * inrate: input sample rate 1124aecaa0aSS.j. Wang * outrate: output sample rate 1134aecaa0aSS.j. Wang * pre_proc: return value for pre-processing option 1144aecaa0aSS.j. Wang * post_proc: return value for post-processing option 1154aecaa0aSS.j. Wang */ 1164aecaa0aSS.j. Wang static void fsl_asrc_sel_proc(int inrate, int outrate, 1174aecaa0aSS.j. Wang int *pre_proc, int *post_proc) 1184aecaa0aSS.j. Wang { 1194aecaa0aSS.j. Wang bool post_proc_cond2; 1204aecaa0aSS.j. Wang bool post_proc_cond0; 1214aecaa0aSS.j. Wang 1224aecaa0aSS.j. Wang /* select pre_proc between [0, 2] */ 1234aecaa0aSS.j. Wang if (inrate * 8 > 33 * outrate) 1244aecaa0aSS.j. Wang *pre_proc = 2; 1254aecaa0aSS.j. Wang else if (inrate * 8 > 15 * outrate) { 1264aecaa0aSS.j. Wang if (inrate > 152000) 1274aecaa0aSS.j. Wang *pre_proc = 2; 1284aecaa0aSS.j. Wang else 1294aecaa0aSS.j. Wang *pre_proc = 1; 1304aecaa0aSS.j. Wang } else if (inrate < 76000) 1314aecaa0aSS.j. Wang *pre_proc = 0; 1324aecaa0aSS.j. Wang else if (inrate > 152000) 1334aecaa0aSS.j. Wang *pre_proc = 2; 1344aecaa0aSS.j. Wang else 1354aecaa0aSS.j. Wang *pre_proc = 1; 1364aecaa0aSS.j. Wang 1374aecaa0aSS.j. Wang /* Condition for selection of post-processing */ 1384aecaa0aSS.j. Wang post_proc_cond2 = (inrate * 15 > outrate * 16 && outrate < 56000) || 1394aecaa0aSS.j. Wang (inrate > 56000 && outrate < 56000); 1404aecaa0aSS.j. Wang post_proc_cond0 = inrate * 23 < outrate * 8; 1414aecaa0aSS.j. Wang 1424aecaa0aSS.j. Wang if (post_proc_cond2) 1434aecaa0aSS.j. Wang *post_proc = 2; 1444aecaa0aSS.j. Wang else if (post_proc_cond0) 1454aecaa0aSS.j. Wang *post_proc = 0; 1464aecaa0aSS.j. Wang else 1474aecaa0aSS.j. Wang *post_proc = 1; 1484aecaa0aSS.j. Wang } 1494aecaa0aSS.j. Wang 1504aecaa0aSS.j. Wang /** 1513117bb31SNicolin Chen * Request ASRC pair 1523117bb31SNicolin Chen * 1533117bb31SNicolin Chen * It assigns pair by the order of A->C->B because allocation of pair B, 1543117bb31SNicolin Chen * within range [ANCA, ANCA+ANCB-1], depends on the channels of pair A 1553117bb31SNicolin Chen * while pair A and pair C are comparatively independent. 1563117bb31SNicolin Chen */ 157*c16e923dSChenTao static int fsl_asrc_request_pair(int channels, struct fsl_asrc_pair *pair) 1583117bb31SNicolin Chen { 1593117bb31SNicolin Chen enum asrc_pair_index index = ASRC_INVALID_PAIR; 1607470704dSShengjiu Wang struct fsl_asrc *asrc = pair->asrc; 1617470704dSShengjiu Wang struct device *dev = &asrc->pdev->dev; 1623117bb31SNicolin Chen unsigned long lock_flags; 1633117bb31SNicolin Chen int i, ret = 0; 1643117bb31SNicolin Chen 1657470704dSShengjiu Wang spin_lock_irqsave(&asrc->lock, lock_flags); 1663117bb31SNicolin Chen 1673117bb31SNicolin Chen for (i = ASRC_PAIR_A; i < ASRC_PAIR_MAX_NUM; i++) { 1687470704dSShengjiu Wang if (asrc->pair[i] != NULL) 1693117bb31SNicolin Chen continue; 1703117bb31SNicolin Chen 1713117bb31SNicolin Chen index = i; 1723117bb31SNicolin Chen 1733117bb31SNicolin Chen if (i != ASRC_PAIR_B) 1743117bb31SNicolin Chen break; 1753117bb31SNicolin Chen } 1763117bb31SNicolin Chen 1773117bb31SNicolin Chen if (index == ASRC_INVALID_PAIR) { 1783117bb31SNicolin Chen dev_err(dev, "all pairs are busy now\n"); 1793117bb31SNicolin Chen ret = -EBUSY; 1807470704dSShengjiu Wang } else if (asrc->channel_avail < channels) { 1813117bb31SNicolin Chen dev_err(dev, "can't afford required channels: %d\n", channels); 1823117bb31SNicolin Chen ret = -EINVAL; 1833117bb31SNicolin Chen } else { 1847470704dSShengjiu Wang asrc->channel_avail -= channels; 1857470704dSShengjiu Wang asrc->pair[index] = pair; 1863117bb31SNicolin Chen pair->channels = channels; 1873117bb31SNicolin Chen pair->index = index; 1883117bb31SNicolin Chen } 1893117bb31SNicolin Chen 1907470704dSShengjiu Wang spin_unlock_irqrestore(&asrc->lock, lock_flags); 1913117bb31SNicolin Chen 1923117bb31SNicolin Chen return ret; 1933117bb31SNicolin Chen } 1943117bb31SNicolin Chen 1953117bb31SNicolin Chen /** 1963117bb31SNicolin Chen * Release ASRC pair 1973117bb31SNicolin Chen * 1987470704dSShengjiu Wang * It clears the resource from asrc and releases the occupied channels. 1993117bb31SNicolin Chen */ 200*c16e923dSChenTao static void fsl_asrc_release_pair(struct fsl_asrc_pair *pair) 2013117bb31SNicolin Chen { 2027470704dSShengjiu Wang struct fsl_asrc *asrc = pair->asrc; 2033117bb31SNicolin Chen enum asrc_pair_index index = pair->index; 2043117bb31SNicolin Chen unsigned long lock_flags; 2053117bb31SNicolin Chen 2063117bb31SNicolin Chen /* Make sure the pair is disabled */ 2077470704dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRCTR, 2083117bb31SNicolin Chen ASRCTR_ASRCEi_MASK(index), 0); 2093117bb31SNicolin Chen 2107470704dSShengjiu Wang spin_lock_irqsave(&asrc->lock, lock_flags); 2113117bb31SNicolin Chen 2127470704dSShengjiu Wang asrc->channel_avail += pair->channels; 2137470704dSShengjiu Wang asrc->pair[index] = NULL; 2143117bb31SNicolin Chen pair->error = 0; 2153117bb31SNicolin Chen 2167470704dSShengjiu Wang spin_unlock_irqrestore(&asrc->lock, lock_flags); 2173117bb31SNicolin Chen } 2183117bb31SNicolin Chen 2193117bb31SNicolin Chen /** 2203117bb31SNicolin Chen * Configure input and output thresholds 2213117bb31SNicolin Chen */ 2223117bb31SNicolin Chen static void fsl_asrc_set_watermarks(struct fsl_asrc_pair *pair, u32 in, u32 out) 2233117bb31SNicolin Chen { 2247470704dSShengjiu Wang struct fsl_asrc *asrc = pair->asrc; 2253117bb31SNicolin Chen enum asrc_pair_index index = pair->index; 2263117bb31SNicolin Chen 2277470704dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRMCR(index), 2283117bb31SNicolin Chen ASRMCRi_EXTTHRSHi_MASK | 2293117bb31SNicolin Chen ASRMCRi_INFIFO_THRESHOLD_MASK | 2303117bb31SNicolin Chen ASRMCRi_OUTFIFO_THRESHOLD_MASK, 2313117bb31SNicolin Chen ASRMCRi_EXTTHRSHi | 2323117bb31SNicolin Chen ASRMCRi_INFIFO_THRESHOLD(in) | 2333117bb31SNicolin Chen ASRMCRi_OUTFIFO_THRESHOLD(out)); 2343117bb31SNicolin Chen } 2353117bb31SNicolin Chen 2363117bb31SNicolin Chen /** 2373117bb31SNicolin Chen * Calculate the total divisor between asrck clock rate and sample rate 2383117bb31SNicolin Chen * 2393117bb31SNicolin Chen * It follows the formula clk_rate = samplerate * (2 ^ prescaler) * divider 2403117bb31SNicolin Chen */ 2413117bb31SNicolin Chen static u32 fsl_asrc_cal_asrck_divisor(struct fsl_asrc_pair *pair, u32 div) 2423117bb31SNicolin Chen { 2433117bb31SNicolin Chen u32 ps; 2443117bb31SNicolin Chen 2453117bb31SNicolin Chen /* Calculate the divisors: prescaler [2^0, 2^7], divder [1, 8] */ 2463117bb31SNicolin Chen for (ps = 0; div > 8; ps++) 2473117bb31SNicolin Chen div >>= 1; 2483117bb31SNicolin Chen 2493117bb31SNicolin Chen return ((div - 1) << ASRCDRi_AxCPi_WIDTH) | ps; 2503117bb31SNicolin Chen } 2513117bb31SNicolin Chen 2523117bb31SNicolin Chen /** 2533117bb31SNicolin Chen * Calculate and set the ratio for Ideal Ratio mode only 2543117bb31SNicolin Chen * 2553117bb31SNicolin Chen * The ratio is a 32-bit fixed point value with 26 fractional bits. 2563117bb31SNicolin Chen */ 2573117bb31SNicolin Chen static int fsl_asrc_set_ideal_ratio(struct fsl_asrc_pair *pair, 2583117bb31SNicolin Chen int inrate, int outrate) 2593117bb31SNicolin Chen { 2607470704dSShengjiu Wang struct fsl_asrc *asrc = pair->asrc; 2613117bb31SNicolin Chen enum asrc_pair_index index = pair->index; 2623117bb31SNicolin Chen unsigned long ratio; 2633117bb31SNicolin Chen int i; 2643117bb31SNicolin Chen 2653117bb31SNicolin Chen if (!outrate) { 2663117bb31SNicolin Chen pair_err("output rate should not be zero\n"); 2673117bb31SNicolin Chen return -EINVAL; 2683117bb31SNicolin Chen } 2693117bb31SNicolin Chen 2703117bb31SNicolin Chen /* Calculate the intergal part of the ratio */ 2713117bb31SNicolin Chen ratio = (inrate / outrate) << IDEAL_RATIO_DECIMAL_DEPTH; 2723117bb31SNicolin Chen 2733117bb31SNicolin Chen /* ... and then the 26 depth decimal part */ 2743117bb31SNicolin Chen inrate %= outrate; 2753117bb31SNicolin Chen 2763117bb31SNicolin Chen for (i = 1; i <= IDEAL_RATIO_DECIMAL_DEPTH; i++) { 2773117bb31SNicolin Chen inrate <<= 1; 2783117bb31SNicolin Chen 2793117bb31SNicolin Chen if (inrate < outrate) 2803117bb31SNicolin Chen continue; 2813117bb31SNicolin Chen 2823117bb31SNicolin Chen ratio |= 1 << (IDEAL_RATIO_DECIMAL_DEPTH - i); 2833117bb31SNicolin Chen inrate -= outrate; 2843117bb31SNicolin Chen 2853117bb31SNicolin Chen if (!inrate) 2863117bb31SNicolin Chen break; 2873117bb31SNicolin Chen } 2883117bb31SNicolin Chen 2897470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRIDRL(index), ratio); 2907470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRIDRH(index), ratio >> 24); 2913117bb31SNicolin Chen 2923117bb31SNicolin Chen return 0; 2933117bb31SNicolin Chen } 2943117bb31SNicolin Chen 2953117bb31SNicolin Chen /** 2963117bb31SNicolin Chen * Configure the assigned ASRC pair 2973117bb31SNicolin Chen * 2983117bb31SNicolin Chen * It configures those ASRC registers according to a configuration instance 2993117bb31SNicolin Chen * of struct asrc_config which includes in/output sample rate, width, channel 3003117bb31SNicolin Chen * and clock settings. 301b39eb1e2SShengjiu Wang * 302b39eb1e2SShengjiu Wang * Note: 303b39eb1e2SShengjiu Wang * The ideal ratio configuration can work with a flexible clock rate setting. 304b39eb1e2SShengjiu Wang * Using IDEAL_RATIO_RATE gives a faster converting speed but overloads ASRC. 305b39eb1e2SShengjiu Wang * For a regular audio playback, the clock rate should not be slower than an 306b39eb1e2SShengjiu Wang * clock rate aligning with the output sample rate; For a use case requiring 307b39eb1e2SShengjiu Wang * faster conversion, set use_ideal_rate to have the faster speed. 3083117bb31SNicolin Chen */ 309b39eb1e2SShengjiu Wang static int fsl_asrc_config_pair(struct fsl_asrc_pair *pair, bool use_ideal_rate) 3103117bb31SNicolin Chen { 311be7bd03fSShengjiu Wang struct fsl_asrc_pair_priv *pair_priv = pair->private; 312be7bd03fSShengjiu Wang struct asrc_config *config = pair_priv->config; 3137470704dSShengjiu Wang struct fsl_asrc *asrc = pair->asrc; 314be7bd03fSShengjiu Wang struct fsl_asrc_priv *asrc_priv = asrc->private; 3153117bb31SNicolin Chen enum asrc_pair_index index = pair->index; 3164bf62571SShengjiu Wang enum asrc_word_width input_word_width; 3174bf62571SShengjiu Wang enum asrc_word_width output_word_width; 3184e13eb72SNicolin Chen u32 inrate, outrate, indiv, outdiv; 319b39eb1e2SShengjiu Wang u32 clk_index[2], div[2], rem[2]; 320b39eb1e2SShengjiu Wang u64 clk_rate; 3213117bb31SNicolin Chen int in, out, channels; 3224aecaa0aSS.j. Wang int pre_proc, post_proc; 3233117bb31SNicolin Chen struct clk *clk; 3244e13eb72SNicolin Chen bool ideal; 3253117bb31SNicolin Chen 3263117bb31SNicolin Chen if (!config) { 3273117bb31SNicolin Chen pair_err("invalid pair config\n"); 3283117bb31SNicolin Chen return -EINVAL; 3293117bb31SNicolin Chen } 3303117bb31SNicolin Chen 3313117bb31SNicolin Chen /* Validate channels */ 3323117bb31SNicolin Chen if (config->channel_num < 1 || config->channel_num > 10) { 3333117bb31SNicolin Chen pair_err("does not support %d channels\n", config->channel_num); 3343117bb31SNicolin Chen return -EINVAL; 3353117bb31SNicolin Chen } 3363117bb31SNicolin Chen 3374bf62571SShengjiu Wang switch (snd_pcm_format_width(config->input_format)) { 3384bf62571SShengjiu Wang case 8: 3394bf62571SShengjiu Wang input_word_width = ASRC_WIDTH_8_BIT; 3404bf62571SShengjiu Wang break; 3414bf62571SShengjiu Wang case 16: 3424bf62571SShengjiu Wang input_word_width = ASRC_WIDTH_16_BIT; 3434bf62571SShengjiu Wang break; 3444bf62571SShengjiu Wang case 24: 3454bf62571SShengjiu Wang input_word_width = ASRC_WIDTH_24_BIT; 3464bf62571SShengjiu Wang break; 3474bf62571SShengjiu Wang default: 3484bf62571SShengjiu Wang pair_err("does not support this input format, %d\n", 3494bf62571SShengjiu Wang config->input_format); 3504bf62571SShengjiu Wang return -EINVAL; 3514bf62571SShengjiu Wang } 3524bf62571SShengjiu Wang 3534bf62571SShengjiu Wang switch (snd_pcm_format_width(config->output_format)) { 3544bf62571SShengjiu Wang case 16: 3554bf62571SShengjiu Wang output_word_width = ASRC_WIDTH_16_BIT; 3564bf62571SShengjiu Wang break; 3574bf62571SShengjiu Wang case 24: 3584bf62571SShengjiu Wang output_word_width = ASRC_WIDTH_24_BIT; 3594bf62571SShengjiu Wang break; 3604bf62571SShengjiu Wang default: 3614bf62571SShengjiu Wang pair_err("does not support this output format, %d\n", 3624bf62571SShengjiu Wang config->output_format); 3633117bb31SNicolin Chen return -EINVAL; 3643117bb31SNicolin Chen } 3653117bb31SNicolin Chen 3664e13eb72SNicolin Chen inrate = config->input_sample_rate; 3674e13eb72SNicolin Chen outrate = config->output_sample_rate; 3684e13eb72SNicolin Chen ideal = config->inclk == INCLK_NONE; 3694e13eb72SNicolin Chen 3703117bb31SNicolin Chen /* Validate input and output sample rates */ 371d281bf5dSS.j. Wang for (in = 0; in < ARRAY_SIZE(supported_asrc_rate); in++) 372d281bf5dSS.j. Wang if (inrate == supported_asrc_rate[in]) 3733117bb31SNicolin Chen break; 3743117bb31SNicolin Chen 375d281bf5dSS.j. Wang if (in == ARRAY_SIZE(supported_asrc_rate)) { 3763117bb31SNicolin Chen pair_err("unsupported input sample rate: %dHz\n", inrate); 3773117bb31SNicolin Chen return -EINVAL; 3783117bb31SNicolin Chen } 3793117bb31SNicolin Chen 3803117bb31SNicolin Chen for (out = 0; out < ARRAY_SIZE(supported_asrc_rate); out++) 3813117bb31SNicolin Chen if (outrate == supported_asrc_rate[out]) 3823117bb31SNicolin Chen break; 3833117bb31SNicolin Chen 3843117bb31SNicolin Chen if (out == ARRAY_SIZE(supported_asrc_rate)) { 3853117bb31SNicolin Chen pair_err("unsupported output sample rate: %dHz\n", outrate); 3863117bb31SNicolin Chen return -EINVAL; 3873117bb31SNicolin Chen } 3883117bb31SNicolin Chen 389d281bf5dSS.j. Wang if ((outrate >= 5512 && outrate <= 30000) && 390b06c58c2SS.j. Wang (outrate > 24 * inrate || inrate > 8 * outrate)) { 391fff6e03cSZidan Wang pair_err("exceed supported ratio range [1/24, 8] for \ 392fff6e03cSZidan Wang inrate/outrate: %d/%d\n", inrate, outrate); 393fff6e03cSZidan Wang return -EINVAL; 394fff6e03cSZidan Wang } 395fff6e03cSZidan Wang 3963117bb31SNicolin Chen /* Validate input and output clock sources */ 397be7bd03fSShengjiu Wang clk_index[IN] = asrc_priv->clk_map[IN][config->inclk]; 398be7bd03fSShengjiu Wang clk_index[OUT] = asrc_priv->clk_map[OUT][config->outclk]; 3993117bb31SNicolin Chen 4003117bb31SNicolin Chen /* We only have output clock for ideal ratio mode */ 401be7bd03fSShengjiu Wang clk = asrc_priv->asrck_clk[clk_index[ideal ? OUT : IN]]; 4023117bb31SNicolin Chen 403b39eb1e2SShengjiu Wang clk_rate = clk_get_rate(clk); 404b39eb1e2SShengjiu Wang rem[IN] = do_div(clk_rate, inrate); 405b39eb1e2SShengjiu Wang div[IN] = (u32)clk_rate; 406b39eb1e2SShengjiu Wang 407b39eb1e2SShengjiu Wang /* 408b39eb1e2SShengjiu Wang * The divider range is [1, 1024], defined by the hardware. For non- 409b39eb1e2SShengjiu Wang * ideal ratio configuration, clock rate has to be strictly aligned 410b39eb1e2SShengjiu Wang * with the sample rate. For ideal ratio configuration, clock rates 411b39eb1e2SShengjiu Wang * only result in different converting speeds. So remainder does not 412b39eb1e2SShengjiu Wang * matter, as long as we keep the divider within its valid range. 413b39eb1e2SShengjiu Wang */ 414b39eb1e2SShengjiu Wang if (div[IN] == 0 || (!ideal && (div[IN] > 1024 || rem[IN] != 0))) { 4153117bb31SNicolin Chen pair_err("failed to support input sample rate %dHz by asrck_%x\n", 4163117bb31SNicolin Chen inrate, clk_index[ideal ? OUT : IN]); 4173117bb31SNicolin Chen return -EINVAL; 4183117bb31SNicolin Chen } 4193117bb31SNicolin Chen 420b39eb1e2SShengjiu Wang div[IN] = min_t(u32, 1024, div[IN]); 421b39eb1e2SShengjiu Wang 422be7bd03fSShengjiu Wang clk = asrc_priv->asrck_clk[clk_index[OUT]]; 423b39eb1e2SShengjiu Wang clk_rate = clk_get_rate(clk); 424b39eb1e2SShengjiu Wang if (ideal && use_ideal_rate) 425b39eb1e2SShengjiu Wang rem[OUT] = do_div(clk_rate, IDEAL_RATIO_RATE); 4263117bb31SNicolin Chen else 427b39eb1e2SShengjiu Wang rem[OUT] = do_div(clk_rate, outrate); 428b39eb1e2SShengjiu Wang div[OUT] = clk_rate; 4293117bb31SNicolin Chen 430b39eb1e2SShengjiu Wang /* Output divider has the same limitation as the input one */ 431b39eb1e2SShengjiu Wang if (div[OUT] == 0 || (!ideal && (div[OUT] > 1024 || rem[OUT] != 0))) { 4323117bb31SNicolin Chen pair_err("failed to support output sample rate %dHz by asrck_%x\n", 4333117bb31SNicolin Chen outrate, clk_index[OUT]); 4343117bb31SNicolin Chen return -EINVAL; 4353117bb31SNicolin Chen } 4363117bb31SNicolin Chen 437b39eb1e2SShengjiu Wang div[OUT] = min_t(u32, 1024, div[OUT]); 438b39eb1e2SShengjiu Wang 4393117bb31SNicolin Chen /* Set the channel number */ 4403117bb31SNicolin Chen channels = config->channel_num; 4413117bb31SNicolin Chen 442be7bd03fSShengjiu Wang if (asrc_priv->soc->channel_bits < 4) 4433117bb31SNicolin Chen channels /= 2; 4443117bb31SNicolin Chen 4453117bb31SNicolin Chen /* Update channels for current pair */ 4467470704dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRCNCR, 447be7bd03fSShengjiu Wang ASRCNCR_ANCi_MASK(index, asrc_priv->soc->channel_bits), 448be7bd03fSShengjiu Wang ASRCNCR_ANCi(index, channels, asrc_priv->soc->channel_bits)); 4493117bb31SNicolin Chen 4503117bb31SNicolin Chen /* Default setting: Automatic selection for processing mode */ 4517470704dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRCTR, 4523117bb31SNicolin Chen ASRCTR_ATSi_MASK(index), ASRCTR_ATS(index)); 4537470704dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRCTR, 4543117bb31SNicolin Chen ASRCTR_USRi_MASK(index), 0); 4553117bb31SNicolin Chen 4563117bb31SNicolin Chen /* Set the input and output clock sources */ 4577470704dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRCSR, 4583117bb31SNicolin Chen ASRCSR_AICSi_MASK(index) | ASRCSR_AOCSi_MASK(index), 4593117bb31SNicolin Chen ASRCSR_AICS(index, clk_index[IN]) | 4603117bb31SNicolin Chen ASRCSR_AOCS(index, clk_index[OUT])); 4613117bb31SNicolin Chen 4623117bb31SNicolin Chen /* Calculate the input clock divisors */ 4633117bb31SNicolin Chen indiv = fsl_asrc_cal_asrck_divisor(pair, div[IN]); 4643117bb31SNicolin Chen outdiv = fsl_asrc_cal_asrck_divisor(pair, div[OUT]); 4653117bb31SNicolin Chen 4663117bb31SNicolin Chen /* Suppose indiv and outdiv includes prescaler, so add its MASK too */ 4677470704dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRCDR(index), 4683117bb31SNicolin Chen ASRCDRi_AOCPi_MASK(index) | ASRCDRi_AICPi_MASK(index) | 4693117bb31SNicolin Chen ASRCDRi_AOCDi_MASK(index) | ASRCDRi_AICDi_MASK(index), 4703117bb31SNicolin Chen ASRCDRi_AOCP(index, outdiv) | ASRCDRi_AICP(index, indiv)); 4713117bb31SNicolin Chen 4723117bb31SNicolin Chen /* Implement word_width configurations */ 4737470704dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRMCR1(index), 4743117bb31SNicolin Chen ASRMCR1i_OW16_MASK | ASRMCR1i_IWD_MASK, 4754bf62571SShengjiu Wang ASRMCR1i_OW16(output_word_width) | 4764bf62571SShengjiu Wang ASRMCR1i_IWD(input_word_width)); 4773117bb31SNicolin Chen 4783117bb31SNicolin Chen /* Enable BUFFER STALL */ 4797470704dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRMCR(index), 4803117bb31SNicolin Chen ASRMCRi_BUFSTALLi_MASK, ASRMCRi_BUFSTALLi); 4813117bb31SNicolin Chen 4823117bb31SNicolin Chen /* Set default thresholds for input and output FIFO */ 4833117bb31SNicolin Chen fsl_asrc_set_watermarks(pair, ASRC_INPUTFIFO_THRESHOLD, 4843117bb31SNicolin Chen ASRC_INPUTFIFO_THRESHOLD); 4853117bb31SNicolin Chen 4864091fb95SMasahiro Yamada /* Configure the following only for Ideal Ratio mode */ 4873117bb31SNicolin Chen if (!ideal) 4883117bb31SNicolin Chen return 0; 4893117bb31SNicolin Chen 4903117bb31SNicolin Chen /* Clear ASTSx bit to use Ideal Ratio mode */ 4917470704dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRCTR, 4923117bb31SNicolin Chen ASRCTR_ATSi_MASK(index), 0); 4933117bb31SNicolin Chen 4943117bb31SNicolin Chen /* Enable Ideal Ratio mode */ 4957470704dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRCTR, 4963117bb31SNicolin Chen ASRCTR_IDRi_MASK(index) | ASRCTR_USRi_MASK(index), 4973117bb31SNicolin Chen ASRCTR_IDR(index) | ASRCTR_USR(index)); 4983117bb31SNicolin Chen 4994aecaa0aSS.j. Wang fsl_asrc_sel_proc(inrate, outrate, &pre_proc, &post_proc); 5004aecaa0aSS.j. Wang 5013117bb31SNicolin Chen /* Apply configurations for pre- and post-processing */ 5027470704dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRCFG, 5033117bb31SNicolin Chen ASRCFG_PREMODi_MASK(index) | ASRCFG_POSTMODi_MASK(index), 5044aecaa0aSS.j. Wang ASRCFG_PREMOD(index, pre_proc) | 5054aecaa0aSS.j. Wang ASRCFG_POSTMOD(index, post_proc)); 5063117bb31SNicolin Chen 5073117bb31SNicolin Chen return fsl_asrc_set_ideal_ratio(pair, inrate, outrate); 5083117bb31SNicolin Chen } 5093117bb31SNicolin Chen 5103117bb31SNicolin Chen /** 5113117bb31SNicolin Chen * Start the assigned ASRC pair 5123117bb31SNicolin Chen * 5133117bb31SNicolin Chen * It enables the assigned pair and makes it stopped at the stall level. 5143117bb31SNicolin Chen */ 5153117bb31SNicolin Chen static void fsl_asrc_start_pair(struct fsl_asrc_pair *pair) 5163117bb31SNicolin Chen { 5177470704dSShengjiu Wang struct fsl_asrc *asrc = pair->asrc; 5183117bb31SNicolin Chen enum asrc_pair_index index = pair->index; 5193117bb31SNicolin Chen int reg, retry = 10, i; 5203117bb31SNicolin Chen 5213117bb31SNicolin Chen /* Enable the current pair */ 5227470704dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRCTR, 5233117bb31SNicolin Chen ASRCTR_ASRCEi_MASK(index), ASRCTR_ASRCE(index)); 5243117bb31SNicolin Chen 5253117bb31SNicolin Chen /* Wait for status of initialization */ 5263117bb31SNicolin Chen do { 5273117bb31SNicolin Chen udelay(5); 5287470704dSShengjiu Wang regmap_read(asrc->regmap, REG_ASRCFG, ®); 5293117bb31SNicolin Chen reg &= ASRCFG_INIRQi_MASK(index); 5303117bb31SNicolin Chen } while (!reg && --retry); 5313117bb31SNicolin Chen 5323117bb31SNicolin Chen /* Make the input fifo to ASRC STALL level */ 5337470704dSShengjiu Wang regmap_read(asrc->regmap, REG_ASRCNCR, ®); 5343117bb31SNicolin Chen for (i = 0; i < pair->channels * 4; i++) 5357470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRDI(index), 0); 5363117bb31SNicolin Chen 5373117bb31SNicolin Chen /* Enable overload interrupt */ 5387470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRIER, ASRIER_AOLIE); 5393117bb31SNicolin Chen } 5403117bb31SNicolin Chen 5413117bb31SNicolin Chen /** 5423117bb31SNicolin Chen * Stop the assigned ASRC pair 5433117bb31SNicolin Chen */ 5443117bb31SNicolin Chen static void fsl_asrc_stop_pair(struct fsl_asrc_pair *pair) 5453117bb31SNicolin Chen { 5467470704dSShengjiu Wang struct fsl_asrc *asrc = pair->asrc; 5473117bb31SNicolin Chen enum asrc_pair_index index = pair->index; 5483117bb31SNicolin Chen 5493117bb31SNicolin Chen /* Stop the current pair */ 5507470704dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRCTR, 5513117bb31SNicolin Chen ASRCTR_ASRCEi_MASK(index), 0); 5523117bb31SNicolin Chen } 5533117bb31SNicolin Chen 5543117bb31SNicolin Chen /** 5553117bb31SNicolin Chen * Get DMA channel according to the pair and direction. 5563117bb31SNicolin Chen */ 5573117bb31SNicolin Chen struct dma_chan *fsl_asrc_get_dma_channel(struct fsl_asrc_pair *pair, bool dir) 5583117bb31SNicolin Chen { 5597470704dSShengjiu Wang struct fsl_asrc *asrc = pair->asrc; 5603117bb31SNicolin Chen enum asrc_pair_index index = pair->index; 5613117bb31SNicolin Chen char name[4]; 5623117bb31SNicolin Chen 5633117bb31SNicolin Chen sprintf(name, "%cx%c", dir == IN ? 'r' : 't', index + 'a'); 5643117bb31SNicolin Chen 5657470704dSShengjiu Wang return dma_request_slave_channel(&asrc->pdev->dev, name); 5663117bb31SNicolin Chen } 5673117bb31SNicolin Chen EXPORT_SYMBOL_GPL(fsl_asrc_get_dma_channel); 5683117bb31SNicolin Chen 56953f67a78SS.j. Wang static int fsl_asrc_dai_startup(struct snd_pcm_substream *substream, 57053f67a78SS.j. Wang struct snd_soc_dai *dai) 57153f67a78SS.j. Wang { 5727470704dSShengjiu Wang struct fsl_asrc *asrc = snd_soc_dai_get_drvdata(dai); 573be7bd03fSShengjiu Wang struct fsl_asrc_priv *asrc_priv = asrc->private; 57453f67a78SS.j. Wang 57553f67a78SS.j. Wang /* Odd channel number is not valid for older ASRC (channel_bits==3) */ 576be7bd03fSShengjiu Wang if (asrc_priv->soc->channel_bits == 3) 57753f67a78SS.j. Wang snd_pcm_hw_constraint_step(substream->runtime, 0, 57853f67a78SS.j. Wang SNDRV_PCM_HW_PARAM_CHANNELS, 2); 57953f67a78SS.j. Wang 580d281bf5dSS.j. Wang 581d281bf5dSS.j. Wang return snd_pcm_hw_constraint_list(substream->runtime, 0, 582d281bf5dSS.j. Wang SNDRV_PCM_HW_PARAM_RATE, &fsl_asrc_rate_constraints); 58353f67a78SS.j. Wang } 58453f67a78SS.j. Wang 5853117bb31SNicolin Chen static int fsl_asrc_dai_hw_params(struct snd_pcm_substream *substream, 5863117bb31SNicolin Chen struct snd_pcm_hw_params *params, 5873117bb31SNicolin Chen struct snd_soc_dai *dai) 5883117bb31SNicolin Chen { 5897470704dSShengjiu Wang struct fsl_asrc *asrc = snd_soc_dai_get_drvdata(dai); 5903117bb31SNicolin Chen struct snd_pcm_runtime *runtime = substream->runtime; 5913117bb31SNicolin Chen struct fsl_asrc_pair *pair = runtime->private_data; 592be7bd03fSShengjiu Wang struct fsl_asrc_pair_priv *pair_priv = pair->private; 5933117bb31SNicolin Chen unsigned int channels = params_channels(params); 5943117bb31SNicolin Chen unsigned int rate = params_rate(params); 5953117bb31SNicolin Chen struct asrc_config config; 5964bf62571SShengjiu Wang int ret; 5973117bb31SNicolin Chen 5983117bb31SNicolin Chen ret = fsl_asrc_request_pair(channels, pair); 5993117bb31SNicolin Chen if (ret) { 6003117bb31SNicolin Chen dev_err(dai->dev, "fail to request asrc pair\n"); 6013117bb31SNicolin Chen return ret; 6023117bb31SNicolin Chen } 6033117bb31SNicolin Chen 604be7bd03fSShengjiu Wang pair_priv->config = &config; 6053117bb31SNicolin Chen 6063117bb31SNicolin Chen config.pair = pair->index; 6073117bb31SNicolin Chen config.channel_num = channels; 6083117bb31SNicolin Chen config.inclk = INCLK_NONE; 6093117bb31SNicolin Chen config.outclk = OUTCLK_ASRCK1_CLK; 6103117bb31SNicolin Chen 6113117bb31SNicolin Chen if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 6124bf62571SShengjiu Wang config.input_format = params_format(params); 6134520af41SShengjiu Wang config.output_format = asrc->asrc_format; 6143117bb31SNicolin Chen config.input_sample_rate = rate; 6157470704dSShengjiu Wang config.output_sample_rate = asrc->asrc_rate; 6163117bb31SNicolin Chen } else { 6174520af41SShengjiu Wang config.input_format = asrc->asrc_format; 6184bf62571SShengjiu Wang config.output_format = params_format(params); 6197470704dSShengjiu Wang config.input_sample_rate = asrc->asrc_rate; 6203117bb31SNicolin Chen config.output_sample_rate = rate; 6213117bb31SNicolin Chen } 6223117bb31SNicolin Chen 623b39eb1e2SShengjiu Wang ret = fsl_asrc_config_pair(pair, false); 6243117bb31SNicolin Chen if (ret) { 6253117bb31SNicolin Chen dev_err(dai->dev, "fail to config asrc pair\n"); 6263117bb31SNicolin Chen return ret; 6273117bb31SNicolin Chen } 6283117bb31SNicolin Chen 6293117bb31SNicolin Chen return 0; 6303117bb31SNicolin Chen } 6313117bb31SNicolin Chen 6323117bb31SNicolin Chen static int fsl_asrc_dai_hw_free(struct snd_pcm_substream *substream, 6333117bb31SNicolin Chen struct snd_soc_dai *dai) 6343117bb31SNicolin Chen { 6353117bb31SNicolin Chen struct snd_pcm_runtime *runtime = substream->runtime; 6363117bb31SNicolin Chen struct fsl_asrc_pair *pair = runtime->private_data; 6373117bb31SNicolin Chen 6383117bb31SNicolin Chen if (pair) 6393117bb31SNicolin Chen fsl_asrc_release_pair(pair); 6403117bb31SNicolin Chen 6413117bb31SNicolin Chen return 0; 6423117bb31SNicolin Chen } 6433117bb31SNicolin Chen 6443117bb31SNicolin Chen static int fsl_asrc_dai_trigger(struct snd_pcm_substream *substream, int cmd, 6453117bb31SNicolin Chen struct snd_soc_dai *dai) 6463117bb31SNicolin Chen { 6473117bb31SNicolin Chen struct snd_pcm_runtime *runtime = substream->runtime; 6483117bb31SNicolin Chen struct fsl_asrc_pair *pair = runtime->private_data; 6493117bb31SNicolin Chen 6503117bb31SNicolin Chen switch (cmd) { 6513117bb31SNicolin Chen case SNDRV_PCM_TRIGGER_START: 6523117bb31SNicolin Chen case SNDRV_PCM_TRIGGER_RESUME: 6533117bb31SNicolin Chen case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 6543117bb31SNicolin Chen fsl_asrc_start_pair(pair); 6553117bb31SNicolin Chen break; 6563117bb31SNicolin Chen case SNDRV_PCM_TRIGGER_STOP: 6573117bb31SNicolin Chen case SNDRV_PCM_TRIGGER_SUSPEND: 6583117bb31SNicolin Chen case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 6593117bb31SNicolin Chen fsl_asrc_stop_pair(pair); 6603117bb31SNicolin Chen break; 6613117bb31SNicolin Chen default: 6623117bb31SNicolin Chen return -EINVAL; 6633117bb31SNicolin Chen } 6643117bb31SNicolin Chen 6653117bb31SNicolin Chen return 0; 6663117bb31SNicolin Chen } 6673117bb31SNicolin Chen 66829a22ebfSGustavo A. R. Silva static const struct snd_soc_dai_ops fsl_asrc_dai_ops = { 66953f67a78SS.j. Wang .startup = fsl_asrc_dai_startup, 6703117bb31SNicolin Chen .hw_params = fsl_asrc_dai_hw_params, 6713117bb31SNicolin Chen .hw_free = fsl_asrc_dai_hw_free, 6723117bb31SNicolin Chen .trigger = fsl_asrc_dai_trigger, 6733117bb31SNicolin Chen }; 6743117bb31SNicolin Chen 6753117bb31SNicolin Chen static int fsl_asrc_dai_probe(struct snd_soc_dai *dai) 6763117bb31SNicolin Chen { 6777470704dSShengjiu Wang struct fsl_asrc *asrc = snd_soc_dai_get_drvdata(dai); 6783117bb31SNicolin Chen 6797470704dSShengjiu Wang snd_soc_dai_init_dma_data(dai, &asrc->dma_params_tx, 6807470704dSShengjiu Wang &asrc->dma_params_rx); 6813117bb31SNicolin Chen 6823117bb31SNicolin Chen return 0; 6833117bb31SNicolin Chen } 6843117bb31SNicolin Chen 6853117bb31SNicolin Chen #define FSL_ASRC_FORMATS (SNDRV_PCM_FMTBIT_S24_LE | \ 6863117bb31SNicolin Chen SNDRV_PCM_FMTBIT_S16_LE | \ 687109539c9SShengjiu Wang SNDRV_PCM_FMTBIT_S24_3LE) 6883117bb31SNicolin Chen 6893117bb31SNicolin Chen static struct snd_soc_dai_driver fsl_asrc_dai = { 6903117bb31SNicolin Chen .probe = fsl_asrc_dai_probe, 6913117bb31SNicolin Chen .playback = { 6923117bb31SNicolin Chen .stream_name = "ASRC-Playback", 6933117bb31SNicolin Chen .channels_min = 1, 6943117bb31SNicolin Chen .channels_max = 10, 695d281bf5dSS.j. Wang .rate_min = 5512, 696d281bf5dSS.j. Wang .rate_max = 192000, 697d281bf5dSS.j. Wang .rates = SNDRV_PCM_RATE_KNOT, 698109539c9SShengjiu Wang .formats = FSL_ASRC_FORMATS | 699109539c9SShengjiu Wang SNDRV_PCM_FMTBIT_S8, 7003117bb31SNicolin Chen }, 7013117bb31SNicolin Chen .capture = { 7023117bb31SNicolin Chen .stream_name = "ASRC-Capture", 7033117bb31SNicolin Chen .channels_min = 1, 7043117bb31SNicolin Chen .channels_max = 10, 705d281bf5dSS.j. Wang .rate_min = 5512, 706d281bf5dSS.j. Wang .rate_max = 192000, 707d281bf5dSS.j. Wang .rates = SNDRV_PCM_RATE_KNOT, 7083117bb31SNicolin Chen .formats = FSL_ASRC_FORMATS, 7093117bb31SNicolin Chen }, 7103117bb31SNicolin Chen .ops = &fsl_asrc_dai_ops, 7113117bb31SNicolin Chen }; 7123117bb31SNicolin Chen 7133117bb31SNicolin Chen static bool fsl_asrc_readable_reg(struct device *dev, unsigned int reg) 7143117bb31SNicolin Chen { 7153117bb31SNicolin Chen switch (reg) { 7163117bb31SNicolin Chen case REG_ASRCTR: 7173117bb31SNicolin Chen case REG_ASRIER: 7183117bb31SNicolin Chen case REG_ASRCNCR: 7193117bb31SNicolin Chen case REG_ASRCFG: 7203117bb31SNicolin Chen case REG_ASRCSR: 7213117bb31SNicolin Chen case REG_ASRCDR1: 7223117bb31SNicolin Chen case REG_ASRCDR2: 7233117bb31SNicolin Chen case REG_ASRSTR: 7243117bb31SNicolin Chen case REG_ASRPM1: 7253117bb31SNicolin Chen case REG_ASRPM2: 7263117bb31SNicolin Chen case REG_ASRPM3: 7273117bb31SNicolin Chen case REG_ASRPM4: 7283117bb31SNicolin Chen case REG_ASRPM5: 7293117bb31SNicolin Chen case REG_ASRTFR1: 7303117bb31SNicolin Chen case REG_ASRCCR: 7313117bb31SNicolin Chen case REG_ASRDOA: 7323117bb31SNicolin Chen case REG_ASRDOB: 7333117bb31SNicolin Chen case REG_ASRDOC: 7343117bb31SNicolin Chen case REG_ASRIDRHA: 7353117bb31SNicolin Chen case REG_ASRIDRLA: 7363117bb31SNicolin Chen case REG_ASRIDRHB: 7373117bb31SNicolin Chen case REG_ASRIDRLB: 7383117bb31SNicolin Chen case REG_ASRIDRHC: 7393117bb31SNicolin Chen case REG_ASRIDRLC: 7403117bb31SNicolin Chen case REG_ASR76K: 7413117bb31SNicolin Chen case REG_ASR56K: 7423117bb31SNicolin Chen case REG_ASRMCRA: 7433117bb31SNicolin Chen case REG_ASRFSTA: 7443117bb31SNicolin Chen case REG_ASRMCRB: 7453117bb31SNicolin Chen case REG_ASRFSTB: 7463117bb31SNicolin Chen case REG_ASRMCRC: 7473117bb31SNicolin Chen case REG_ASRFSTC: 7483117bb31SNicolin Chen case REG_ASRMCR1A: 7493117bb31SNicolin Chen case REG_ASRMCR1B: 7503117bb31SNicolin Chen case REG_ASRMCR1C: 7513117bb31SNicolin Chen return true; 7523117bb31SNicolin Chen default: 7533117bb31SNicolin Chen return false; 7543117bb31SNicolin Chen } 7553117bb31SNicolin Chen } 7563117bb31SNicolin Chen 7573117bb31SNicolin Chen static bool fsl_asrc_volatile_reg(struct device *dev, unsigned int reg) 7583117bb31SNicolin Chen { 7593117bb31SNicolin Chen switch (reg) { 7603117bb31SNicolin Chen case REG_ASRSTR: 7613117bb31SNicolin Chen case REG_ASRDIA: 7623117bb31SNicolin Chen case REG_ASRDIB: 7633117bb31SNicolin Chen case REG_ASRDIC: 7643117bb31SNicolin Chen case REG_ASRDOA: 7653117bb31SNicolin Chen case REG_ASRDOB: 7663117bb31SNicolin Chen case REG_ASRDOC: 7673117bb31SNicolin Chen case REG_ASRFSTA: 7683117bb31SNicolin Chen case REG_ASRFSTB: 7693117bb31SNicolin Chen case REG_ASRFSTC: 7703117bb31SNicolin Chen case REG_ASRCFG: 7713117bb31SNicolin Chen return true; 7723117bb31SNicolin Chen default: 7733117bb31SNicolin Chen return false; 7743117bb31SNicolin Chen } 7753117bb31SNicolin Chen } 7763117bb31SNicolin Chen 7773117bb31SNicolin Chen static bool fsl_asrc_writeable_reg(struct device *dev, unsigned int reg) 7783117bb31SNicolin Chen { 7793117bb31SNicolin Chen switch (reg) { 7803117bb31SNicolin Chen case REG_ASRCTR: 7813117bb31SNicolin Chen case REG_ASRIER: 7823117bb31SNicolin Chen case REG_ASRCNCR: 7833117bb31SNicolin Chen case REG_ASRCFG: 7843117bb31SNicolin Chen case REG_ASRCSR: 7853117bb31SNicolin Chen case REG_ASRCDR1: 7863117bb31SNicolin Chen case REG_ASRCDR2: 7873117bb31SNicolin Chen case REG_ASRSTR: 7883117bb31SNicolin Chen case REG_ASRPM1: 7893117bb31SNicolin Chen case REG_ASRPM2: 7903117bb31SNicolin Chen case REG_ASRPM3: 7913117bb31SNicolin Chen case REG_ASRPM4: 7923117bb31SNicolin Chen case REG_ASRPM5: 7933117bb31SNicolin Chen case REG_ASRTFR1: 7943117bb31SNicolin Chen case REG_ASRCCR: 7953117bb31SNicolin Chen case REG_ASRDIA: 7963117bb31SNicolin Chen case REG_ASRDIB: 7973117bb31SNicolin Chen case REG_ASRDIC: 7983117bb31SNicolin Chen case REG_ASRIDRHA: 7993117bb31SNicolin Chen case REG_ASRIDRLA: 8003117bb31SNicolin Chen case REG_ASRIDRHB: 8013117bb31SNicolin Chen case REG_ASRIDRLB: 8023117bb31SNicolin Chen case REG_ASRIDRHC: 8033117bb31SNicolin Chen case REG_ASRIDRLC: 8043117bb31SNicolin Chen case REG_ASR76K: 8053117bb31SNicolin Chen case REG_ASR56K: 8063117bb31SNicolin Chen case REG_ASRMCRA: 8073117bb31SNicolin Chen case REG_ASRMCRB: 8083117bb31SNicolin Chen case REG_ASRMCRC: 8093117bb31SNicolin Chen case REG_ASRMCR1A: 8103117bb31SNicolin Chen case REG_ASRMCR1B: 8113117bb31SNicolin Chen case REG_ASRMCR1C: 8123117bb31SNicolin Chen return true; 8133117bb31SNicolin Chen default: 8143117bb31SNicolin Chen return false; 8153117bb31SNicolin Chen } 8163117bb31SNicolin Chen } 8173117bb31SNicolin Chen 81886a570c5SNicolin Chen static struct reg_default fsl_asrc_reg[] = { 81986a570c5SNicolin Chen { REG_ASRCTR, 0x0000 }, { REG_ASRIER, 0x0000 }, 82086a570c5SNicolin Chen { REG_ASRCNCR, 0x0000 }, { REG_ASRCFG, 0x0000 }, 82186a570c5SNicolin Chen { REG_ASRCSR, 0x0000 }, { REG_ASRCDR1, 0x0000 }, 82286a570c5SNicolin Chen { REG_ASRCDR2, 0x0000 }, { REG_ASRSTR, 0x0000 }, 82386a570c5SNicolin Chen { REG_ASRRA, 0x0000 }, { REG_ASRRB, 0x0000 }, 82486a570c5SNicolin Chen { REG_ASRRC, 0x0000 }, { REG_ASRPM1, 0x0000 }, 82586a570c5SNicolin Chen { REG_ASRPM2, 0x0000 }, { REG_ASRPM3, 0x0000 }, 82686a570c5SNicolin Chen { REG_ASRPM4, 0x0000 }, { REG_ASRPM5, 0x0000 }, 82786a570c5SNicolin Chen { REG_ASRTFR1, 0x0000 }, { REG_ASRCCR, 0x0000 }, 82886a570c5SNicolin Chen { REG_ASRDIA, 0x0000 }, { REG_ASRDOA, 0x0000 }, 82986a570c5SNicolin Chen { REG_ASRDIB, 0x0000 }, { REG_ASRDOB, 0x0000 }, 83086a570c5SNicolin Chen { REG_ASRDIC, 0x0000 }, { REG_ASRDOC, 0x0000 }, 83186a570c5SNicolin Chen { REG_ASRIDRHA, 0x0000 }, { REG_ASRIDRLA, 0x0000 }, 83286a570c5SNicolin Chen { REG_ASRIDRHB, 0x0000 }, { REG_ASRIDRLB, 0x0000 }, 83386a570c5SNicolin Chen { REG_ASRIDRHC, 0x0000 }, { REG_ASRIDRLC, 0x0000 }, 83486a570c5SNicolin Chen { REG_ASR76K, 0x0A47 }, { REG_ASR56K, 0x0DF3 }, 83586a570c5SNicolin Chen { REG_ASRMCRA, 0x0000 }, { REG_ASRFSTA, 0x0000 }, 83686a570c5SNicolin Chen { REG_ASRMCRB, 0x0000 }, { REG_ASRFSTB, 0x0000 }, 83786a570c5SNicolin Chen { REG_ASRMCRC, 0x0000 }, { REG_ASRFSTC, 0x0000 }, 83886a570c5SNicolin Chen { REG_ASRMCR1A, 0x0000 }, { REG_ASRMCR1B, 0x0000 }, 83986a570c5SNicolin Chen { REG_ASRMCR1C, 0x0000 }, 84086a570c5SNicolin Chen }; 84186a570c5SNicolin Chen 842bf16d883SXiubo Li static const struct regmap_config fsl_asrc_regmap_config = { 8433117bb31SNicolin Chen .reg_bits = 32, 8443117bb31SNicolin Chen .reg_stride = 4, 8453117bb31SNicolin Chen .val_bits = 32, 8463117bb31SNicolin Chen 8473117bb31SNicolin Chen .max_register = REG_ASRMCR1C, 84886a570c5SNicolin Chen .reg_defaults = fsl_asrc_reg, 84986a570c5SNicolin Chen .num_reg_defaults = ARRAY_SIZE(fsl_asrc_reg), 8503117bb31SNicolin Chen .readable_reg = fsl_asrc_readable_reg, 8513117bb31SNicolin Chen .volatile_reg = fsl_asrc_volatile_reg, 8523117bb31SNicolin Chen .writeable_reg = fsl_asrc_writeable_reg, 853b4138868SMarek Vasut .cache_type = REGCACHE_FLAT, 8543117bb31SNicolin Chen }; 8553117bb31SNicolin Chen 8563117bb31SNicolin Chen /** 8573117bb31SNicolin Chen * Initialize ASRC registers with a default configurations 8583117bb31SNicolin Chen */ 8597470704dSShengjiu Wang static int fsl_asrc_init(struct fsl_asrc *asrc) 8603117bb31SNicolin Chen { 8613117bb31SNicolin Chen /* Halt ASRC internal FP when input FIFO needs data for pair A, B, C */ 8627470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRCTR, ASRCTR_ASRCEN); 8633117bb31SNicolin Chen 8643117bb31SNicolin Chen /* Disable interrupt by default */ 8657470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRIER, 0x0); 8663117bb31SNicolin Chen 8673117bb31SNicolin Chen /* Apply recommended settings for parameters from Reference Manual */ 8687470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRPM1, 0x7fffff); 8697470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRPM2, 0x255555); 8707470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRPM3, 0xff7280); 8717470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRPM4, 0xff7280); 8727470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRPM5, 0xff7280); 8733117bb31SNicolin Chen 8743117bb31SNicolin Chen /* Base address for task queue FIFO. Set to 0x7C */ 8757470704dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRTFR1, 8763117bb31SNicolin Chen ASRTFR1_TF_BASE_MASK, ASRTFR1_TF_BASE(0xfc)); 8773117bb31SNicolin Chen 8783117bb31SNicolin Chen /* Set the processing clock for 76KHz to 133M */ 8797470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASR76K, 0x06D6); 8803117bb31SNicolin Chen 8813117bb31SNicolin Chen /* Set the processing clock for 56KHz to 133M */ 8827470704dSShengjiu Wang return regmap_write(asrc->regmap, REG_ASR56K, 0x0947); 8833117bb31SNicolin Chen } 8843117bb31SNicolin Chen 8853117bb31SNicolin Chen /** 8863117bb31SNicolin Chen * Interrupt handler for ASRC 8873117bb31SNicolin Chen */ 8883117bb31SNicolin Chen static irqreturn_t fsl_asrc_isr(int irq, void *dev_id) 8893117bb31SNicolin Chen { 8907470704dSShengjiu Wang struct fsl_asrc *asrc = (struct fsl_asrc *)dev_id; 8917470704dSShengjiu Wang struct device *dev = &asrc->pdev->dev; 8923117bb31SNicolin Chen enum asrc_pair_index index; 8933117bb31SNicolin Chen u32 status; 8943117bb31SNicolin Chen 8957470704dSShengjiu Wang regmap_read(asrc->regmap, REG_ASRSTR, &status); 8963117bb31SNicolin Chen 8973117bb31SNicolin Chen /* Clean overload error */ 8987470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRSTR, ASRSTR_AOLE); 8993117bb31SNicolin Chen 9003117bb31SNicolin Chen /* 9013117bb31SNicolin Chen * We here use dev_dbg() for all exceptions because ASRC itself does 9023117bb31SNicolin Chen * not care if FIFO overflowed or underrun while a warning in the 9033117bb31SNicolin Chen * interrupt would result a ridged conversion. 9043117bb31SNicolin Chen */ 9053117bb31SNicolin Chen for (index = ASRC_PAIR_A; index < ASRC_PAIR_MAX_NUM; index++) { 9067470704dSShengjiu Wang if (!asrc->pair[index]) 9073117bb31SNicolin Chen continue; 9083117bb31SNicolin Chen 9093117bb31SNicolin Chen if (status & ASRSTR_ATQOL) { 9107470704dSShengjiu Wang asrc->pair[index]->error |= ASRC_TASK_Q_OVERLOAD; 9113117bb31SNicolin Chen dev_dbg(dev, "ASRC Task Queue FIFO overload\n"); 9123117bb31SNicolin Chen } 9133117bb31SNicolin Chen 9143117bb31SNicolin Chen if (status & ASRSTR_AOOL(index)) { 9157470704dSShengjiu Wang asrc->pair[index]->error |= ASRC_OUTPUT_TASK_OVERLOAD; 9163117bb31SNicolin Chen pair_dbg("Output Task Overload\n"); 9173117bb31SNicolin Chen } 9183117bb31SNicolin Chen 9193117bb31SNicolin Chen if (status & ASRSTR_AIOL(index)) { 9207470704dSShengjiu Wang asrc->pair[index]->error |= ASRC_INPUT_TASK_OVERLOAD; 9213117bb31SNicolin Chen pair_dbg("Input Task Overload\n"); 9223117bb31SNicolin Chen } 9233117bb31SNicolin Chen 9243117bb31SNicolin Chen if (status & ASRSTR_AODO(index)) { 9257470704dSShengjiu Wang asrc->pair[index]->error |= ASRC_OUTPUT_BUFFER_OVERFLOW; 9263117bb31SNicolin Chen pair_dbg("Output Data Buffer has overflowed\n"); 9273117bb31SNicolin Chen } 9283117bb31SNicolin Chen 9293117bb31SNicolin Chen if (status & ASRSTR_AIDU(index)) { 9307470704dSShengjiu Wang asrc->pair[index]->error |= ASRC_INPUT_BUFFER_UNDERRUN; 9313117bb31SNicolin Chen pair_dbg("Input Data Buffer has underflowed\n"); 9323117bb31SNicolin Chen } 9333117bb31SNicolin Chen } 9343117bb31SNicolin Chen 9353117bb31SNicolin Chen return IRQ_HANDLED; 9363117bb31SNicolin Chen } 9373117bb31SNicolin Chen 938be7bd03fSShengjiu Wang static int fsl_asrc_get_fifo_addr(u8 dir, enum asrc_pair_index index) 939be7bd03fSShengjiu Wang { 940be7bd03fSShengjiu Wang return REG_ASRDx(dir, index); 941be7bd03fSShengjiu Wang } 942be7bd03fSShengjiu Wang 9433117bb31SNicolin Chen static int fsl_asrc_probe(struct platform_device *pdev) 9443117bb31SNicolin Chen { 9453117bb31SNicolin Chen struct device_node *np = pdev->dev.of_node; 946be7bd03fSShengjiu Wang struct fsl_asrc_priv *asrc_priv; 9477470704dSShengjiu Wang struct fsl_asrc *asrc; 9483117bb31SNicolin Chen struct resource *res; 9493117bb31SNicolin Chen void __iomem *regs; 9503117bb31SNicolin Chen int irq, ret, i; 951c05f10f2SShengjiu Wang u32 map_idx; 9523117bb31SNicolin Chen char tmp[16]; 9534520af41SShengjiu Wang u32 width; 9543117bb31SNicolin Chen 9557470704dSShengjiu Wang asrc = devm_kzalloc(&pdev->dev, sizeof(*asrc), GFP_KERNEL); 9567470704dSShengjiu Wang if (!asrc) 9573117bb31SNicolin Chen return -ENOMEM; 9583117bb31SNicolin Chen 959be7bd03fSShengjiu Wang asrc_priv = devm_kzalloc(&pdev->dev, sizeof(*asrc_priv), GFP_KERNEL); 960be7bd03fSShengjiu Wang if (!asrc_priv) 961be7bd03fSShengjiu Wang return -ENOMEM; 962be7bd03fSShengjiu Wang 9637470704dSShengjiu Wang asrc->pdev = pdev; 964be7bd03fSShengjiu Wang asrc->private = asrc_priv; 9653117bb31SNicolin Chen 9663117bb31SNicolin Chen /* Get the addresses and IRQ */ 9673117bb31SNicolin Chen res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 9683117bb31SNicolin Chen regs = devm_ioremap_resource(&pdev->dev, res); 9693117bb31SNicolin Chen if (IS_ERR(regs)) 9703117bb31SNicolin Chen return PTR_ERR(regs); 9713117bb31SNicolin Chen 9727470704dSShengjiu Wang asrc->paddr = res->start; 9733117bb31SNicolin Chen 9747470704dSShengjiu Wang asrc->regmap = devm_regmap_init_mmio_clk(&pdev->dev, "mem", regs, 9753117bb31SNicolin Chen &fsl_asrc_regmap_config); 9767470704dSShengjiu Wang if (IS_ERR(asrc->regmap)) { 9773117bb31SNicolin Chen dev_err(&pdev->dev, "failed to init regmap\n"); 9787470704dSShengjiu Wang return PTR_ERR(asrc->regmap); 9793117bb31SNicolin Chen } 9803117bb31SNicolin Chen 9813117bb31SNicolin Chen irq = platform_get_irq(pdev, 0); 982cf9441adSStephen Boyd if (irq < 0) 9833117bb31SNicolin Chen return irq; 9843117bb31SNicolin Chen 9853117bb31SNicolin Chen ret = devm_request_irq(&pdev->dev, irq, fsl_asrc_isr, 0, 9867470704dSShengjiu Wang dev_name(&pdev->dev), asrc); 9873117bb31SNicolin Chen if (ret) { 9883117bb31SNicolin Chen dev_err(&pdev->dev, "failed to claim irq %u: %d\n", irq, ret); 9893117bb31SNicolin Chen return ret; 9903117bb31SNicolin Chen } 9913117bb31SNicolin Chen 9927470704dSShengjiu Wang asrc->mem_clk = devm_clk_get(&pdev->dev, "mem"); 9937470704dSShengjiu Wang if (IS_ERR(asrc->mem_clk)) { 9943117bb31SNicolin Chen dev_err(&pdev->dev, "failed to get mem clock\n"); 9957470704dSShengjiu Wang return PTR_ERR(asrc->mem_clk); 9963117bb31SNicolin Chen } 9973117bb31SNicolin Chen 9987470704dSShengjiu Wang asrc->ipg_clk = devm_clk_get(&pdev->dev, "ipg"); 9997470704dSShengjiu Wang if (IS_ERR(asrc->ipg_clk)) { 10003117bb31SNicolin Chen dev_err(&pdev->dev, "failed to get ipg clock\n"); 10017470704dSShengjiu Wang return PTR_ERR(asrc->ipg_clk); 10023117bb31SNicolin Chen } 10033117bb31SNicolin Chen 10047470704dSShengjiu Wang asrc->spba_clk = devm_clk_get(&pdev->dev, "spba"); 10057470704dSShengjiu Wang if (IS_ERR(asrc->spba_clk)) 100613b8a97aSShengjiu Wang dev_warn(&pdev->dev, "failed to get spba clock\n"); 100713b8a97aSShengjiu Wang 10083117bb31SNicolin Chen for (i = 0; i < ASRC_CLK_MAX_NUM; i++) { 10093117bb31SNicolin Chen sprintf(tmp, "asrck_%x", i); 1010be7bd03fSShengjiu Wang asrc_priv->asrck_clk[i] = devm_clk_get(&pdev->dev, tmp); 1011be7bd03fSShengjiu Wang if (IS_ERR(asrc_priv->asrck_clk[i])) { 10123117bb31SNicolin Chen dev_err(&pdev->dev, "failed to get %s clock\n", tmp); 1013be7bd03fSShengjiu Wang return PTR_ERR(asrc_priv->asrck_clk[i]); 10143117bb31SNicolin Chen } 10153117bb31SNicolin Chen } 10163117bb31SNicolin Chen 1017be7bd03fSShengjiu Wang asrc_priv->soc = of_device_get_match_data(&pdev->dev); 1018be7bd03fSShengjiu Wang if (!asrc_priv->soc) { 1019c05f10f2SShengjiu Wang dev_err(&pdev->dev, "failed to get soc data\n"); 1020c05f10f2SShengjiu Wang return -ENODEV; 1021c05f10f2SShengjiu Wang } 1022c05f10f2SShengjiu Wang 1023be7bd03fSShengjiu Wang asrc->use_edma = asrc_priv->soc->use_edma; 1024be7bd03fSShengjiu Wang asrc->get_dma_channel = fsl_asrc_get_dma_channel; 1025be7bd03fSShengjiu Wang asrc->request_pair = fsl_asrc_request_pair; 1026be7bd03fSShengjiu Wang asrc->release_pair = fsl_asrc_release_pair; 1027be7bd03fSShengjiu Wang asrc->get_fifo_addr = fsl_asrc_get_fifo_addr; 1028be7bd03fSShengjiu Wang asrc->pair_priv_size = sizeof(struct fsl_asrc_pair_priv); 1029be7bd03fSShengjiu Wang 1030f3d8ac8cSFabio Estevam if (of_device_is_compatible(np, "fsl,imx35-asrc")) { 1031be7bd03fSShengjiu Wang asrc_priv->clk_map[IN] = input_clk_map_imx35; 1032be7bd03fSShengjiu Wang asrc_priv->clk_map[OUT] = output_clk_map_imx35; 1033c05f10f2SShengjiu Wang } else if (of_device_is_compatible(np, "fsl,imx53-asrc")) { 1034be7bd03fSShengjiu Wang asrc_priv->clk_map[IN] = input_clk_map_imx53; 1035be7bd03fSShengjiu Wang asrc_priv->clk_map[OUT] = output_clk_map_imx53; 1036c05f10f2SShengjiu Wang } else if (of_device_is_compatible(np, "fsl,imx8qm-asrc") || 1037c05f10f2SShengjiu Wang of_device_is_compatible(np, "fsl,imx8qxp-asrc")) { 1038c05f10f2SShengjiu Wang ret = of_property_read_u32(np, "fsl,asrc-clk-map", &map_idx); 1039c05f10f2SShengjiu Wang if (ret) { 1040c05f10f2SShengjiu Wang dev_err(&pdev->dev, "failed to get clk map index\n"); 1041c05f10f2SShengjiu Wang return ret; 1042c05f10f2SShengjiu Wang } 1043c05f10f2SShengjiu Wang 1044c05f10f2SShengjiu Wang if (map_idx > 1) { 1045c05f10f2SShengjiu Wang dev_err(&pdev->dev, "unsupported clk map index\n"); 1046c05f10f2SShengjiu Wang return -EINVAL; 1047c05f10f2SShengjiu Wang } 1048c05f10f2SShengjiu Wang if (of_device_is_compatible(np, "fsl,imx8qm-asrc")) { 1049be7bd03fSShengjiu Wang asrc_priv->clk_map[IN] = clk_map_imx8qm[map_idx]; 1050be7bd03fSShengjiu Wang asrc_priv->clk_map[OUT] = clk_map_imx8qm[map_idx]; 10513117bb31SNicolin Chen } else { 1052be7bd03fSShengjiu Wang asrc_priv->clk_map[IN] = clk_map_imx8qxp[map_idx]; 1053be7bd03fSShengjiu Wang asrc_priv->clk_map[OUT] = clk_map_imx8qxp[map_idx]; 1054c05f10f2SShengjiu Wang } 10553117bb31SNicolin Chen } 10563117bb31SNicolin Chen 10577470704dSShengjiu Wang ret = fsl_asrc_init(asrc); 10583117bb31SNicolin Chen if (ret) { 10593117bb31SNicolin Chen dev_err(&pdev->dev, "failed to init asrc %d\n", ret); 1060c0296950SFabio Estevam return ret; 10613117bb31SNicolin Chen } 10623117bb31SNicolin Chen 10637470704dSShengjiu Wang asrc->channel_avail = 10; 10643117bb31SNicolin Chen 10653117bb31SNicolin Chen ret = of_property_read_u32(np, "fsl,asrc-rate", 10667470704dSShengjiu Wang &asrc->asrc_rate); 10673117bb31SNicolin Chen if (ret) { 10683117bb31SNicolin Chen dev_err(&pdev->dev, "failed to get output rate\n"); 1069c0296950SFabio Estevam return ret; 10703117bb31SNicolin Chen } 10713117bb31SNicolin Chen 10724520af41SShengjiu Wang ret = of_property_read_u32(np, "fsl,asrc-format", &asrc->asrc_format); 10733117bb31SNicolin Chen if (ret) { 10744520af41SShengjiu Wang ret = of_property_read_u32(np, "fsl,asrc-width", &width); 10754520af41SShengjiu Wang if (ret) { 10764520af41SShengjiu Wang dev_err(&pdev->dev, "failed to decide output format\n"); 1077c0296950SFabio Estevam return ret; 10783117bb31SNicolin Chen } 10793117bb31SNicolin Chen 10804520af41SShengjiu Wang switch (width) { 10814520af41SShengjiu Wang case 16: 10824520af41SShengjiu Wang asrc->asrc_format = SNDRV_PCM_FORMAT_S16_LE; 10834520af41SShengjiu Wang break; 10844520af41SShengjiu Wang case 24: 10854520af41SShengjiu Wang asrc->asrc_format = SNDRV_PCM_FORMAT_S24_LE; 10864520af41SShengjiu Wang break; 10874520af41SShengjiu Wang default: 10884520af41SShengjiu Wang dev_warn(&pdev->dev, 10894520af41SShengjiu Wang "unsupported width, use default S24_LE\n"); 10904520af41SShengjiu Wang asrc->asrc_format = SNDRV_PCM_FORMAT_S24_LE; 10914520af41SShengjiu Wang break; 10924520af41SShengjiu Wang } 10934520af41SShengjiu Wang } 10944520af41SShengjiu Wang 10954520af41SShengjiu Wang if (!(FSL_ASRC_FORMATS & (1ULL << asrc->asrc_format))) { 10964520af41SShengjiu Wang dev_warn(&pdev->dev, "unsupported width, use default S24_LE\n"); 10974520af41SShengjiu Wang asrc->asrc_format = SNDRV_PCM_FORMAT_S24_LE; 10983117bb31SNicolin Chen } 10993117bb31SNicolin Chen 11007470704dSShengjiu Wang platform_set_drvdata(pdev, asrc); 11013117bb31SNicolin Chen pm_runtime_enable(&pdev->dev); 11027470704dSShengjiu Wang spin_lock_init(&asrc->lock); 11033117bb31SNicolin Chen 11043117bb31SNicolin Chen ret = devm_snd_soc_register_component(&pdev->dev, &fsl_asrc_component, 11053117bb31SNicolin Chen &fsl_asrc_dai, 1); 11063117bb31SNicolin Chen if (ret) { 11073117bb31SNicolin Chen dev_err(&pdev->dev, "failed to register ASoC DAI\n"); 11083117bb31SNicolin Chen return ret; 11093117bb31SNicolin Chen } 11103117bb31SNicolin Chen 11113117bb31SNicolin Chen return 0; 11123117bb31SNicolin Chen } 11133117bb31SNicolin Chen 1114641d334bSRafael J. Wysocki #ifdef CONFIG_PM 11153117bb31SNicolin Chen static int fsl_asrc_runtime_resume(struct device *dev) 11163117bb31SNicolin Chen { 11177470704dSShengjiu Wang struct fsl_asrc *asrc = dev_get_drvdata(dev); 1118be7bd03fSShengjiu Wang struct fsl_asrc_priv *asrc_priv = asrc->private; 1119b1ade0f2SFabio Estevam int i, ret; 11203117bb31SNicolin Chen 11217470704dSShengjiu Wang ret = clk_prepare_enable(asrc->mem_clk); 1122b1ade0f2SFabio Estevam if (ret) 1123b1ade0f2SFabio Estevam return ret; 11247470704dSShengjiu Wang ret = clk_prepare_enable(asrc->ipg_clk); 1125b1ade0f2SFabio Estevam if (ret) 1126b1ade0f2SFabio Estevam goto disable_mem_clk; 11277470704dSShengjiu Wang if (!IS_ERR(asrc->spba_clk)) { 11287470704dSShengjiu Wang ret = clk_prepare_enable(asrc->spba_clk); 112913b8a97aSShengjiu Wang if (ret) 113013b8a97aSShengjiu Wang goto disable_ipg_clk; 113113b8a97aSShengjiu Wang } 1132b1ade0f2SFabio Estevam for (i = 0; i < ASRC_CLK_MAX_NUM; i++) { 1133be7bd03fSShengjiu Wang ret = clk_prepare_enable(asrc_priv->asrck_clk[i]); 1134b1ade0f2SFabio Estevam if (ret) 1135b1ade0f2SFabio Estevam goto disable_asrck_clk; 1136b1ade0f2SFabio Estevam } 11373117bb31SNicolin Chen 11383117bb31SNicolin Chen return 0; 1139b1ade0f2SFabio Estevam 1140b1ade0f2SFabio Estevam disable_asrck_clk: 1141b1ade0f2SFabio Estevam for (i--; i >= 0; i--) 1142be7bd03fSShengjiu Wang clk_disable_unprepare(asrc_priv->asrck_clk[i]); 11437470704dSShengjiu Wang if (!IS_ERR(asrc->spba_clk)) 11447470704dSShengjiu Wang clk_disable_unprepare(asrc->spba_clk); 114513b8a97aSShengjiu Wang disable_ipg_clk: 11467470704dSShengjiu Wang clk_disable_unprepare(asrc->ipg_clk); 1147b1ade0f2SFabio Estevam disable_mem_clk: 11487470704dSShengjiu Wang clk_disable_unprepare(asrc->mem_clk); 1149b1ade0f2SFabio Estevam return ret; 11503117bb31SNicolin Chen } 11513117bb31SNicolin Chen 11523117bb31SNicolin Chen static int fsl_asrc_runtime_suspend(struct device *dev) 11533117bb31SNicolin Chen { 11547470704dSShengjiu Wang struct fsl_asrc *asrc = dev_get_drvdata(dev); 1155be7bd03fSShengjiu Wang struct fsl_asrc_priv *asrc_priv = asrc->private; 11563117bb31SNicolin Chen int i; 11573117bb31SNicolin Chen 11583117bb31SNicolin Chen for (i = 0; i < ASRC_CLK_MAX_NUM; i++) 1159be7bd03fSShengjiu Wang clk_disable_unprepare(asrc_priv->asrck_clk[i]); 11607470704dSShengjiu Wang if (!IS_ERR(asrc->spba_clk)) 11617470704dSShengjiu Wang clk_disable_unprepare(asrc->spba_clk); 11627470704dSShengjiu Wang clk_disable_unprepare(asrc->ipg_clk); 11637470704dSShengjiu Wang clk_disable_unprepare(asrc->mem_clk); 11643117bb31SNicolin Chen 11653117bb31SNicolin Chen return 0; 11663117bb31SNicolin Chen } 1167641d334bSRafael J. Wysocki #endif /* CONFIG_PM */ 11683117bb31SNicolin Chen 1169d3dacda9SFabio Estevam #ifdef CONFIG_PM_SLEEP 11703117bb31SNicolin Chen static int fsl_asrc_suspend(struct device *dev) 11713117bb31SNicolin Chen { 11727470704dSShengjiu Wang struct fsl_asrc *asrc = dev_get_drvdata(dev); 1173be7bd03fSShengjiu Wang struct fsl_asrc_priv *asrc_priv = asrc->private; 11743117bb31SNicolin Chen 11757470704dSShengjiu Wang regmap_read(asrc->regmap, REG_ASRCFG, 1176be7bd03fSShengjiu Wang &asrc_priv->regcache_cfg); 1177d44c6114SZidan Wang 11787470704dSShengjiu Wang regcache_cache_only(asrc->regmap, true); 11797470704dSShengjiu Wang regcache_mark_dirty(asrc->regmap); 11803117bb31SNicolin Chen 11813117bb31SNicolin Chen return 0; 11823117bb31SNicolin Chen } 11833117bb31SNicolin Chen 11843117bb31SNicolin Chen static int fsl_asrc_resume(struct device *dev) 11853117bb31SNicolin Chen { 11867470704dSShengjiu Wang struct fsl_asrc *asrc = dev_get_drvdata(dev); 1187be7bd03fSShengjiu Wang struct fsl_asrc_priv *asrc_priv = asrc->private; 11883117bb31SNicolin Chen u32 asrctr; 11893117bb31SNicolin Chen 11903117bb31SNicolin Chen /* Stop all pairs provisionally */ 11917470704dSShengjiu Wang regmap_read(asrc->regmap, REG_ASRCTR, &asrctr); 11927470704dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRCTR, 11933117bb31SNicolin Chen ASRCTR_ASRCEi_ALL_MASK, 0); 11943117bb31SNicolin Chen 11953117bb31SNicolin Chen /* Restore all registers */ 11967470704dSShengjiu Wang regcache_cache_only(asrc->regmap, false); 11977470704dSShengjiu Wang regcache_sync(asrc->regmap); 11983117bb31SNicolin Chen 11997470704dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRCFG, 1200d44c6114SZidan Wang ASRCFG_NDPRi_ALL_MASK | ASRCFG_POSTMODi_ALL_MASK | 1201be7bd03fSShengjiu Wang ASRCFG_PREMODi_ALL_MASK, asrc_priv->regcache_cfg); 1202d44c6114SZidan Wang 12033117bb31SNicolin Chen /* Restart enabled pairs */ 12047470704dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRCTR, 12053117bb31SNicolin Chen ASRCTR_ASRCEi_ALL_MASK, asrctr); 12063117bb31SNicolin Chen 12073117bb31SNicolin Chen return 0; 12083117bb31SNicolin Chen } 12093117bb31SNicolin Chen #endif /* CONFIG_PM_SLEEP */ 12103117bb31SNicolin Chen 12113117bb31SNicolin Chen static const struct dev_pm_ops fsl_asrc_pm = { 12123117bb31SNicolin Chen SET_RUNTIME_PM_OPS(fsl_asrc_runtime_suspend, fsl_asrc_runtime_resume, NULL) 12133117bb31SNicolin Chen SET_SYSTEM_SLEEP_PM_OPS(fsl_asrc_suspend, fsl_asrc_resume) 12143117bb31SNicolin Chen }; 12153117bb31SNicolin Chen 1216c05f10f2SShengjiu Wang static const struct fsl_asrc_soc_data fsl_asrc_imx35_data = { 1217c05f10f2SShengjiu Wang .use_edma = false, 1218c05f10f2SShengjiu Wang .channel_bits = 3, 1219c05f10f2SShengjiu Wang }; 1220c05f10f2SShengjiu Wang 1221c05f10f2SShengjiu Wang static const struct fsl_asrc_soc_data fsl_asrc_imx53_data = { 1222c05f10f2SShengjiu Wang .use_edma = false, 1223c05f10f2SShengjiu Wang .channel_bits = 4, 1224c05f10f2SShengjiu Wang }; 1225c05f10f2SShengjiu Wang 1226c05f10f2SShengjiu Wang static const struct fsl_asrc_soc_data fsl_asrc_imx8qm_data = { 1227c05f10f2SShengjiu Wang .use_edma = true, 1228c05f10f2SShengjiu Wang .channel_bits = 4, 1229c05f10f2SShengjiu Wang }; 1230c05f10f2SShengjiu Wang 1231c05f10f2SShengjiu Wang static const struct fsl_asrc_soc_data fsl_asrc_imx8qxp_data = { 1232c05f10f2SShengjiu Wang .use_edma = true, 1233c05f10f2SShengjiu Wang .channel_bits = 4, 1234c05f10f2SShengjiu Wang }; 1235c05f10f2SShengjiu Wang 12363117bb31SNicolin Chen static const struct of_device_id fsl_asrc_ids[] = { 1237c05f10f2SShengjiu Wang { .compatible = "fsl,imx35-asrc", .data = &fsl_asrc_imx35_data }, 1238c05f10f2SShengjiu Wang { .compatible = "fsl,imx53-asrc", .data = &fsl_asrc_imx53_data }, 1239c05f10f2SShengjiu Wang { .compatible = "fsl,imx8qm-asrc", .data = &fsl_asrc_imx8qm_data }, 1240c05f10f2SShengjiu Wang { .compatible = "fsl,imx8qxp-asrc", .data = &fsl_asrc_imx8qxp_data }, 12413117bb31SNicolin Chen {} 12423117bb31SNicolin Chen }; 12433117bb31SNicolin Chen MODULE_DEVICE_TABLE(of, fsl_asrc_ids); 12443117bb31SNicolin Chen 12453117bb31SNicolin Chen static struct platform_driver fsl_asrc_driver = { 12463117bb31SNicolin Chen .probe = fsl_asrc_probe, 12473117bb31SNicolin Chen .driver = { 12483117bb31SNicolin Chen .name = "fsl-asrc", 12493117bb31SNicolin Chen .of_match_table = fsl_asrc_ids, 12503117bb31SNicolin Chen .pm = &fsl_asrc_pm, 12513117bb31SNicolin Chen }, 12523117bb31SNicolin Chen }; 12533117bb31SNicolin Chen module_platform_driver(fsl_asrc_driver); 12543117bb31SNicolin Chen 12553117bb31SNicolin Chen MODULE_DESCRIPTION("Freescale ASRC ASoC driver"); 12563117bb31SNicolin Chen MODULE_AUTHOR("Nicolin Chen <nicoleotsuka@gmail.com>"); 12573117bb31SNicolin Chen MODULE_ALIAS("platform:fsl-asrc"); 12583117bb31SNicolin Chen MODULE_LICENSE("GPL v2"); 1259