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 */ 157c16e923dSChenTao 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 */ 200c16e923dSChenTao 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 */ 557cff1f8b4Sshengjiu wang static struct dma_chan *fsl_asrc_get_dma_channel(struct fsl_asrc_pair *pair, 558cff1f8b4Sshengjiu wang bool dir) 5593117bb31SNicolin Chen { 5607470704dSShengjiu Wang struct fsl_asrc *asrc = pair->asrc; 5613117bb31SNicolin Chen enum asrc_pair_index index = pair->index; 5623117bb31SNicolin Chen char name[4]; 5633117bb31SNicolin Chen 5643117bb31SNicolin Chen sprintf(name, "%cx%c", dir == IN ? 'r' : 't', index + 'a'); 5653117bb31SNicolin Chen 5667470704dSShengjiu Wang return dma_request_slave_channel(&asrc->pdev->dev, name); 5673117bb31SNicolin Chen } 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 { 861f8953043SShengjiu Wang unsigned long ipg_rate; 862f8953043SShengjiu Wang 8633117bb31SNicolin Chen /* Halt ASRC internal FP when input FIFO needs data for pair A, B, C */ 8647470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRCTR, ASRCTR_ASRCEN); 8653117bb31SNicolin Chen 8663117bb31SNicolin Chen /* Disable interrupt by default */ 8677470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRIER, 0x0); 8683117bb31SNicolin Chen 8693117bb31SNicolin Chen /* Apply recommended settings for parameters from Reference Manual */ 8707470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRPM1, 0x7fffff); 8717470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRPM2, 0x255555); 8727470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRPM3, 0xff7280); 8737470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRPM4, 0xff7280); 8747470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRPM5, 0xff7280); 8753117bb31SNicolin Chen 8763117bb31SNicolin Chen /* Base address for task queue FIFO. Set to 0x7C */ 8777470704dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRTFR1, 8783117bb31SNicolin Chen ASRTFR1_TF_BASE_MASK, ASRTFR1_TF_BASE(0xfc)); 8793117bb31SNicolin Chen 880f8953043SShengjiu Wang /* 881f8953043SShengjiu Wang * Set the period of the 76KHz and 56KHz sampling clocks based on 882f8953043SShengjiu Wang * the ASRC processing clock. 883f8953043SShengjiu Wang * On iMX6, ipg_clk = 133MHz, REG_ASR76K = 0x06D6, REG_ASR56K = 0x0947 884f8953043SShengjiu Wang */ 885f8953043SShengjiu Wang ipg_rate = clk_get_rate(asrc->ipg_clk); 886f8953043SShengjiu Wang regmap_write(asrc->regmap, REG_ASR76K, ipg_rate / 76000); 887f8953043SShengjiu Wang return regmap_write(asrc->regmap, REG_ASR56K, ipg_rate / 56000); 8883117bb31SNicolin Chen } 8893117bb31SNicolin Chen 8903117bb31SNicolin Chen /** 8913117bb31SNicolin Chen * Interrupt handler for ASRC 8923117bb31SNicolin Chen */ 8933117bb31SNicolin Chen static irqreturn_t fsl_asrc_isr(int irq, void *dev_id) 8943117bb31SNicolin Chen { 8957470704dSShengjiu Wang struct fsl_asrc *asrc = (struct fsl_asrc *)dev_id; 8967470704dSShengjiu Wang struct device *dev = &asrc->pdev->dev; 8973117bb31SNicolin Chen enum asrc_pair_index index; 8983117bb31SNicolin Chen u32 status; 8993117bb31SNicolin Chen 9007470704dSShengjiu Wang regmap_read(asrc->regmap, REG_ASRSTR, &status); 9013117bb31SNicolin Chen 9023117bb31SNicolin Chen /* Clean overload error */ 9037470704dSShengjiu Wang regmap_write(asrc->regmap, REG_ASRSTR, ASRSTR_AOLE); 9043117bb31SNicolin Chen 9053117bb31SNicolin Chen /* 9063117bb31SNicolin Chen * We here use dev_dbg() for all exceptions because ASRC itself does 9073117bb31SNicolin Chen * not care if FIFO overflowed or underrun while a warning in the 9083117bb31SNicolin Chen * interrupt would result a ridged conversion. 9093117bb31SNicolin Chen */ 9103117bb31SNicolin Chen for (index = ASRC_PAIR_A; index < ASRC_PAIR_MAX_NUM; index++) { 9117470704dSShengjiu Wang if (!asrc->pair[index]) 9123117bb31SNicolin Chen continue; 9133117bb31SNicolin Chen 9143117bb31SNicolin Chen if (status & ASRSTR_ATQOL) { 9157470704dSShengjiu Wang asrc->pair[index]->error |= ASRC_TASK_Q_OVERLOAD; 9163117bb31SNicolin Chen dev_dbg(dev, "ASRC Task Queue FIFO overload\n"); 9173117bb31SNicolin Chen } 9183117bb31SNicolin Chen 9193117bb31SNicolin Chen if (status & ASRSTR_AOOL(index)) { 9207470704dSShengjiu Wang asrc->pair[index]->error |= ASRC_OUTPUT_TASK_OVERLOAD; 9213117bb31SNicolin Chen pair_dbg("Output Task Overload\n"); 9223117bb31SNicolin Chen } 9233117bb31SNicolin Chen 9243117bb31SNicolin Chen if (status & ASRSTR_AIOL(index)) { 9257470704dSShengjiu Wang asrc->pair[index]->error |= ASRC_INPUT_TASK_OVERLOAD; 9263117bb31SNicolin Chen pair_dbg("Input Task Overload\n"); 9273117bb31SNicolin Chen } 9283117bb31SNicolin Chen 9293117bb31SNicolin Chen if (status & ASRSTR_AODO(index)) { 9307470704dSShengjiu Wang asrc->pair[index]->error |= ASRC_OUTPUT_BUFFER_OVERFLOW; 9313117bb31SNicolin Chen pair_dbg("Output Data Buffer has overflowed\n"); 9323117bb31SNicolin Chen } 9333117bb31SNicolin Chen 9343117bb31SNicolin Chen if (status & ASRSTR_AIDU(index)) { 9357470704dSShengjiu Wang asrc->pair[index]->error |= ASRC_INPUT_BUFFER_UNDERRUN; 9363117bb31SNicolin Chen pair_dbg("Input Data Buffer has underflowed\n"); 9373117bb31SNicolin Chen } 9383117bb31SNicolin Chen } 9393117bb31SNicolin Chen 9403117bb31SNicolin Chen return IRQ_HANDLED; 9413117bb31SNicolin Chen } 9423117bb31SNicolin Chen 943be7bd03fSShengjiu Wang static int fsl_asrc_get_fifo_addr(u8 dir, enum asrc_pair_index index) 944be7bd03fSShengjiu Wang { 945be7bd03fSShengjiu Wang return REG_ASRDx(dir, index); 946be7bd03fSShengjiu Wang } 947be7bd03fSShengjiu Wang 9483117bb31SNicolin Chen static int fsl_asrc_probe(struct platform_device *pdev) 9493117bb31SNicolin Chen { 9503117bb31SNicolin Chen struct device_node *np = pdev->dev.of_node; 951be7bd03fSShengjiu Wang struct fsl_asrc_priv *asrc_priv; 9527470704dSShengjiu Wang struct fsl_asrc *asrc; 9533117bb31SNicolin Chen struct resource *res; 9543117bb31SNicolin Chen void __iomem *regs; 9553117bb31SNicolin Chen int irq, ret, i; 956c05f10f2SShengjiu Wang u32 map_idx; 9573117bb31SNicolin Chen char tmp[16]; 9584520af41SShengjiu Wang u32 width; 9593117bb31SNicolin Chen 9607470704dSShengjiu Wang asrc = devm_kzalloc(&pdev->dev, sizeof(*asrc), GFP_KERNEL); 9617470704dSShengjiu Wang if (!asrc) 9623117bb31SNicolin Chen return -ENOMEM; 9633117bb31SNicolin Chen 964be7bd03fSShengjiu Wang asrc_priv = devm_kzalloc(&pdev->dev, sizeof(*asrc_priv), GFP_KERNEL); 965be7bd03fSShengjiu Wang if (!asrc_priv) 966be7bd03fSShengjiu Wang return -ENOMEM; 967be7bd03fSShengjiu Wang 9687470704dSShengjiu Wang asrc->pdev = pdev; 969be7bd03fSShengjiu Wang asrc->private = asrc_priv; 9703117bb31SNicolin Chen 9713117bb31SNicolin Chen /* Get the addresses and IRQ */ 9723117bb31SNicolin Chen res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 9733117bb31SNicolin Chen regs = devm_ioremap_resource(&pdev->dev, res); 9743117bb31SNicolin Chen if (IS_ERR(regs)) 9753117bb31SNicolin Chen return PTR_ERR(regs); 9763117bb31SNicolin Chen 9777470704dSShengjiu Wang asrc->paddr = res->start; 9783117bb31SNicolin Chen 9797470704dSShengjiu Wang asrc->regmap = devm_regmap_init_mmio_clk(&pdev->dev, "mem", regs, 9803117bb31SNicolin Chen &fsl_asrc_regmap_config); 9817470704dSShengjiu Wang if (IS_ERR(asrc->regmap)) { 9823117bb31SNicolin Chen dev_err(&pdev->dev, "failed to init regmap\n"); 9837470704dSShengjiu Wang return PTR_ERR(asrc->regmap); 9843117bb31SNicolin Chen } 9853117bb31SNicolin Chen 9863117bb31SNicolin Chen irq = platform_get_irq(pdev, 0); 987cf9441adSStephen Boyd if (irq < 0) 9883117bb31SNicolin Chen return irq; 9893117bb31SNicolin Chen 9903117bb31SNicolin Chen ret = devm_request_irq(&pdev->dev, irq, fsl_asrc_isr, 0, 9917470704dSShengjiu Wang dev_name(&pdev->dev), asrc); 9923117bb31SNicolin Chen if (ret) { 9933117bb31SNicolin Chen dev_err(&pdev->dev, "failed to claim irq %u: %d\n", irq, ret); 9943117bb31SNicolin Chen return ret; 9953117bb31SNicolin Chen } 9963117bb31SNicolin Chen 9977470704dSShengjiu Wang asrc->mem_clk = devm_clk_get(&pdev->dev, "mem"); 9987470704dSShengjiu Wang if (IS_ERR(asrc->mem_clk)) { 9993117bb31SNicolin Chen dev_err(&pdev->dev, "failed to get mem clock\n"); 10007470704dSShengjiu Wang return PTR_ERR(asrc->mem_clk); 10013117bb31SNicolin Chen } 10023117bb31SNicolin Chen 10037470704dSShengjiu Wang asrc->ipg_clk = devm_clk_get(&pdev->dev, "ipg"); 10047470704dSShengjiu Wang if (IS_ERR(asrc->ipg_clk)) { 10053117bb31SNicolin Chen dev_err(&pdev->dev, "failed to get ipg clock\n"); 10067470704dSShengjiu Wang return PTR_ERR(asrc->ipg_clk); 10073117bb31SNicolin Chen } 10083117bb31SNicolin Chen 10097470704dSShengjiu Wang asrc->spba_clk = devm_clk_get(&pdev->dev, "spba"); 10107470704dSShengjiu Wang if (IS_ERR(asrc->spba_clk)) 101113b8a97aSShengjiu Wang dev_warn(&pdev->dev, "failed to get spba clock\n"); 101213b8a97aSShengjiu Wang 10133117bb31SNicolin Chen for (i = 0; i < ASRC_CLK_MAX_NUM; i++) { 10143117bb31SNicolin Chen sprintf(tmp, "asrck_%x", i); 1015be7bd03fSShengjiu Wang asrc_priv->asrck_clk[i] = devm_clk_get(&pdev->dev, tmp); 1016be7bd03fSShengjiu Wang if (IS_ERR(asrc_priv->asrck_clk[i])) { 10173117bb31SNicolin Chen dev_err(&pdev->dev, "failed to get %s clock\n", tmp); 1018be7bd03fSShengjiu Wang return PTR_ERR(asrc_priv->asrck_clk[i]); 10193117bb31SNicolin Chen } 10203117bb31SNicolin Chen } 10213117bb31SNicolin Chen 1022be7bd03fSShengjiu Wang asrc_priv->soc = of_device_get_match_data(&pdev->dev); 1023be7bd03fSShengjiu Wang if (!asrc_priv->soc) { 1024c05f10f2SShengjiu Wang dev_err(&pdev->dev, "failed to get soc data\n"); 1025c05f10f2SShengjiu Wang return -ENODEV; 1026c05f10f2SShengjiu Wang } 1027c05f10f2SShengjiu Wang 1028be7bd03fSShengjiu Wang asrc->use_edma = asrc_priv->soc->use_edma; 1029be7bd03fSShengjiu Wang asrc->get_dma_channel = fsl_asrc_get_dma_channel; 1030be7bd03fSShengjiu Wang asrc->request_pair = fsl_asrc_request_pair; 1031be7bd03fSShengjiu Wang asrc->release_pair = fsl_asrc_release_pair; 1032be7bd03fSShengjiu Wang asrc->get_fifo_addr = fsl_asrc_get_fifo_addr; 1033be7bd03fSShengjiu Wang asrc->pair_priv_size = sizeof(struct fsl_asrc_pair_priv); 1034be7bd03fSShengjiu Wang 1035f3d8ac8cSFabio Estevam if (of_device_is_compatible(np, "fsl,imx35-asrc")) { 1036be7bd03fSShengjiu Wang asrc_priv->clk_map[IN] = input_clk_map_imx35; 1037be7bd03fSShengjiu Wang asrc_priv->clk_map[OUT] = output_clk_map_imx35; 1038c05f10f2SShengjiu Wang } else if (of_device_is_compatible(np, "fsl,imx53-asrc")) { 1039be7bd03fSShengjiu Wang asrc_priv->clk_map[IN] = input_clk_map_imx53; 1040be7bd03fSShengjiu Wang asrc_priv->clk_map[OUT] = output_clk_map_imx53; 1041c05f10f2SShengjiu Wang } else if (of_device_is_compatible(np, "fsl,imx8qm-asrc") || 1042c05f10f2SShengjiu Wang of_device_is_compatible(np, "fsl,imx8qxp-asrc")) { 1043c05f10f2SShengjiu Wang ret = of_property_read_u32(np, "fsl,asrc-clk-map", &map_idx); 1044c05f10f2SShengjiu Wang if (ret) { 1045c05f10f2SShengjiu Wang dev_err(&pdev->dev, "failed to get clk map index\n"); 1046c05f10f2SShengjiu Wang return ret; 1047c05f10f2SShengjiu Wang } 1048c05f10f2SShengjiu Wang 1049c05f10f2SShengjiu Wang if (map_idx > 1) { 1050c05f10f2SShengjiu Wang dev_err(&pdev->dev, "unsupported clk map index\n"); 1051c05f10f2SShengjiu Wang return -EINVAL; 1052c05f10f2SShengjiu Wang } 1053c05f10f2SShengjiu Wang if (of_device_is_compatible(np, "fsl,imx8qm-asrc")) { 1054be7bd03fSShengjiu Wang asrc_priv->clk_map[IN] = clk_map_imx8qm[map_idx]; 1055be7bd03fSShengjiu Wang asrc_priv->clk_map[OUT] = clk_map_imx8qm[map_idx]; 10563117bb31SNicolin Chen } else { 1057be7bd03fSShengjiu Wang asrc_priv->clk_map[IN] = clk_map_imx8qxp[map_idx]; 1058be7bd03fSShengjiu Wang asrc_priv->clk_map[OUT] = clk_map_imx8qxp[map_idx]; 1059c05f10f2SShengjiu Wang } 10603117bb31SNicolin Chen } 10613117bb31SNicolin Chen 10627470704dSShengjiu Wang ret = fsl_asrc_init(asrc); 10633117bb31SNicolin Chen if (ret) { 10643117bb31SNicolin Chen dev_err(&pdev->dev, "failed to init asrc %d\n", ret); 1065c0296950SFabio Estevam return ret; 10663117bb31SNicolin Chen } 10673117bb31SNicolin Chen 10687470704dSShengjiu Wang asrc->channel_avail = 10; 10693117bb31SNicolin Chen 10703117bb31SNicolin Chen ret = of_property_read_u32(np, "fsl,asrc-rate", 10717470704dSShengjiu Wang &asrc->asrc_rate); 10723117bb31SNicolin Chen if (ret) { 10733117bb31SNicolin Chen dev_err(&pdev->dev, "failed to get output rate\n"); 1074c0296950SFabio Estevam return ret; 10753117bb31SNicolin Chen } 10763117bb31SNicolin Chen 10774520af41SShengjiu Wang ret = of_property_read_u32(np, "fsl,asrc-format", &asrc->asrc_format); 10783117bb31SNicolin Chen if (ret) { 10794520af41SShengjiu Wang ret = of_property_read_u32(np, "fsl,asrc-width", &width); 10804520af41SShengjiu Wang if (ret) { 10814520af41SShengjiu Wang dev_err(&pdev->dev, "failed to decide output format\n"); 1082c0296950SFabio Estevam return ret; 10833117bb31SNicolin Chen } 10843117bb31SNicolin Chen 10854520af41SShengjiu Wang switch (width) { 10864520af41SShengjiu Wang case 16: 10874520af41SShengjiu Wang asrc->asrc_format = SNDRV_PCM_FORMAT_S16_LE; 10884520af41SShengjiu Wang break; 10894520af41SShengjiu Wang case 24: 10904520af41SShengjiu Wang asrc->asrc_format = SNDRV_PCM_FORMAT_S24_LE; 10914520af41SShengjiu Wang break; 10924520af41SShengjiu Wang default: 10934520af41SShengjiu Wang dev_warn(&pdev->dev, 10944520af41SShengjiu Wang "unsupported width, use default S24_LE\n"); 10954520af41SShengjiu Wang asrc->asrc_format = SNDRV_PCM_FORMAT_S24_LE; 10964520af41SShengjiu Wang break; 10974520af41SShengjiu Wang } 10984520af41SShengjiu Wang } 10994520af41SShengjiu Wang 11004520af41SShengjiu Wang if (!(FSL_ASRC_FORMATS & (1ULL << asrc->asrc_format))) { 11014520af41SShengjiu Wang dev_warn(&pdev->dev, "unsupported width, use default S24_LE\n"); 11024520af41SShengjiu Wang asrc->asrc_format = SNDRV_PCM_FORMAT_S24_LE; 11033117bb31SNicolin Chen } 11043117bb31SNicolin Chen 11057470704dSShengjiu Wang platform_set_drvdata(pdev, asrc); 11063117bb31SNicolin Chen pm_runtime_enable(&pdev->dev); 11077470704dSShengjiu Wang spin_lock_init(&asrc->lock); 1108*393dc21dSShengjiu Wang regcache_cache_only(asrc->regmap, true); 11093117bb31SNicolin Chen 11103117bb31SNicolin Chen ret = devm_snd_soc_register_component(&pdev->dev, &fsl_asrc_component, 11113117bb31SNicolin Chen &fsl_asrc_dai, 1); 11123117bb31SNicolin Chen if (ret) { 11133117bb31SNicolin Chen dev_err(&pdev->dev, "failed to register ASoC DAI\n"); 11143117bb31SNicolin Chen return ret; 11153117bb31SNicolin Chen } 11163117bb31SNicolin Chen 11173117bb31SNicolin Chen return 0; 11183117bb31SNicolin Chen } 11193117bb31SNicolin Chen 1120641d334bSRafael J. Wysocki #ifdef CONFIG_PM 11213117bb31SNicolin Chen static int fsl_asrc_runtime_resume(struct device *dev) 11223117bb31SNicolin Chen { 11237470704dSShengjiu Wang struct fsl_asrc *asrc = dev_get_drvdata(dev); 1124be7bd03fSShengjiu Wang struct fsl_asrc_priv *asrc_priv = asrc->private; 1125b1ade0f2SFabio Estevam int i, ret; 1126*393dc21dSShengjiu Wang u32 asrctr; 11273117bb31SNicolin Chen 11287470704dSShengjiu Wang ret = clk_prepare_enable(asrc->mem_clk); 1129b1ade0f2SFabio Estevam if (ret) 1130b1ade0f2SFabio Estevam return ret; 11317470704dSShengjiu Wang ret = clk_prepare_enable(asrc->ipg_clk); 1132b1ade0f2SFabio Estevam if (ret) 1133b1ade0f2SFabio Estevam goto disable_mem_clk; 11347470704dSShengjiu Wang if (!IS_ERR(asrc->spba_clk)) { 11357470704dSShengjiu Wang ret = clk_prepare_enable(asrc->spba_clk); 113613b8a97aSShengjiu Wang if (ret) 113713b8a97aSShengjiu Wang goto disable_ipg_clk; 113813b8a97aSShengjiu Wang } 1139b1ade0f2SFabio Estevam for (i = 0; i < ASRC_CLK_MAX_NUM; i++) { 1140be7bd03fSShengjiu Wang ret = clk_prepare_enable(asrc_priv->asrck_clk[i]); 1141b1ade0f2SFabio Estevam if (ret) 1142b1ade0f2SFabio Estevam goto disable_asrck_clk; 1143b1ade0f2SFabio Estevam } 11443117bb31SNicolin Chen 1145*393dc21dSShengjiu Wang /* Stop all pairs provisionally */ 1146*393dc21dSShengjiu Wang regmap_read(asrc->regmap, REG_ASRCTR, &asrctr); 1147*393dc21dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRCTR, 1148*393dc21dSShengjiu Wang ASRCTR_ASRCEi_ALL_MASK, 0); 1149*393dc21dSShengjiu Wang 1150*393dc21dSShengjiu Wang /* Restore all registers */ 1151*393dc21dSShengjiu Wang regcache_cache_only(asrc->regmap, false); 1152*393dc21dSShengjiu Wang regcache_mark_dirty(asrc->regmap); 1153*393dc21dSShengjiu Wang regcache_sync(asrc->regmap); 1154*393dc21dSShengjiu Wang 1155*393dc21dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRCFG, 1156*393dc21dSShengjiu Wang ASRCFG_NDPRi_ALL_MASK | ASRCFG_POSTMODi_ALL_MASK | 1157*393dc21dSShengjiu Wang ASRCFG_PREMODi_ALL_MASK, asrc_priv->regcache_cfg); 1158*393dc21dSShengjiu Wang 1159*393dc21dSShengjiu Wang /* Restart enabled pairs */ 1160*393dc21dSShengjiu Wang regmap_update_bits(asrc->regmap, REG_ASRCTR, 1161*393dc21dSShengjiu Wang ASRCTR_ASRCEi_ALL_MASK, asrctr); 1162*393dc21dSShengjiu Wang 11633117bb31SNicolin Chen return 0; 1164b1ade0f2SFabio Estevam 1165b1ade0f2SFabio Estevam disable_asrck_clk: 1166b1ade0f2SFabio Estevam for (i--; i >= 0; i--) 1167be7bd03fSShengjiu Wang clk_disable_unprepare(asrc_priv->asrck_clk[i]); 11687470704dSShengjiu Wang if (!IS_ERR(asrc->spba_clk)) 11697470704dSShengjiu Wang clk_disable_unprepare(asrc->spba_clk); 117013b8a97aSShengjiu Wang disable_ipg_clk: 11717470704dSShengjiu Wang clk_disable_unprepare(asrc->ipg_clk); 1172b1ade0f2SFabio Estevam disable_mem_clk: 11737470704dSShengjiu Wang clk_disable_unprepare(asrc->mem_clk); 1174b1ade0f2SFabio Estevam return ret; 11753117bb31SNicolin Chen } 11763117bb31SNicolin Chen 11773117bb31SNicolin Chen static int fsl_asrc_runtime_suspend(struct device *dev) 11783117bb31SNicolin Chen { 11797470704dSShengjiu Wang struct fsl_asrc *asrc = dev_get_drvdata(dev); 1180be7bd03fSShengjiu Wang struct fsl_asrc_priv *asrc_priv = asrc->private; 11813117bb31SNicolin Chen int i; 11823117bb31SNicolin Chen 1183*393dc21dSShengjiu Wang regmap_read(asrc->regmap, REG_ASRCFG, 1184*393dc21dSShengjiu Wang &asrc_priv->regcache_cfg); 1185*393dc21dSShengjiu Wang 1186*393dc21dSShengjiu Wang regcache_cache_only(asrc->regmap, true); 1187*393dc21dSShengjiu Wang 11883117bb31SNicolin Chen for (i = 0; i < ASRC_CLK_MAX_NUM; i++) 1189be7bd03fSShengjiu Wang clk_disable_unprepare(asrc_priv->asrck_clk[i]); 11907470704dSShengjiu Wang if (!IS_ERR(asrc->spba_clk)) 11917470704dSShengjiu Wang clk_disable_unprepare(asrc->spba_clk); 11927470704dSShengjiu Wang clk_disable_unprepare(asrc->ipg_clk); 11937470704dSShengjiu Wang clk_disable_unprepare(asrc->mem_clk); 11943117bb31SNicolin Chen 11953117bb31SNicolin Chen return 0; 11963117bb31SNicolin Chen } 1197641d334bSRafael J. Wysocki #endif /* CONFIG_PM */ 11983117bb31SNicolin Chen 11993117bb31SNicolin Chen static const struct dev_pm_ops fsl_asrc_pm = { 12003117bb31SNicolin Chen SET_RUNTIME_PM_OPS(fsl_asrc_runtime_suspend, fsl_asrc_runtime_resume, NULL) 1201*393dc21dSShengjiu Wang SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend, 1202*393dc21dSShengjiu Wang pm_runtime_force_resume) 12033117bb31SNicolin Chen }; 12043117bb31SNicolin Chen 1205c05f10f2SShengjiu Wang static const struct fsl_asrc_soc_data fsl_asrc_imx35_data = { 1206c05f10f2SShengjiu Wang .use_edma = false, 1207c05f10f2SShengjiu Wang .channel_bits = 3, 1208c05f10f2SShengjiu Wang }; 1209c05f10f2SShengjiu Wang 1210c05f10f2SShengjiu Wang static const struct fsl_asrc_soc_data fsl_asrc_imx53_data = { 1211c05f10f2SShengjiu Wang .use_edma = false, 1212c05f10f2SShengjiu Wang .channel_bits = 4, 1213c05f10f2SShengjiu Wang }; 1214c05f10f2SShengjiu Wang 1215c05f10f2SShengjiu Wang static const struct fsl_asrc_soc_data fsl_asrc_imx8qm_data = { 1216c05f10f2SShengjiu Wang .use_edma = true, 1217c05f10f2SShengjiu Wang .channel_bits = 4, 1218c05f10f2SShengjiu Wang }; 1219c05f10f2SShengjiu Wang 1220c05f10f2SShengjiu Wang static const struct fsl_asrc_soc_data fsl_asrc_imx8qxp_data = { 1221c05f10f2SShengjiu Wang .use_edma = true, 1222c05f10f2SShengjiu Wang .channel_bits = 4, 1223c05f10f2SShengjiu Wang }; 1224c05f10f2SShengjiu Wang 12253117bb31SNicolin Chen static const struct of_device_id fsl_asrc_ids[] = { 1226c05f10f2SShengjiu Wang { .compatible = "fsl,imx35-asrc", .data = &fsl_asrc_imx35_data }, 1227c05f10f2SShengjiu Wang { .compatible = "fsl,imx53-asrc", .data = &fsl_asrc_imx53_data }, 1228c05f10f2SShengjiu Wang { .compatible = "fsl,imx8qm-asrc", .data = &fsl_asrc_imx8qm_data }, 1229c05f10f2SShengjiu Wang { .compatible = "fsl,imx8qxp-asrc", .data = &fsl_asrc_imx8qxp_data }, 12303117bb31SNicolin Chen {} 12313117bb31SNicolin Chen }; 12323117bb31SNicolin Chen MODULE_DEVICE_TABLE(of, fsl_asrc_ids); 12333117bb31SNicolin Chen 12343117bb31SNicolin Chen static struct platform_driver fsl_asrc_driver = { 12353117bb31SNicolin Chen .probe = fsl_asrc_probe, 12363117bb31SNicolin Chen .driver = { 12373117bb31SNicolin Chen .name = "fsl-asrc", 12383117bb31SNicolin Chen .of_match_table = fsl_asrc_ids, 12393117bb31SNicolin Chen .pm = &fsl_asrc_pm, 12403117bb31SNicolin Chen }, 12413117bb31SNicolin Chen }; 12423117bb31SNicolin Chen module_platform_driver(fsl_asrc_driver); 12433117bb31SNicolin Chen 12443117bb31SNicolin Chen MODULE_DESCRIPTION("Freescale ASRC ASoC driver"); 12453117bb31SNicolin Chen MODULE_AUTHOR("Nicolin Chen <nicoleotsuka@gmail.com>"); 12463117bb31SNicolin Chen MODULE_ALIAS("platform:fsl-asrc"); 12473117bb31SNicolin Chen MODULE_LICENSE("GPL v2"); 1248