12ba28053SFabio Estevam // SPDX-License-Identifier: GPL-2.0 22ba28053SFabio Estevam // 32ba28053SFabio Estevam // Freescale ASRC ALSA SoC Platform (DMA) 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/dma-mapping.h> 103117bb31SNicolin Chen #include <linux/module.h> 113117bb31SNicolin Chen #include <linux/platform_data/dma-imx.h> 123117bb31SNicolin Chen #include <sound/dmaengine_pcm.h> 133117bb31SNicolin Chen #include <sound/pcm_params.h> 143117bb31SNicolin Chen 15be7bd03fSShengjiu Wang #include "fsl_asrc_common.h" 163117bb31SNicolin Chen 173117bb31SNicolin Chen #define FSL_ASRC_DMABUF_SIZE (256 * 1024) 183117bb31SNicolin Chen 19703df441SShengjiu Wang static struct snd_pcm_hardware snd_imx_hardware = { 203117bb31SNicolin Chen .info = SNDRV_PCM_INFO_INTERLEAVED | 213117bb31SNicolin Chen SNDRV_PCM_INFO_BLOCK_TRANSFER | 223117bb31SNicolin Chen SNDRV_PCM_INFO_MMAP | 23703df441SShengjiu Wang SNDRV_PCM_INFO_MMAP_VALID, 243117bb31SNicolin Chen .buffer_bytes_max = FSL_ASRC_DMABUF_SIZE, 253117bb31SNicolin Chen .period_bytes_min = 128, 263117bb31SNicolin Chen .period_bytes_max = 65535, /* Limited by SDMA engine */ 273117bb31SNicolin Chen .periods_min = 2, 283117bb31SNicolin Chen .periods_max = 255, 293117bb31SNicolin Chen .fifo_size = 0, 303117bb31SNicolin Chen }; 313117bb31SNicolin Chen 323117bb31SNicolin Chen static bool filter(struct dma_chan *chan, void *param) 333117bb31SNicolin Chen { 343117bb31SNicolin Chen if (!imx_dma_is_general_purpose(chan)) 353117bb31SNicolin Chen return false; 363117bb31SNicolin Chen 373117bb31SNicolin Chen chan->private = param; 383117bb31SNicolin Chen 393117bb31SNicolin Chen return true; 403117bb31SNicolin Chen } 413117bb31SNicolin Chen 423117bb31SNicolin Chen static void fsl_asrc_dma_complete(void *arg) 433117bb31SNicolin Chen { 443117bb31SNicolin Chen struct snd_pcm_substream *substream = arg; 453117bb31SNicolin Chen struct snd_pcm_runtime *runtime = substream->runtime; 463117bb31SNicolin Chen struct fsl_asrc_pair *pair = runtime->private_data; 473117bb31SNicolin Chen 483117bb31SNicolin Chen pair->pos += snd_pcm_lib_period_bytes(substream); 493117bb31SNicolin Chen if (pair->pos >= snd_pcm_lib_buffer_bytes(substream)) 503117bb31SNicolin Chen pair->pos = 0; 513117bb31SNicolin Chen 523117bb31SNicolin Chen snd_pcm_period_elapsed(substream); 533117bb31SNicolin Chen } 543117bb31SNicolin Chen 558903ed25SKuninori Morimoto static int fsl_asrc_dma_prepare_and_submit(struct snd_pcm_substream *substream, 568903ed25SKuninori Morimoto struct snd_soc_component *component) 573117bb31SNicolin Chen { 583117bb31SNicolin Chen u8 dir = substream->stream == SNDRV_PCM_STREAM_PLAYBACK ? OUT : IN; 593117bb31SNicolin Chen struct snd_pcm_runtime *runtime = substream->runtime; 603117bb31SNicolin Chen struct fsl_asrc_pair *pair = runtime->private_data; 617f110661SKuninori Morimoto struct device *dev = component->dev; 623117bb31SNicolin Chen unsigned long flags = DMA_CTRL_ACK; 633117bb31SNicolin Chen 643117bb31SNicolin Chen /* Prepare and submit Front-End DMA channel */ 653117bb31SNicolin Chen if (!substream->runtime->no_period_wakeup) 663117bb31SNicolin Chen flags |= DMA_PREP_INTERRUPT; 673117bb31SNicolin Chen 683117bb31SNicolin Chen pair->pos = 0; 693117bb31SNicolin Chen pair->desc[!dir] = dmaengine_prep_dma_cyclic( 703117bb31SNicolin Chen pair->dma_chan[!dir], runtime->dma_addr, 713117bb31SNicolin Chen snd_pcm_lib_buffer_bytes(substream), 723117bb31SNicolin Chen snd_pcm_lib_period_bytes(substream), 7324dbd9edSStefan Agner dir == OUT ? DMA_MEM_TO_DEV : DMA_DEV_TO_MEM, flags); 743117bb31SNicolin Chen if (!pair->desc[!dir]) { 753117bb31SNicolin Chen dev_err(dev, "failed to prepare slave DMA for Front-End\n"); 763117bb31SNicolin Chen return -ENOMEM; 773117bb31SNicolin Chen } 783117bb31SNicolin Chen 793117bb31SNicolin Chen pair->desc[!dir]->callback = fsl_asrc_dma_complete; 803117bb31SNicolin Chen pair->desc[!dir]->callback_param = substream; 813117bb31SNicolin Chen 823117bb31SNicolin Chen dmaengine_submit(pair->desc[!dir]); 833117bb31SNicolin Chen 843117bb31SNicolin Chen /* Prepare and submit Back-End DMA channel */ 853117bb31SNicolin Chen pair->desc[dir] = dmaengine_prep_dma_cyclic( 863117bb31SNicolin Chen pair->dma_chan[dir], 0xffff, 64, 64, DMA_DEV_TO_DEV, 0); 873117bb31SNicolin Chen if (!pair->desc[dir]) { 883117bb31SNicolin Chen dev_err(dev, "failed to prepare slave DMA for Back-End\n"); 893117bb31SNicolin Chen return -ENOMEM; 903117bb31SNicolin Chen } 913117bb31SNicolin Chen 923117bb31SNicolin Chen dmaengine_submit(pair->desc[dir]); 933117bb31SNicolin Chen 943117bb31SNicolin Chen return 0; 953117bb31SNicolin Chen } 963117bb31SNicolin Chen 978903ed25SKuninori Morimoto static int fsl_asrc_dma_trigger(struct snd_soc_component *component, 988903ed25SKuninori Morimoto struct snd_pcm_substream *substream, int cmd) 993117bb31SNicolin Chen { 1003117bb31SNicolin Chen struct snd_pcm_runtime *runtime = substream->runtime; 1013117bb31SNicolin Chen struct fsl_asrc_pair *pair = runtime->private_data; 1023117bb31SNicolin Chen int ret; 1033117bb31SNicolin Chen 1043117bb31SNicolin Chen switch (cmd) { 1053117bb31SNicolin Chen case SNDRV_PCM_TRIGGER_START: 1063117bb31SNicolin Chen case SNDRV_PCM_TRIGGER_RESUME: 1073117bb31SNicolin Chen case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 1088903ed25SKuninori Morimoto ret = fsl_asrc_dma_prepare_and_submit(substream, component); 1093117bb31SNicolin Chen if (ret) 1103117bb31SNicolin Chen return ret; 1113117bb31SNicolin Chen dma_async_issue_pending(pair->dma_chan[IN]); 1123117bb31SNicolin Chen dma_async_issue_pending(pair->dma_chan[OUT]); 1133117bb31SNicolin Chen break; 1143117bb31SNicolin Chen case SNDRV_PCM_TRIGGER_STOP: 1153117bb31SNicolin Chen case SNDRV_PCM_TRIGGER_SUSPEND: 1163117bb31SNicolin Chen case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 1173117bb31SNicolin Chen dmaengine_terminate_all(pair->dma_chan[OUT]); 1183117bb31SNicolin Chen dmaengine_terminate_all(pair->dma_chan[IN]); 1193117bb31SNicolin Chen break; 1203117bb31SNicolin Chen default: 1213117bb31SNicolin Chen return -EINVAL; 1223117bb31SNicolin Chen } 1233117bb31SNicolin Chen 1243117bb31SNicolin Chen return 0; 1253117bb31SNicolin Chen } 1263117bb31SNicolin Chen 1278903ed25SKuninori Morimoto static int fsl_asrc_dma_hw_params(struct snd_soc_component *component, 1288903ed25SKuninori Morimoto struct snd_pcm_substream *substream, 1293117bb31SNicolin Chen struct snd_pcm_hw_params *params) 1303117bb31SNicolin Chen { 1313117bb31SNicolin Chen enum dma_slave_buswidth buswidth = DMA_SLAVE_BUSWIDTH_2_BYTES; 1329f5f078aSKuninori Morimoto struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 1333117bb31SNicolin Chen bool tx = substream->stream == SNDRV_PCM_STREAM_PLAYBACK; 1343117bb31SNicolin Chen struct snd_dmaengine_dai_dma_data *dma_params_fe = NULL; 1353117bb31SNicolin Chen struct snd_dmaengine_dai_dma_data *dma_params_be = NULL; 1363117bb31SNicolin Chen struct snd_pcm_runtime *runtime = substream->runtime; 1373117bb31SNicolin Chen struct fsl_asrc_pair *pair = runtime->private_data; 138706e2c88SShengjiu Wang struct dma_chan *tmp_chan = NULL, *be_chan = NULL; 139706e2c88SShengjiu Wang struct snd_soc_component *component_be = NULL; 1407470704dSShengjiu Wang struct fsl_asrc *asrc = pair->asrc; 1413117bb31SNicolin Chen struct dma_slave_config config_fe, config_be; 1423117bb31SNicolin Chen enum asrc_pair_index index = pair->index; 1437f110661SKuninori Morimoto struct device *dev = component->dev; 144*ee427ea4SRobin Gong struct device_node *of_dma_node; 1453117bb31SNicolin Chen int stream = substream->stream; 1463117bb31SNicolin Chen struct imx_dma_data *tmp_data; 1473117bb31SNicolin Chen struct snd_soc_dpcm *dpcm; 1483117bb31SNicolin Chen struct device *dev_be; 1493117bb31SNicolin Chen u8 dir = tx ? OUT : IN; 1503117bb31SNicolin Chen dma_cap_mask_t mask; 1514520af41SShengjiu Wang int ret, width; 1523117bb31SNicolin Chen 1533117bb31SNicolin Chen /* Fetch the Back-End dma_data from DPCM */ 1548d6258a4SKuninori Morimoto for_each_dpcm_be(rtd, stream, dpcm) { 1553117bb31SNicolin Chen struct snd_soc_pcm_runtime *be = dpcm->be; 1563117bb31SNicolin Chen struct snd_pcm_substream *substream_be; 15717198ae7SKuninori Morimoto struct snd_soc_dai *dai = asoc_rtd_to_cpu(be, 0); 1583117bb31SNicolin Chen 1593117bb31SNicolin Chen if (dpcm->fe != rtd) 1603117bb31SNicolin Chen continue; 1613117bb31SNicolin Chen 1623117bb31SNicolin Chen substream_be = snd_soc_dpcm_get_substream(be, stream); 1633117bb31SNicolin Chen dma_params_be = snd_soc_dai_get_dma_data(dai, substream_be); 1643117bb31SNicolin Chen dev_be = dai->dev; 1653117bb31SNicolin Chen break; 1663117bb31SNicolin Chen } 1673117bb31SNicolin Chen 1683117bb31SNicolin Chen if (!dma_params_be) { 1693117bb31SNicolin Chen dev_err(dev, "failed to get the substream of Back-End\n"); 1703117bb31SNicolin Chen return -EINVAL; 1713117bb31SNicolin Chen } 1723117bb31SNicolin Chen 1733117bb31SNicolin Chen /* Override dma_data of the Front-End and config its dmaengine */ 17417198ae7SKuninori Morimoto dma_params_fe = snd_soc_dai_get_dma_data(asoc_rtd_to_cpu(rtd, 0), substream); 175be7bd03fSShengjiu Wang dma_params_fe->addr = asrc->paddr + asrc->get_fifo_addr(!dir, index); 1763117bb31SNicolin Chen dma_params_fe->maxburst = dma_params_be->maxburst; 1773117bb31SNicolin Chen 178be7bd03fSShengjiu Wang pair->dma_chan[!dir] = asrc->get_dma_channel(pair, !dir); 1793117bb31SNicolin Chen if (!pair->dma_chan[!dir]) { 1803117bb31SNicolin Chen dev_err(dev, "failed to request DMA channel\n"); 1813117bb31SNicolin Chen return -EINVAL; 1823117bb31SNicolin Chen } 1833117bb31SNicolin Chen 1843117bb31SNicolin Chen memset(&config_fe, 0, sizeof(config_fe)); 1853117bb31SNicolin Chen ret = snd_dmaengine_pcm_prepare_slave_config(substream, params, &config_fe); 1863117bb31SNicolin Chen if (ret) { 1873117bb31SNicolin Chen dev_err(dev, "failed to prepare DMA config for Front-End\n"); 1883117bb31SNicolin Chen return ret; 1893117bb31SNicolin Chen } 1903117bb31SNicolin Chen 1913117bb31SNicolin Chen ret = dmaengine_slave_config(pair->dma_chan[!dir], &config_fe); 1923117bb31SNicolin Chen if (ret) { 1933117bb31SNicolin Chen dev_err(dev, "failed to config DMA channel for Front-End\n"); 1943117bb31SNicolin Chen return ret; 1953117bb31SNicolin Chen } 1963117bb31SNicolin Chen 1973117bb31SNicolin Chen /* Request and config DMA channel for Back-End */ 1983117bb31SNicolin Chen dma_cap_zero(mask); 1993117bb31SNicolin Chen dma_cap_set(DMA_SLAVE, mask); 2003117bb31SNicolin Chen dma_cap_set(DMA_CYCLIC, mask); 2013117bb31SNicolin Chen 202c05f10f2SShengjiu Wang /* 203706e2c88SShengjiu Wang * The Back-End device might have already requested a DMA channel, 204706e2c88SShengjiu Wang * so try to reuse it first, and then request a new one upon NULL. 205706e2c88SShengjiu Wang */ 206706e2c88SShengjiu Wang component_be = snd_soc_lookup_component_nolocked(dev_be, SND_DMAENGINE_PCM_DRV_NAME); 207706e2c88SShengjiu Wang if (component_be) { 208706e2c88SShengjiu Wang be_chan = soc_component_to_pcm(component_be)->chan[substream->stream]; 209706e2c88SShengjiu Wang tmp_chan = be_chan; 210706e2c88SShengjiu Wang } 211706e2c88SShengjiu Wang if (!tmp_chan) 212706e2c88SShengjiu Wang tmp_chan = dma_request_slave_channel(dev_be, tx ? "tx" : "rx"); 213706e2c88SShengjiu Wang 214706e2c88SShengjiu Wang /* 215c05f10f2SShengjiu Wang * An EDMA DEV_TO_DEV channel is fixed and bound with DMA event of each 216c05f10f2SShengjiu Wang * peripheral, unlike SDMA channel that is allocated dynamically. So no 217706e2c88SShengjiu Wang * need to configure dma_request and dma_request2, but get dma_chan of 218706e2c88SShengjiu Wang * Back-End device directly via dma_request_slave_channel. 219c05f10f2SShengjiu Wang */ 220be7bd03fSShengjiu Wang if (!asrc->use_edma) { 2213117bb31SNicolin Chen /* Get DMA request of Back-End */ 2223117bb31SNicolin Chen tmp_data = tmp_chan->private; 2233117bb31SNicolin Chen pair->dma_data.dma_request = tmp_data->dma_request; 224706e2c88SShengjiu Wang if (!be_chan) 2253117bb31SNicolin Chen dma_release_channel(tmp_chan); 2263117bb31SNicolin Chen 2273117bb31SNicolin Chen /* Get DMA request of Front-End */ 228be7bd03fSShengjiu Wang tmp_chan = asrc->get_dma_channel(pair, dir); 2293117bb31SNicolin Chen tmp_data = tmp_chan->private; 2303117bb31SNicolin Chen pair->dma_data.dma_request2 = tmp_data->dma_request; 2313117bb31SNicolin Chen pair->dma_data.peripheral_type = tmp_data->peripheral_type; 2323117bb31SNicolin Chen pair->dma_data.priority = tmp_data->priority; 2333117bb31SNicolin Chen dma_release_channel(tmp_chan); 2343117bb31SNicolin Chen 235*ee427ea4SRobin Gong of_dma_node = pair->dma_chan[!dir]->device->dev->of_node; 236c05f10f2SShengjiu Wang pair->dma_chan[dir] = 237*ee427ea4SRobin Gong __dma_request_channel(&mask, filter, &pair->dma_data, 238*ee427ea4SRobin Gong of_dma_node); 239b287a6d9SShengjiu Wang pair->req_dma_chan = true; 240c05f10f2SShengjiu Wang } else { 241b287a6d9SShengjiu Wang pair->dma_chan[dir] = tmp_chan; 242b287a6d9SShengjiu Wang /* Do not flag to release if we are reusing the Back-End one */ 243b287a6d9SShengjiu Wang pair->req_dma_chan = !be_chan; 244c05f10f2SShengjiu Wang } 245c05f10f2SShengjiu Wang 2463117bb31SNicolin Chen if (!pair->dma_chan[dir]) { 2473117bb31SNicolin Chen dev_err(dev, "failed to request DMA channel for Back-End\n"); 2483117bb31SNicolin Chen return -EINVAL; 2493117bb31SNicolin Chen } 2503117bb31SNicolin Chen 2514520af41SShengjiu Wang width = snd_pcm_format_physical_width(asrc->asrc_format); 2524520af41SShengjiu Wang if (width < 8 || width > 64) 2534520af41SShengjiu Wang return -EINVAL; 2544520af41SShengjiu Wang else if (width == 8) 2554520af41SShengjiu Wang buswidth = DMA_SLAVE_BUSWIDTH_1_BYTE; 2564520af41SShengjiu Wang else if (width == 16) 2573117bb31SNicolin Chen buswidth = DMA_SLAVE_BUSWIDTH_2_BYTES; 2584520af41SShengjiu Wang else if (width == 24) 2594520af41SShengjiu Wang buswidth = DMA_SLAVE_BUSWIDTH_3_BYTES; 2604520af41SShengjiu Wang else if (width <= 32) 2613117bb31SNicolin Chen buswidth = DMA_SLAVE_BUSWIDTH_4_BYTES; 2624520af41SShengjiu Wang else 2634520af41SShengjiu Wang buswidth = DMA_SLAVE_BUSWIDTH_8_BYTES; 2643117bb31SNicolin Chen 2653117bb31SNicolin Chen config_be.direction = DMA_DEV_TO_DEV; 2663117bb31SNicolin Chen config_be.src_addr_width = buswidth; 2673117bb31SNicolin Chen config_be.src_maxburst = dma_params_be->maxburst; 2683117bb31SNicolin Chen config_be.dst_addr_width = buswidth; 2693117bb31SNicolin Chen config_be.dst_maxburst = dma_params_be->maxburst; 2703117bb31SNicolin Chen 2713117bb31SNicolin Chen if (tx) { 272be7bd03fSShengjiu Wang config_be.src_addr = asrc->paddr + asrc->get_fifo_addr(OUT, index); 2733117bb31SNicolin Chen config_be.dst_addr = dma_params_be->addr; 2743117bb31SNicolin Chen } else { 275be7bd03fSShengjiu Wang config_be.dst_addr = asrc->paddr + asrc->get_fifo_addr(IN, index); 2763117bb31SNicolin Chen config_be.src_addr = dma_params_be->addr; 2773117bb31SNicolin Chen } 2783117bb31SNicolin Chen 2793117bb31SNicolin Chen ret = dmaengine_slave_config(pair->dma_chan[dir], &config_be); 2803117bb31SNicolin Chen if (ret) { 2813117bb31SNicolin Chen dev_err(dev, "failed to config DMA channel for Back-End\n"); 282b287a6d9SShengjiu Wang if (pair->req_dma_chan) 28336124fb1SXiyu Yang dma_release_channel(pair->dma_chan[dir]); 2843117bb31SNicolin Chen return ret; 2853117bb31SNicolin Chen } 2863117bb31SNicolin Chen 2873117bb31SNicolin Chen snd_pcm_set_runtime_buffer(substream, &substream->dma_buffer); 2883117bb31SNicolin Chen 2893117bb31SNicolin Chen return 0; 2903117bb31SNicolin Chen } 2913117bb31SNicolin Chen 2928903ed25SKuninori Morimoto static int fsl_asrc_dma_hw_free(struct snd_soc_component *component, 2938903ed25SKuninori Morimoto struct snd_pcm_substream *substream) 2943117bb31SNicolin Chen { 295b287a6d9SShengjiu Wang bool tx = substream->stream == SNDRV_PCM_STREAM_PLAYBACK; 2963117bb31SNicolin Chen struct snd_pcm_runtime *runtime = substream->runtime; 2973117bb31SNicolin Chen struct fsl_asrc_pair *pair = runtime->private_data; 298b287a6d9SShengjiu Wang u8 dir = tx ? OUT : IN; 2993117bb31SNicolin Chen 3003117bb31SNicolin Chen snd_pcm_set_runtime_buffer(substream, NULL); 3013117bb31SNicolin Chen 302b287a6d9SShengjiu Wang if (pair->dma_chan[!dir]) 303b287a6d9SShengjiu Wang dma_release_channel(pair->dma_chan[!dir]); 3043117bb31SNicolin Chen 305b287a6d9SShengjiu Wang /* release dev_to_dev chan if we aren't reusing the Back-End one */ 306b287a6d9SShengjiu Wang if (pair->dma_chan[dir] && pair->req_dma_chan) 307b287a6d9SShengjiu Wang dma_release_channel(pair->dma_chan[dir]); 3083117bb31SNicolin Chen 309b287a6d9SShengjiu Wang pair->dma_chan[!dir] = NULL; 310b287a6d9SShengjiu Wang pair->dma_chan[dir] = NULL; 3113117bb31SNicolin Chen 3123117bb31SNicolin Chen return 0; 3133117bb31SNicolin Chen } 3143117bb31SNicolin Chen 3158903ed25SKuninori Morimoto static int fsl_asrc_dma_startup(struct snd_soc_component *component, 3168903ed25SKuninori Morimoto struct snd_pcm_substream *substream) 3173117bb31SNicolin Chen { 318703df441SShengjiu Wang bool tx = substream->stream == SNDRV_PCM_STREAM_PLAYBACK; 3199f5f078aSKuninori Morimoto struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 3203117bb31SNicolin Chen struct snd_pcm_runtime *runtime = substream->runtime; 321703df441SShengjiu Wang struct snd_dmaengine_dai_dma_data *dma_data; 3227f110661SKuninori Morimoto struct device *dev = component->dev; 3237470704dSShengjiu Wang struct fsl_asrc *asrc = dev_get_drvdata(dev); 3243117bb31SNicolin Chen struct fsl_asrc_pair *pair; 325703df441SShengjiu Wang struct dma_chan *tmp_chan = NULL; 326703df441SShengjiu Wang u8 dir = tx ? OUT : IN; 327703df441SShengjiu Wang bool release_pair = true; 328703df441SShengjiu Wang int ret = 0; 329703df441SShengjiu Wang 330703df441SShengjiu Wang ret = snd_pcm_hw_constraint_integer(substream->runtime, 331703df441SShengjiu Wang SNDRV_PCM_HW_PARAM_PERIODS); 332703df441SShengjiu Wang if (ret < 0) { 333703df441SShengjiu Wang dev_err(dev, "failed to set pcm hw params periods\n"); 334703df441SShengjiu Wang return ret; 335703df441SShengjiu Wang } 3363117bb31SNicolin Chen 337be7bd03fSShengjiu Wang pair = kzalloc(sizeof(*pair) + asrc->pair_priv_size, GFP_KERNEL); 338443be77eSMarkus Elfring if (!pair) 3393117bb31SNicolin Chen return -ENOMEM; 3403117bb31SNicolin Chen 3417470704dSShengjiu Wang pair->asrc = asrc; 342be7bd03fSShengjiu Wang pair->private = (void *)pair + sizeof(struct fsl_asrc_pair); 3433117bb31SNicolin Chen 3443117bb31SNicolin Chen runtime->private_data = pair; 3453117bb31SNicolin Chen 346703df441SShengjiu Wang /* Request a dummy pair, which will be released later. 347703df441SShengjiu Wang * Request pair function needs channel num as input, for this 348703df441SShengjiu Wang * dummy pair, we just request "1" channel temporarily. 349703df441SShengjiu Wang */ 350be7bd03fSShengjiu Wang ret = asrc->request_pair(1, pair); 351703df441SShengjiu Wang if (ret < 0) { 352703df441SShengjiu Wang dev_err(dev, "failed to request asrc pair\n"); 353703df441SShengjiu Wang goto req_pair_err; 354703df441SShengjiu Wang } 355703df441SShengjiu Wang 356703df441SShengjiu Wang /* Request a dummy dma channel, which will be released later. */ 357be7bd03fSShengjiu Wang tmp_chan = asrc->get_dma_channel(pair, dir); 358703df441SShengjiu Wang if (!tmp_chan) { 359703df441SShengjiu Wang dev_err(dev, "failed to get dma channel\n"); 360703df441SShengjiu Wang ret = -EINVAL; 361703df441SShengjiu Wang goto dma_chan_err; 362703df441SShengjiu Wang } 363703df441SShengjiu Wang 36417198ae7SKuninori Morimoto dma_data = snd_soc_dai_get_dma_data(asoc_rtd_to_cpu(rtd, 0), substream); 365703df441SShengjiu Wang 366703df441SShengjiu Wang /* Refine the snd_imx_hardware according to caps of DMA. */ 367703df441SShengjiu Wang ret = snd_dmaengine_pcm_refine_runtime_hwparams(substream, 368703df441SShengjiu Wang dma_data, 369703df441SShengjiu Wang &snd_imx_hardware, 370703df441SShengjiu Wang tmp_chan); 371703df441SShengjiu Wang if (ret < 0) { 372703df441SShengjiu Wang dev_err(dev, "failed to refine runtime hwparams\n"); 373703df441SShengjiu Wang goto out; 374703df441SShengjiu Wang } 375703df441SShengjiu Wang 376703df441SShengjiu Wang release_pair = false; 3773117bb31SNicolin Chen snd_soc_set_runtime_hwparams(substream, &snd_imx_hardware); 3783117bb31SNicolin Chen 379703df441SShengjiu Wang out: 380703df441SShengjiu Wang dma_release_channel(tmp_chan); 381703df441SShengjiu Wang 382703df441SShengjiu Wang dma_chan_err: 383be7bd03fSShengjiu Wang asrc->release_pair(pair); 384703df441SShengjiu Wang 385703df441SShengjiu Wang req_pair_err: 386703df441SShengjiu Wang if (release_pair) 387703df441SShengjiu Wang kfree(pair); 388703df441SShengjiu Wang 389703df441SShengjiu Wang return ret; 3903117bb31SNicolin Chen } 3913117bb31SNicolin Chen 3928903ed25SKuninori Morimoto static int fsl_asrc_dma_shutdown(struct snd_soc_component *component, 3938903ed25SKuninori Morimoto struct snd_pcm_substream *substream) 3943117bb31SNicolin Chen { 3953117bb31SNicolin Chen struct snd_pcm_runtime *runtime = substream->runtime; 3963117bb31SNicolin Chen struct fsl_asrc_pair *pair = runtime->private_data; 3977470704dSShengjiu Wang struct fsl_asrc *asrc; 3983117bb31SNicolin Chen 3996ccf62c7SNicolin Chen if (!pair) 4006ccf62c7SNicolin Chen return 0; 4016ccf62c7SNicolin Chen 4027470704dSShengjiu Wang asrc = pair->asrc; 4036ccf62c7SNicolin Chen 4047470704dSShengjiu Wang if (asrc->pair[pair->index] == pair) 4057470704dSShengjiu Wang asrc->pair[pair->index] = NULL; 4063117bb31SNicolin Chen 4073117bb31SNicolin Chen kfree(pair); 4083117bb31SNicolin Chen 4093117bb31SNicolin Chen return 0; 4103117bb31SNicolin Chen } 4113117bb31SNicolin Chen 4128903ed25SKuninori Morimoto static snd_pcm_uframes_t 4138903ed25SKuninori Morimoto fsl_asrc_dma_pcm_pointer(struct snd_soc_component *component, 4148903ed25SKuninori Morimoto struct snd_pcm_substream *substream) 4153117bb31SNicolin Chen { 4163117bb31SNicolin Chen struct snd_pcm_runtime *runtime = substream->runtime; 4173117bb31SNicolin Chen struct fsl_asrc_pair *pair = runtime->private_data; 4183117bb31SNicolin Chen 4193117bb31SNicolin Chen return bytes_to_frames(substream->runtime, pair->pos); 4203117bb31SNicolin Chen } 4213117bb31SNicolin Chen 4228903ed25SKuninori Morimoto static int fsl_asrc_dma_pcm_new(struct snd_soc_component *component, 4238903ed25SKuninori Morimoto struct snd_soc_pcm_runtime *rtd) 4243117bb31SNicolin Chen { 4253117bb31SNicolin Chen struct snd_card *card = rtd->card->snd_card; 4263117bb31SNicolin Chen struct snd_pcm_substream *substream; 4273117bb31SNicolin Chen struct snd_pcm *pcm = rtd->pcm; 4283117bb31SNicolin Chen int ret, i; 4293117bb31SNicolin Chen 4303117bb31SNicolin Chen ret = dma_coerce_mask_and_coherent(card->dev, DMA_BIT_MASK(32)); 4313117bb31SNicolin Chen if (ret) { 4323117bb31SNicolin Chen dev_err(card->dev, "failed to set DMA mask\n"); 4333117bb31SNicolin Chen return ret; 4343117bb31SNicolin Chen } 4353117bb31SNicolin Chen 436fa7b2a1fSKuninori Morimoto for_each_pcm_streams(i) { 4373117bb31SNicolin Chen substream = pcm->streams[i].substream; 4383117bb31SNicolin Chen if (!substream) 4393117bb31SNicolin Chen continue; 4403117bb31SNicolin Chen 4413117bb31SNicolin Chen ret = snd_dma_alloc_pages(SNDRV_DMA_TYPE_DEV, pcm->card->dev, 4423117bb31SNicolin Chen FSL_ASRC_DMABUF_SIZE, &substream->dma_buffer); 4433117bb31SNicolin Chen if (ret) { 4443117bb31SNicolin Chen dev_err(card->dev, "failed to allocate DMA buffer\n"); 4453117bb31SNicolin Chen goto err; 4463117bb31SNicolin Chen } 4473117bb31SNicolin Chen } 4483117bb31SNicolin Chen 4493117bb31SNicolin Chen return 0; 4503117bb31SNicolin Chen 4513117bb31SNicolin Chen err: 4523117bb31SNicolin Chen if (--i == 0 && pcm->streams[i].substream) 4533117bb31SNicolin Chen snd_dma_free_pages(&pcm->streams[i].substream->dma_buffer); 4543117bb31SNicolin Chen 4553117bb31SNicolin Chen return ret; 4563117bb31SNicolin Chen } 4573117bb31SNicolin Chen 4588903ed25SKuninori Morimoto static void fsl_asrc_dma_pcm_free(struct snd_soc_component *component, 4598903ed25SKuninori Morimoto struct snd_pcm *pcm) 4603117bb31SNicolin Chen { 4613117bb31SNicolin Chen struct snd_pcm_substream *substream; 4623117bb31SNicolin Chen int i; 4633117bb31SNicolin Chen 464fa7b2a1fSKuninori Morimoto for_each_pcm_streams(i) { 4653117bb31SNicolin Chen substream = pcm->streams[i].substream; 4663117bb31SNicolin Chen if (!substream) 4673117bb31SNicolin Chen continue; 4683117bb31SNicolin Chen 4693117bb31SNicolin Chen snd_dma_free_pages(&substream->dma_buffer); 4703117bb31SNicolin Chen substream->dma_buffer.area = NULL; 4713117bb31SNicolin Chen substream->dma_buffer.addr = 0; 4723117bb31SNicolin Chen } 4733117bb31SNicolin Chen } 4743117bb31SNicolin Chen 4757f110661SKuninori Morimoto struct snd_soc_component_driver fsl_asrc_component = { 4767f110661SKuninori Morimoto .name = DRV_NAME, 4778903ed25SKuninori Morimoto .hw_params = fsl_asrc_dma_hw_params, 4788903ed25SKuninori Morimoto .hw_free = fsl_asrc_dma_hw_free, 4798903ed25SKuninori Morimoto .trigger = fsl_asrc_dma_trigger, 4808903ed25SKuninori Morimoto .open = fsl_asrc_dma_startup, 4818903ed25SKuninori Morimoto .close = fsl_asrc_dma_shutdown, 4828903ed25SKuninori Morimoto .pointer = fsl_asrc_dma_pcm_pointer, 4838903ed25SKuninori Morimoto .pcm_construct = fsl_asrc_dma_pcm_new, 4848903ed25SKuninori Morimoto .pcm_destruct = fsl_asrc_dma_pcm_free, 4853117bb31SNicolin Chen }; 4867f110661SKuninori Morimoto EXPORT_SYMBOL_GPL(fsl_asrc_component); 487