| 1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387 |
- // SPDX-License-Identifier: GPL-2.0-only
- /*
- * Copyright (c) 2010-2011,2013-2015 The Linux Foundation. All rights reserved.
- *
- * lpass-platform.c -- ALSA SoC platform driver for QTi LPASS
- */
- #include <dt-bindings/sound/qcom,lpass.h>
- #include <linux/dma-mapping.h>
- #include <linux/export.h>
- #include <linux/kernel.h>
- #include <linux/module.h>
- #include <linux/platform_device.h>
- #include <sound/pcm_params.h>
- #include <linux/regmap.h>
- #include <sound/soc.h>
- #include "lpass-lpaif-reg.h"
- #include "lpass.h"
- #define DRV_NAME "lpass-platform"
- #define LPASS_PLATFORM_BUFFER_SIZE (24 * 2 * 1024)
- #define LPASS_PLATFORM_PERIODS 2
- #define LPASS_RXTX_CDC_DMA_LPM_BUFF_SIZE (8 * 1024)
- #define LPASS_VA_CDC_DMA_LPM_BUFF_SIZE (12 * 1024)
- #define LPASS_CDC_DMA_REGISTER_FIELDS_MAX 15
- static const struct snd_pcm_hardware lpass_platform_pcm_hardware = {
- .info = SNDRV_PCM_INFO_MMAP |
- SNDRV_PCM_INFO_MMAP_VALID |
- SNDRV_PCM_INFO_INTERLEAVED |
- SNDRV_PCM_INFO_PAUSE |
- SNDRV_PCM_INFO_RESUME,
- .formats = SNDRV_PCM_FMTBIT_S16 |
- SNDRV_PCM_FMTBIT_S24 |
- SNDRV_PCM_FMTBIT_S32,
- .rates = SNDRV_PCM_RATE_8000_192000,
- .rate_min = 8000,
- .rate_max = 192000,
- .channels_min = 1,
- .channels_max = 8,
- .buffer_bytes_max = LPASS_PLATFORM_BUFFER_SIZE,
- .period_bytes_max = LPASS_PLATFORM_BUFFER_SIZE /
- LPASS_PLATFORM_PERIODS,
- .period_bytes_min = LPASS_PLATFORM_BUFFER_SIZE /
- LPASS_PLATFORM_PERIODS,
- .periods_min = LPASS_PLATFORM_PERIODS,
- .periods_max = LPASS_PLATFORM_PERIODS,
- .fifo_size = 0,
- };
- static const struct snd_pcm_hardware lpass_platform_rxtx_hardware = {
- .info = SNDRV_PCM_INFO_MMAP |
- SNDRV_PCM_INFO_MMAP_VALID |
- SNDRV_PCM_INFO_INTERLEAVED |
- SNDRV_PCM_INFO_PAUSE |
- SNDRV_PCM_INFO_RESUME,
- .formats = SNDRV_PCM_FMTBIT_S16 |
- SNDRV_PCM_FMTBIT_S24 |
- SNDRV_PCM_FMTBIT_S32,
- .rates = SNDRV_PCM_RATE_8000_192000,
- .rate_min = 8000,
- .rate_max = 192000,
- .channels_min = 1,
- .channels_max = 8,
- .buffer_bytes_max = LPASS_RXTX_CDC_DMA_LPM_BUFF_SIZE,
- .period_bytes_max = LPASS_RXTX_CDC_DMA_LPM_BUFF_SIZE /
- LPASS_PLATFORM_PERIODS,
- .period_bytes_min = LPASS_RXTX_CDC_DMA_LPM_BUFF_SIZE /
- LPASS_PLATFORM_PERIODS,
- .periods_min = LPASS_PLATFORM_PERIODS,
- .periods_max = LPASS_PLATFORM_PERIODS,
- .fifo_size = 0,
- };
- static const struct snd_pcm_hardware lpass_platform_va_hardware = {
- .info = SNDRV_PCM_INFO_MMAP |
- SNDRV_PCM_INFO_MMAP_VALID |
- SNDRV_PCM_INFO_INTERLEAVED |
- SNDRV_PCM_INFO_PAUSE |
- SNDRV_PCM_INFO_RESUME,
- .formats = SNDRV_PCM_FMTBIT_S16 |
- SNDRV_PCM_FMTBIT_S24 |
- SNDRV_PCM_FMTBIT_S32,
- .rates = SNDRV_PCM_RATE_8000_192000,
- .rate_min = 8000,
- .rate_max = 192000,
- .channels_min = 1,
- .channels_max = 8,
- .buffer_bytes_max = LPASS_VA_CDC_DMA_LPM_BUFF_SIZE,
- .period_bytes_max = LPASS_VA_CDC_DMA_LPM_BUFF_SIZE /
- LPASS_PLATFORM_PERIODS,
- .period_bytes_min = LPASS_VA_CDC_DMA_LPM_BUFF_SIZE /
- LPASS_PLATFORM_PERIODS,
- .periods_min = LPASS_PLATFORM_PERIODS,
- .periods_max = LPASS_PLATFORM_PERIODS,
- .fifo_size = 0,
- };
- static int lpass_platform_alloc_rxtx_dmactl_fields(struct device *dev,
- struct regmap *map)
- {
- struct lpass_data *drvdata = dev_get_drvdata(dev);
- const struct lpass_variant *v = drvdata->variant;
- struct lpaif_dmactl *rd_dmactl, *wr_dmactl;
- int rval;
- rd_dmactl = devm_kzalloc(dev, sizeof(*rd_dmactl), GFP_KERNEL);
- if (!rd_dmactl)
- return -ENOMEM;
- wr_dmactl = devm_kzalloc(dev, sizeof(*wr_dmactl), GFP_KERNEL);
- if (!wr_dmactl)
- return -ENOMEM;
- drvdata->rxtx_rd_dmactl = rd_dmactl;
- drvdata->rxtx_wr_dmactl = wr_dmactl;
- rval = devm_regmap_field_bulk_alloc(dev, map, &rd_dmactl->intf,
- &v->rxtx_rdma_intf, LPASS_CDC_DMA_REGISTER_FIELDS_MAX);
- if (rval)
- return rval;
- return devm_regmap_field_bulk_alloc(dev, map, &wr_dmactl->intf,
- &v->rxtx_wrdma_intf, LPASS_CDC_DMA_REGISTER_FIELDS_MAX);
- }
- static int lpass_platform_alloc_va_dmactl_fields(struct device *dev,
- struct regmap *map)
- {
- struct lpass_data *drvdata = dev_get_drvdata(dev);
- const struct lpass_variant *v = drvdata->variant;
- struct lpaif_dmactl *wr_dmactl;
- wr_dmactl = devm_kzalloc(dev, sizeof(*wr_dmactl), GFP_KERNEL);
- if (!wr_dmactl)
- return -ENOMEM;
- drvdata->va_wr_dmactl = wr_dmactl;
- return devm_regmap_field_bulk_alloc(dev, map, &wr_dmactl->intf,
- &v->va_wrdma_intf, LPASS_CDC_DMA_REGISTER_FIELDS_MAX);
- }
- static int lpass_platform_alloc_dmactl_fields(struct device *dev,
- struct regmap *map)
- {
- struct lpass_data *drvdata = dev_get_drvdata(dev);
- const struct lpass_variant *v = drvdata->variant;
- struct lpaif_dmactl *rd_dmactl, *wr_dmactl;
- int rval;
- drvdata->rd_dmactl = devm_kzalloc(dev, sizeof(struct lpaif_dmactl),
- GFP_KERNEL);
- if (drvdata->rd_dmactl == NULL)
- return -ENOMEM;
- drvdata->wr_dmactl = devm_kzalloc(dev, sizeof(struct lpaif_dmactl),
- GFP_KERNEL);
- if (drvdata->wr_dmactl == NULL)
- return -ENOMEM;
- rd_dmactl = drvdata->rd_dmactl;
- wr_dmactl = drvdata->wr_dmactl;
- rval = devm_regmap_field_bulk_alloc(dev, map, &rd_dmactl->intf,
- &v->rdma_intf, 6);
- if (rval)
- return rval;
- return devm_regmap_field_bulk_alloc(dev, map, &wr_dmactl->intf,
- &v->wrdma_intf, 6);
- }
- static int lpass_platform_alloc_hdmidmactl_fields(struct device *dev,
- struct regmap *map)
- {
- struct lpass_data *drvdata = dev_get_drvdata(dev);
- const struct lpass_variant *v = drvdata->variant;
- struct lpaif_dmactl *rd_dmactl;
- rd_dmactl = devm_kzalloc(dev, sizeof(struct lpaif_dmactl), GFP_KERNEL);
- if (rd_dmactl == NULL)
- return -ENOMEM;
- drvdata->hdmi_rd_dmactl = rd_dmactl;
- return devm_regmap_field_bulk_alloc(dev, map, &rd_dmactl->bursten,
- &v->hdmi_rdma_bursten, 8);
- }
- static int lpass_platform_pcmops_open(struct snd_soc_component *component,
- struct snd_pcm_substream *substream)
- {
- struct snd_pcm_runtime *runtime = substream->runtime;
- struct snd_soc_pcm_runtime *soc_runtime = snd_soc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(soc_runtime, 0);
- struct lpass_data *drvdata = snd_soc_component_get_drvdata(component);
- const struct lpass_variant *v = drvdata->variant;
- int ret, dma_ch, dir = substream->stream;
- struct lpass_pcm_data *data;
- struct regmap *map;
- unsigned int dai_id = cpu_dai->driver->id;
- component->id = dai_id;
- data = kzalloc(sizeof(*data), GFP_KERNEL);
- if (!data)
- return -ENOMEM;
- data->i2s_port = cpu_dai->driver->id;
- runtime->private_data = data;
- if (v->alloc_dma_channel)
- dma_ch = v->alloc_dma_channel(drvdata, dir, dai_id);
- else
- dma_ch = 0;
- if (dma_ch < 0) {
- kfree(data);
- return dma_ch;
- }
- switch (dai_id) {
- case MI2S_PRIMARY ... MI2S_QUINARY:
- map = drvdata->lpaif_map;
- drvdata->substream[dma_ch] = substream;
- break;
- case LPASS_DP_RX:
- map = drvdata->hdmiif_map;
- drvdata->hdmi_substream[dma_ch] = substream;
- break;
- case LPASS_CDC_DMA_RX0 ... LPASS_CDC_DMA_RX9:
- case LPASS_CDC_DMA_TX0 ... LPASS_CDC_DMA_TX8:
- map = drvdata->rxtx_lpaif_map;
- drvdata->rxtx_substream[dma_ch] = substream;
- break;
- case LPASS_CDC_DMA_VA_TX0 ... LPASS_CDC_DMA_VA_TX8:
- map = drvdata->va_lpaif_map;
- drvdata->va_substream[dma_ch] = substream;
- break;
- default:
- break;
- }
- data->dma_ch = dma_ch;
- switch (dai_id) {
- case MI2S_PRIMARY ... MI2S_QUINARY:
- case LPASS_DP_RX:
- ret = regmap_write(map, LPAIF_DMACTL_REG(v, dma_ch, dir, data->i2s_port), 0);
- if (ret) {
- kfree(data);
- dev_err(soc_runtime->dev, "error writing to rdmactl reg: %d\n", ret);
- return ret;
- }
- snd_soc_set_runtime_hwparams(substream, &lpass_platform_pcm_hardware);
- runtime->dma_bytes = lpass_platform_pcm_hardware.buffer_bytes_max;
- break;
- case LPASS_CDC_DMA_RX0 ... LPASS_CDC_DMA_RX9:
- case LPASS_CDC_DMA_TX0 ... LPASS_CDC_DMA_TX8:
- snd_soc_set_runtime_hwparams(substream, &lpass_platform_rxtx_hardware);
- runtime->dma_bytes = lpass_platform_rxtx_hardware.buffer_bytes_max;
- snd_pcm_set_runtime_buffer(substream, &substream->dma_buffer);
- break;
- case LPASS_CDC_DMA_VA_TX0 ... LPASS_CDC_DMA_VA_TX8:
- snd_soc_set_runtime_hwparams(substream, &lpass_platform_va_hardware);
- runtime->dma_bytes = lpass_platform_va_hardware.buffer_bytes_max;
- snd_pcm_set_runtime_buffer(substream, &substream->dma_buffer);
- break;
- default:
- break;
- }
- ret = snd_pcm_hw_constraint_integer(runtime,
- SNDRV_PCM_HW_PARAM_PERIODS);
- if (ret < 0) {
- kfree(data);
- dev_err(soc_runtime->dev, "setting constraints failed: %d\n",
- ret);
- return -EINVAL;
- }
- return 0;
- }
- static int lpass_platform_pcmops_close(struct snd_soc_component *component,
- struct snd_pcm_substream *substream)
- {
- struct snd_pcm_runtime *runtime = substream->runtime;
- struct snd_soc_pcm_runtime *soc_runtime = snd_soc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(soc_runtime, 0);
- struct lpass_data *drvdata = snd_soc_component_get_drvdata(component);
- const struct lpass_variant *v = drvdata->variant;
- struct lpass_pcm_data *data;
- unsigned int dai_id = cpu_dai->driver->id;
- data = runtime->private_data;
- switch (dai_id) {
- case MI2S_PRIMARY ... MI2S_QUINARY:
- drvdata->substream[data->dma_ch] = NULL;
- break;
- case LPASS_DP_RX:
- drvdata->hdmi_substream[data->dma_ch] = NULL;
- break;
- case LPASS_CDC_DMA_RX0 ... LPASS_CDC_DMA_RX9:
- case LPASS_CDC_DMA_TX0 ... LPASS_CDC_DMA_TX8:
- drvdata->rxtx_substream[data->dma_ch] = NULL;
- break;
- case LPASS_CDC_DMA_VA_TX0 ... LPASS_CDC_DMA_VA_TX8:
- drvdata->va_substream[data->dma_ch] = NULL;
- break;
- default:
- break;
- }
- if (v->free_dma_channel)
- v->free_dma_channel(drvdata, data->dma_ch, dai_id);
- kfree(data);
- return 0;
- }
- static struct lpaif_dmactl *__lpass_get_dmactl_handle(const struct snd_pcm_substream *substream,
- struct snd_soc_component *component)
- {
- struct snd_soc_pcm_runtime *soc_runtime = snd_soc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(soc_runtime, 0);
- struct lpass_data *drvdata = snd_soc_component_get_drvdata(component);
- struct lpaif_dmactl *dmactl = NULL;
- switch (cpu_dai->driver->id) {
- case MI2S_PRIMARY ... MI2S_QUINARY:
- if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
- dmactl = drvdata->rd_dmactl;
- else
- dmactl = drvdata->wr_dmactl;
- break;
- case LPASS_DP_RX:
- dmactl = drvdata->hdmi_rd_dmactl;
- break;
- case LPASS_CDC_DMA_RX0 ... LPASS_CDC_DMA_RX9:
- dmactl = drvdata->rxtx_rd_dmactl;
- break;
- case LPASS_CDC_DMA_TX0 ... LPASS_CDC_DMA_TX8:
- dmactl = drvdata->rxtx_wr_dmactl;
- break;
- case LPASS_CDC_DMA_VA_TX0 ... LPASS_CDC_DMA_VA_TX8:
- dmactl = drvdata->va_wr_dmactl;
- break;
- }
- return dmactl;
- }
- static int __lpass_get_id(const struct snd_pcm_substream *substream,
- struct snd_soc_component *component)
- {
- struct snd_soc_pcm_runtime *soc_runtime = snd_soc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(soc_runtime, 0);
- struct lpass_data *drvdata = snd_soc_component_get_drvdata(component);
- struct snd_pcm_runtime *rt = substream->runtime;
- struct lpass_pcm_data *pcm_data = rt->private_data;
- const struct lpass_variant *v = drvdata->variant;
- int id;
- switch (cpu_dai->driver->id) {
- case MI2S_PRIMARY ... MI2S_QUINARY:
- if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
- id = pcm_data->dma_ch;
- else
- id = pcm_data->dma_ch - v->wrdma_channel_start;
- break;
- case LPASS_DP_RX:
- id = pcm_data->dma_ch;
- break;
- case LPASS_CDC_DMA_RX0 ... LPASS_CDC_DMA_RX9:
- id = pcm_data->dma_ch;
- break;
- case LPASS_CDC_DMA_TX0 ... LPASS_CDC_DMA_TX8:
- id = pcm_data->dma_ch - v->rxtx_wrdma_channel_start;
- break;
- case LPASS_CDC_DMA_VA_TX0 ... LPASS_CDC_DMA_VA_TX8:
- id = pcm_data->dma_ch - v->va_wrdma_channel_start;
- break;
- }
- return id;
- }
- static struct regmap *__lpass_get_regmap_handle(const struct snd_pcm_substream *substream,
- struct snd_soc_component *component)
- {
- struct snd_soc_pcm_runtime *soc_runtime = snd_soc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(soc_runtime, 0);
- struct lpass_data *drvdata = snd_soc_component_get_drvdata(component);
- struct regmap *map = NULL;
- switch (cpu_dai->driver->id) {
- case MI2S_PRIMARY ... MI2S_QUINARY:
- map = drvdata->lpaif_map;
- break;
- case LPASS_DP_RX:
- map = drvdata->hdmiif_map;
- break;
- case LPASS_CDC_DMA_RX0 ... LPASS_CDC_DMA_RX9:
- case LPASS_CDC_DMA_TX0 ... LPASS_CDC_DMA_TX8:
- map = drvdata->rxtx_lpaif_map;
- break;
- case LPASS_CDC_DMA_VA_TX0 ... LPASS_CDC_DMA_VA_TX8:
- map = drvdata->va_lpaif_map;
- break;
- }
- return map;
- }
- static int lpass_platform_pcmops_hw_params(struct snd_soc_component *component,
- struct snd_pcm_substream *substream,
- struct snd_pcm_hw_params *params)
- {
- struct snd_soc_pcm_runtime *soc_runtime = snd_soc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(soc_runtime, 0);
- struct lpass_data *drvdata = snd_soc_component_get_drvdata(component);
- struct snd_pcm_runtime *rt = substream->runtime;
- struct lpass_pcm_data *pcm_data = rt->private_data;
- const struct lpass_variant *v = drvdata->variant;
- snd_pcm_format_t format = params_format(params);
- unsigned int channels = params_channels(params);
- unsigned int regval;
- struct lpaif_dmactl *dmactl;
- int id;
- int bitwidth;
- int ret, dma_port = pcm_data->i2s_port + v->dmactl_audif_start;
- unsigned int dai_id = cpu_dai->driver->id;
- dmactl = __lpass_get_dmactl_handle(substream, component);
- id = __lpass_get_id(substream, component);
- bitwidth = snd_pcm_format_width(format);
- if (bitwidth < 0) {
- dev_err(soc_runtime->dev, "invalid bit width given: %d\n",
- bitwidth);
- return bitwidth;
- }
- ret = regmap_fields_write(dmactl->bursten, id, LPAIF_DMACTL_BURSTEN_INCR4);
- if (ret) {
- dev_err(soc_runtime->dev, "error updating bursten field: %d\n", ret);
- return ret;
- }
- ret = regmap_fields_write(dmactl->fifowm, id, LPAIF_DMACTL_FIFOWM_8);
- if (ret) {
- dev_err(soc_runtime->dev, "error updating fifowm field: %d\n", ret);
- return ret;
- }
- switch (dai_id) {
- case LPASS_DP_RX:
- ret = regmap_fields_write(dmactl->burst8, id,
- LPAIF_DMACTL_BURSTEN_INCR4);
- if (ret) {
- dev_err(soc_runtime->dev, "error updating burst8en field: %d\n", ret);
- return ret;
- }
- ret = regmap_fields_write(dmactl->burst16, id,
- LPAIF_DMACTL_BURSTEN_INCR4);
- if (ret) {
- dev_err(soc_runtime->dev, "error updating burst16en field: %d\n", ret);
- return ret;
- }
- ret = regmap_fields_write(dmactl->dynburst, id,
- LPAIF_DMACTL_BURSTEN_INCR4);
- if (ret) {
- dev_err(soc_runtime->dev, "error updating dynbursten field: %d\n", ret);
- return ret;
- }
- break;
- case MI2S_PRIMARY:
- case MI2S_SECONDARY:
- case MI2S_TERTIARY:
- case MI2S_QUATERNARY:
- case MI2S_QUINARY:
- ret = regmap_fields_write(dmactl->intf, id,
- LPAIF_DMACTL_AUDINTF(dma_port));
- if (ret) {
- dev_err(soc_runtime->dev, "error updating audio interface field: %d\n",
- ret);
- return ret;
- }
- break;
- case LPASS_CDC_DMA_RX0 ... LPASS_CDC_DMA_RX9:
- case LPASS_CDC_DMA_TX0 ... LPASS_CDC_DMA_TX8:
- case LPASS_CDC_DMA_VA_TX0 ... LPASS_CDC_DMA_VA_TX0:
- break;
- default:
- dev_err(soc_runtime->dev, "%s: invalid interface: %d\n", __func__, dai_id);
- break;
- }
- switch (bitwidth) {
- case 16:
- switch (channels) {
- case 1:
- case 2:
- regval = LPAIF_DMACTL_WPSCNT_ONE;
- break;
- case 4:
- regval = LPAIF_DMACTL_WPSCNT_TWO;
- break;
- case 6:
- regval = LPAIF_DMACTL_WPSCNT_THREE;
- break;
- case 8:
- regval = LPAIF_DMACTL_WPSCNT_FOUR;
- break;
- default:
- dev_err(soc_runtime->dev, "invalid PCM config given: bw=%d, ch=%u\n",
- bitwidth, channels);
- return -EINVAL;
- }
- break;
- case 24:
- case 32:
- switch (channels) {
- case 1:
- regval = LPAIF_DMACTL_WPSCNT_ONE;
- break;
- case 2:
- regval = (dai_id == LPASS_DP_RX ?
- LPAIF_DMACTL_WPSCNT_ONE :
- LPAIF_DMACTL_WPSCNT_TWO);
- break;
- case 4:
- regval = (dai_id == LPASS_DP_RX ?
- LPAIF_DMACTL_WPSCNT_TWO :
- LPAIF_DMACTL_WPSCNT_FOUR);
- break;
- case 6:
- regval = (dai_id == LPASS_DP_RX ?
- LPAIF_DMACTL_WPSCNT_THREE :
- LPAIF_DMACTL_WPSCNT_SIX);
- break;
- case 8:
- regval = (dai_id == LPASS_DP_RX ?
- LPAIF_DMACTL_WPSCNT_FOUR :
- LPAIF_DMACTL_WPSCNT_EIGHT);
- break;
- default:
- dev_err(soc_runtime->dev, "invalid PCM config given: bw=%d, ch=%u\n",
- bitwidth, channels);
- return -EINVAL;
- }
- break;
- default:
- dev_err(soc_runtime->dev, "invalid PCM config given: bw=%d, ch=%u\n",
- bitwidth, channels);
- return -EINVAL;
- }
- ret = regmap_fields_write(dmactl->wpscnt, id, regval);
- if (ret) {
- dev_err(soc_runtime->dev, "error writing to dmactl reg: %d\n",
- ret);
- return ret;
- }
- return 0;
- }
- static int lpass_platform_pcmops_hw_free(struct snd_soc_component *component,
- struct snd_pcm_substream *substream)
- {
- struct snd_soc_pcm_runtime *soc_runtime = snd_soc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(soc_runtime, 0);
- struct lpass_data *drvdata = snd_soc_component_get_drvdata(component);
- struct snd_pcm_runtime *rt = substream->runtime;
- struct lpass_pcm_data *pcm_data = rt->private_data;
- const struct lpass_variant *v = drvdata->variant;
- unsigned int reg;
- int ret;
- struct regmap *map;
- unsigned int dai_id = cpu_dai->driver->id;
- if (is_cdc_dma_port(dai_id))
- return 0;
- map = __lpass_get_regmap_handle(substream, component);
- reg = LPAIF_DMACTL_REG(v, pcm_data->dma_ch, substream->stream, dai_id);
- ret = regmap_write(map, reg, 0);
- if (ret)
- dev_err(soc_runtime->dev, "error writing to rdmactl reg: %d\n",
- ret);
- return ret;
- }
- static int lpass_platform_pcmops_prepare(struct snd_soc_component *component,
- struct snd_pcm_substream *substream)
- {
- struct snd_pcm_runtime *runtime = substream->runtime;
- struct snd_soc_pcm_runtime *soc_runtime = snd_soc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(soc_runtime, 0);
- struct lpass_data *drvdata = snd_soc_component_get_drvdata(component);
- struct snd_pcm_runtime *rt = substream->runtime;
- struct lpass_pcm_data *pcm_data = rt->private_data;
- const struct lpass_variant *v = drvdata->variant;
- struct lpaif_dmactl *dmactl;
- struct regmap *map;
- int ret, id, ch, dir = substream->stream;
- unsigned int dai_id = cpu_dai->driver->id;
- ch = pcm_data->dma_ch;
- dmactl = __lpass_get_dmactl_handle(substream, component);
- id = __lpass_get_id(substream, component);
- map = __lpass_get_regmap_handle(substream, component);
- ret = regmap_write(map, LPAIF_DMABASE_REG(v, ch, dir, dai_id),
- runtime->dma_addr);
- if (ret) {
- dev_err(soc_runtime->dev, "error writing to rdmabase reg: %d\n",
- ret);
- return ret;
- }
- ret = regmap_write(map, LPAIF_DMABUFF_REG(v, ch, dir, dai_id),
- (snd_pcm_lib_buffer_bytes(substream) >> 2) - 1);
- if (ret) {
- dev_err(soc_runtime->dev, "error writing to rdmabuff reg: %d\n",
- ret);
- return ret;
- }
- ret = regmap_write(map, LPAIF_DMAPER_REG(v, ch, dir, dai_id),
- (snd_pcm_lib_period_bytes(substream) >> 2) - 1);
- if (ret) {
- dev_err(soc_runtime->dev, "error writing to rdmaper reg: %d\n",
- ret);
- return ret;
- }
- if (is_cdc_dma_port(dai_id)) {
- ret = regmap_fields_write(dmactl->fifowm, id, LPAIF_DMACTL_FIFOWM_8);
- if (ret) {
- dev_err(soc_runtime->dev, "error writing fifowm field to dmactl reg: %d, id: %d\n",
- ret, id);
- return ret;
- }
- }
- ret = regmap_fields_write(dmactl->enable, id, LPAIF_DMACTL_ENABLE_ON);
- if (ret) {
- dev_err(soc_runtime->dev, "error writing to rdmactl reg: %d\n",
- ret);
- return ret;
- }
- return 0;
- }
- static int lpass_platform_pcmops_trigger(struct snd_soc_component *component,
- struct snd_pcm_substream *substream,
- int cmd)
- {
- struct snd_soc_pcm_runtime *soc_runtime = snd_soc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(soc_runtime, 0);
- struct lpass_data *drvdata = snd_soc_component_get_drvdata(component);
- struct snd_pcm_runtime *rt = substream->runtime;
- struct lpass_pcm_data *pcm_data = rt->private_data;
- const struct lpass_variant *v = drvdata->variant;
- struct lpaif_dmactl *dmactl;
- struct regmap *map;
- int ret, ch, id;
- unsigned int reg_irqclr = 0, val_irqclr = 0;
- unsigned int reg_irqen = 0, val_irqen = 0, val_mask = 0;
- unsigned int dai_id = cpu_dai->driver->id;
- ch = pcm_data->dma_ch;
- dmactl = __lpass_get_dmactl_handle(substream, component);
- id = __lpass_get_id(substream, component);
- map = __lpass_get_regmap_handle(substream, component);
- switch (cmd) {
- case SNDRV_PCM_TRIGGER_START:
- case SNDRV_PCM_TRIGGER_RESUME:
- case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
- ret = regmap_fields_write(dmactl->enable, id,
- LPAIF_DMACTL_ENABLE_ON);
- if (ret) {
- dev_err(soc_runtime->dev,
- "error writing to rdmactl reg: %d\n", ret);
- return ret;
- }
- switch (dai_id) {
- case LPASS_DP_RX:
- ret = regmap_fields_write(dmactl->dyncclk, id,
- LPAIF_DMACTL_DYNCLK_ON);
- if (ret) {
- dev_err(soc_runtime->dev,
- "error writing to rdmactl reg: %d\n", ret);
- return ret;
- }
- reg_irqclr = LPASS_HDMITX_APP_IRQCLEAR_REG(v);
- val_irqclr = (LPAIF_IRQ_ALL(ch) |
- LPAIF_IRQ_HDMI_REQ_ON_PRELOAD(ch) |
- LPAIF_IRQ_HDMI_METADONE |
- LPAIF_IRQ_HDMI_SDEEP_AUD_DIS(ch));
- reg_irqen = LPASS_HDMITX_APP_IRQEN_REG(v);
- val_mask = (LPAIF_IRQ_ALL(ch) |
- LPAIF_IRQ_HDMI_REQ_ON_PRELOAD(ch) |
- LPAIF_IRQ_HDMI_METADONE |
- LPAIF_IRQ_HDMI_SDEEP_AUD_DIS(ch));
- val_irqen = (LPAIF_IRQ_ALL(ch) |
- LPAIF_IRQ_HDMI_REQ_ON_PRELOAD(ch) |
- LPAIF_IRQ_HDMI_METADONE |
- LPAIF_IRQ_HDMI_SDEEP_AUD_DIS(ch));
- break;
- case MI2S_PRIMARY:
- case MI2S_SECONDARY:
- case MI2S_TERTIARY:
- case MI2S_QUATERNARY:
- case MI2S_QUINARY:
- reg_irqclr = LPAIF_IRQCLEAR_REG(v, LPAIF_IRQ_PORT_HOST);
- val_irqclr = LPAIF_IRQ_ALL(ch);
- reg_irqen = LPAIF_IRQEN_REG(v, LPAIF_IRQ_PORT_HOST);
- val_mask = LPAIF_IRQ_ALL(ch);
- val_irqen = LPAIF_IRQ_ALL(ch);
- break;
- case LPASS_CDC_DMA_RX0 ... LPASS_CDC_DMA_RX9:
- case LPASS_CDC_DMA_TX0 ... LPASS_CDC_DMA_TX8:
- ret = regmap_fields_write(dmactl->dyncclk, id, LPAIF_DMACTL_DYNCLK_ON);
- if (ret) {
- dev_err(soc_runtime->dev,
- "error writing to rdmactl reg field: %d\n", ret);
- return ret;
- }
- reg_irqclr = LPAIF_RXTX_IRQCLEAR_REG(v, LPAIF_IRQ_PORT_HOST);
- val_irqclr = LPAIF_IRQ_ALL(ch);
- reg_irqen = LPAIF_RXTX_IRQEN_REG(v, LPAIF_IRQ_PORT_HOST);
- val_mask = LPAIF_IRQ_ALL(ch);
- val_irqen = LPAIF_IRQ_ALL(ch);
- break;
- case LPASS_CDC_DMA_VA_TX0 ... LPASS_CDC_DMA_VA_TX8:
- ret = regmap_fields_write(dmactl->dyncclk, id, LPAIF_DMACTL_DYNCLK_ON);
- if (ret) {
- dev_err(soc_runtime->dev,
- "error writing to rdmactl reg field: %d\n", ret);
- return ret;
- }
- reg_irqclr = LPAIF_VA_IRQCLEAR_REG(v, LPAIF_IRQ_PORT_HOST);
- val_irqclr = LPAIF_IRQ_ALL(ch);
- reg_irqen = LPAIF_VA_IRQEN_REG(v, LPAIF_IRQ_PORT_HOST);
- val_mask = LPAIF_IRQ_ALL(ch);
- val_irqen = LPAIF_IRQ_ALL(ch);
- break;
- default:
- dev_err(soc_runtime->dev, "%s: invalid %d interface\n", __func__, dai_id);
- return -EINVAL;
- }
- ret = regmap_write_bits(map, reg_irqclr, val_irqclr, val_irqclr);
- if (ret) {
- dev_err(soc_runtime->dev, "error writing to irqclear reg: %d\n", ret);
- return ret;
- }
- ret = regmap_update_bits(map, reg_irqen, val_mask, val_irqen);
- if (ret) {
- dev_err(soc_runtime->dev, "error writing to irqen reg: %d\n", ret);
- return ret;
- }
- break;
- case SNDRV_PCM_TRIGGER_STOP:
- case SNDRV_PCM_TRIGGER_SUSPEND:
- case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
- ret = regmap_fields_write(dmactl->enable, id,
- LPAIF_DMACTL_ENABLE_OFF);
- if (ret) {
- dev_err(soc_runtime->dev,
- "error writing to rdmactl reg: %d\n", ret);
- return ret;
- }
- switch (dai_id) {
- case LPASS_DP_RX:
- ret = regmap_fields_write(dmactl->dyncclk, id,
- LPAIF_DMACTL_DYNCLK_OFF);
- if (ret) {
- dev_err(soc_runtime->dev,
- "error writing to rdmactl reg: %d\n", ret);
- return ret;
- }
- reg_irqen = LPASS_HDMITX_APP_IRQEN_REG(v);
- val_mask = (LPAIF_IRQ_ALL(ch) |
- LPAIF_IRQ_HDMI_REQ_ON_PRELOAD(ch) |
- LPAIF_IRQ_HDMI_METADONE |
- LPAIF_IRQ_HDMI_SDEEP_AUD_DIS(ch));
- val_irqen = 0;
- break;
- case MI2S_PRIMARY:
- case MI2S_SECONDARY:
- case MI2S_TERTIARY:
- case MI2S_QUATERNARY:
- case MI2S_QUINARY:
- reg_irqen = LPAIF_IRQEN_REG(v, LPAIF_IRQ_PORT_HOST);
- val_mask = LPAIF_IRQ_ALL(ch);
- val_irqen = 0;
- break;
- case LPASS_CDC_DMA_RX0 ... LPASS_CDC_DMA_RX9:
- case LPASS_CDC_DMA_TX0 ... LPASS_CDC_DMA_TX8:
- ret = regmap_fields_write(dmactl->dyncclk, id, LPAIF_DMACTL_DYNCLK_OFF);
- if (ret) {
- dev_err(soc_runtime->dev,
- "error writing to rdmactl reg field: %d\n", ret);
- return ret;
- }
- reg_irqclr = LPAIF_RXTX_IRQCLEAR_REG(v, LPAIF_IRQ_PORT_HOST);
- val_irqclr = LPAIF_IRQ_ALL(ch);
- reg_irqen = LPAIF_RXTX_IRQEN_REG(v, LPAIF_IRQ_PORT_HOST);
- val_mask = LPAIF_IRQ_ALL(ch);
- val_irqen = LPAIF_IRQ_ALL(ch);
- break;
- case LPASS_CDC_DMA_VA_TX0 ... LPASS_CDC_DMA_VA_TX8:
- ret = regmap_fields_write(dmactl->dyncclk, id, LPAIF_DMACTL_DYNCLK_OFF);
- if (ret) {
- dev_err(soc_runtime->dev,
- "error writing to rdmactl reg field: %d\n", ret);
- return ret;
- }
- reg_irqclr = LPAIF_VA_IRQCLEAR_REG(v, LPAIF_IRQ_PORT_HOST);
- val_irqclr = LPAIF_IRQ_ALL(ch);
- reg_irqen = LPAIF_VA_IRQEN_REG(v, LPAIF_IRQ_PORT_HOST);
- val_mask = LPAIF_IRQ_ALL(ch);
- val_irqen = LPAIF_IRQ_ALL(ch);
- break;
- default:
- dev_err(soc_runtime->dev, "%s: invalid %d interface\n", __func__, dai_id);
- return -EINVAL;
- }
- ret = regmap_update_bits(map, reg_irqen, val_mask, val_irqen);
- if (ret) {
- dev_err(soc_runtime->dev,
- "error writing to irqen reg: %d\n", ret);
- return ret;
- }
- break;
- }
- return 0;
- }
- static snd_pcm_uframes_t lpass_platform_pcmops_pointer(
- struct snd_soc_component *component,
- struct snd_pcm_substream *substream)
- {
- struct snd_soc_pcm_runtime *soc_runtime = snd_soc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(soc_runtime, 0);
- struct lpass_data *drvdata = snd_soc_component_get_drvdata(component);
- struct snd_pcm_runtime *rt = substream->runtime;
- struct lpass_pcm_data *pcm_data = rt->private_data;
- const struct lpass_variant *v = drvdata->variant;
- unsigned int base_addr, curr_addr;
- int ret, ch, dir = substream->stream;
- struct regmap *map;
- unsigned int dai_id = cpu_dai->driver->id;
- map = __lpass_get_regmap_handle(substream, component);
- ch = pcm_data->dma_ch;
- ret = regmap_read(map,
- LPAIF_DMABASE_REG(v, ch, dir, dai_id), &base_addr);
- if (ret) {
- dev_err(soc_runtime->dev,
- "error reading from rdmabase reg: %d\n", ret);
- return ret;
- }
- ret = regmap_read(map,
- LPAIF_DMACURR_REG(v, ch, dir, dai_id), &curr_addr);
- if (ret) {
- dev_err(soc_runtime->dev,
- "error reading from rdmacurr reg: %d\n", ret);
- return ret;
- }
- return bytes_to_frames(substream->runtime, curr_addr - base_addr);
- }
- static int lpass_platform_cdc_dma_mmap(struct snd_pcm_substream *substream,
- struct vm_area_struct *vma)
- {
- struct snd_pcm_runtime *runtime = substream->runtime;
- unsigned long size, offset;
- vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot);
- size = vma->vm_end - vma->vm_start;
- offset = vma->vm_pgoff << PAGE_SHIFT;
- return io_remap_pfn_range(vma, vma->vm_start,
- (runtime->dma_addr + offset) >> PAGE_SHIFT,
- size, vma->vm_page_prot);
- }
- static int lpass_platform_pcmops_mmap(struct snd_soc_component *component,
- struct snd_pcm_substream *substream,
- struct vm_area_struct *vma)
- {
- struct snd_soc_pcm_runtime *soc_runtime = snd_soc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(soc_runtime, 0);
- unsigned int dai_id = cpu_dai->driver->id;
- if (is_cdc_dma_port(dai_id))
- return lpass_platform_cdc_dma_mmap(substream, vma);
- return snd_pcm_lib_default_mmap(substream, vma);
- }
- static irqreturn_t lpass_dma_interrupt_handler(
- struct snd_pcm_substream *substream,
- struct lpass_data *drvdata,
- int chan, u32 interrupts)
- {
- struct snd_soc_pcm_runtime *soc_runtime = snd_soc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(soc_runtime, 0);
- const struct lpass_variant *v = drvdata->variant;
- irqreturn_t ret = IRQ_NONE;
- int rv;
- unsigned int reg, val, mask;
- struct regmap *map;
- unsigned int dai_id = cpu_dai->driver->id;
- mask = LPAIF_IRQ_ALL(chan);
- switch (dai_id) {
- case LPASS_DP_RX:
- map = drvdata->hdmiif_map;
- reg = LPASS_HDMITX_APP_IRQCLEAR_REG(v);
- val = (LPAIF_IRQ_HDMI_REQ_ON_PRELOAD(chan) |
- LPAIF_IRQ_HDMI_METADONE |
- LPAIF_IRQ_HDMI_SDEEP_AUD_DIS(chan));
- break;
- case MI2S_PRIMARY:
- case MI2S_SECONDARY:
- case MI2S_TERTIARY:
- case MI2S_QUATERNARY:
- case MI2S_QUINARY:
- map = drvdata->lpaif_map;
- reg = LPAIF_IRQCLEAR_REG(v, LPAIF_IRQ_PORT_HOST);
- val = 0;
- break;
- case LPASS_CDC_DMA_RX0 ... LPASS_CDC_DMA_RX9:
- case LPASS_CDC_DMA_TX0 ... LPASS_CDC_DMA_TX8:
- map = drvdata->rxtx_lpaif_map;
- reg = LPAIF_RXTX_IRQCLEAR_REG(v, LPAIF_IRQ_PORT_HOST);
- val = 0;
- break;
- case LPASS_CDC_DMA_VA_TX0 ... LPASS_CDC_DMA_VA_TX8:
- map = drvdata->va_lpaif_map;
- reg = LPAIF_VA_IRQCLEAR_REG(v, LPAIF_IRQ_PORT_HOST);
- val = 0;
- break;
- default:
- dev_err(soc_runtime->dev, "%s: invalid %d interface\n", __func__, dai_id);
- return -EINVAL;
- }
- if (interrupts & LPAIF_IRQ_PER(chan)) {
- rv = regmap_write_bits(map, reg, mask, (LPAIF_IRQ_PER(chan) | val));
- if (rv) {
- dev_err(soc_runtime->dev,
- "error writing to irqclear reg: %d\n", rv);
- return IRQ_NONE;
- }
- snd_pcm_period_elapsed(substream);
- ret = IRQ_HANDLED;
- }
- if (interrupts & LPAIF_IRQ_XRUN(chan)) {
- rv = regmap_write_bits(map, reg, mask, (LPAIF_IRQ_XRUN(chan) | val));
- if (rv) {
- dev_err(soc_runtime->dev,
- "error writing to irqclear reg: %d\n", rv);
- return IRQ_NONE;
- }
- dev_warn_ratelimited(soc_runtime->dev, "xrun warning\n");
- snd_pcm_stop_xrun(substream);
- ret = IRQ_HANDLED;
- }
- if (interrupts & LPAIF_IRQ_ERR(chan)) {
- rv = regmap_write_bits(map, reg, mask, (LPAIF_IRQ_ERR(chan) | val));
- if (rv) {
- dev_err(soc_runtime->dev,
- "error writing to irqclear reg: %d\n", rv);
- return IRQ_NONE;
- }
- dev_err(soc_runtime->dev, "bus access error\n");
- snd_pcm_stop(substream, SNDRV_PCM_STATE_DISCONNECTED);
- ret = IRQ_HANDLED;
- }
- if (interrupts & val) {
- rv = regmap_write(map, reg, val);
- if (rv) {
- dev_err(soc_runtime->dev,
- "error writing to irqclear reg: %d\n", rv);
- return IRQ_NONE;
- }
- ret = IRQ_HANDLED;
- }
- return ret;
- }
- static irqreturn_t lpass_platform_lpaif_irq(int irq, void *data)
- {
- struct lpass_data *drvdata = data;
- const struct lpass_variant *v = drvdata->variant;
- unsigned int irqs;
- int rv, chan;
- rv = regmap_read(drvdata->lpaif_map,
- LPAIF_IRQSTAT_REG(v, LPAIF_IRQ_PORT_HOST), &irqs);
- if (rv) {
- pr_err("error reading from irqstat reg: %d\n", rv);
- return IRQ_NONE;
- }
- /* Handle per channel interrupts */
- for (chan = 0; chan < LPASS_MAX_DMA_CHANNELS; chan++) {
- if (irqs & LPAIF_IRQ_ALL(chan) && drvdata->substream[chan]) {
- rv = lpass_dma_interrupt_handler(
- drvdata->substream[chan],
- drvdata, chan, irqs);
- if (rv != IRQ_HANDLED)
- return rv;
- }
- }
- return IRQ_HANDLED;
- }
- static irqreturn_t lpass_platform_hdmiif_irq(int irq, void *data)
- {
- struct lpass_data *drvdata = data;
- const struct lpass_variant *v = drvdata->variant;
- unsigned int irqs;
- int rv, chan;
- rv = regmap_read(drvdata->hdmiif_map,
- LPASS_HDMITX_APP_IRQSTAT_REG(v), &irqs);
- if (rv) {
- pr_err("error reading from irqstat reg: %d\n", rv);
- return IRQ_NONE;
- }
- /* Handle per channel interrupts */
- for (chan = 0; chan < LPASS_MAX_HDMI_DMA_CHANNELS; chan++) {
- if (irqs & (LPAIF_IRQ_ALL(chan) | LPAIF_IRQ_HDMI_REQ_ON_PRELOAD(chan) |
- LPAIF_IRQ_HDMI_METADONE |
- LPAIF_IRQ_HDMI_SDEEP_AUD_DIS(chan))
- && drvdata->hdmi_substream[chan]) {
- rv = lpass_dma_interrupt_handler(
- drvdata->hdmi_substream[chan],
- drvdata, chan, irqs);
- if (rv != IRQ_HANDLED)
- return rv;
- }
- }
- return IRQ_HANDLED;
- }
- static irqreturn_t lpass_platform_rxtxif_irq(int irq, void *data)
- {
- struct lpass_data *drvdata = data;
- const struct lpass_variant *v = drvdata->variant;
- unsigned int irqs;
- irqreturn_t rv;
- int chan;
- rv = regmap_read(drvdata->rxtx_lpaif_map,
- LPAIF_RXTX_IRQSTAT_REG(v, LPAIF_IRQ_PORT_HOST), &irqs);
- /* Handle per channel interrupts */
- for (chan = 0; chan < LPASS_MAX_CDC_DMA_CHANNELS; chan++) {
- if (irqs & LPAIF_IRQ_ALL(chan) && drvdata->rxtx_substream[chan]) {
- rv = lpass_dma_interrupt_handler(
- drvdata->rxtx_substream[chan],
- drvdata, chan, irqs);
- if (rv != IRQ_HANDLED)
- return rv;
- }
- }
- return IRQ_HANDLED;
- }
- static irqreturn_t lpass_platform_vaif_irq(int irq, void *data)
- {
- struct lpass_data *drvdata = data;
- const struct lpass_variant *v = drvdata->variant;
- unsigned int irqs;
- irqreturn_t rv;
- int chan;
- rv = regmap_read(drvdata->va_lpaif_map,
- LPAIF_VA_IRQSTAT_REG(v, LPAIF_IRQ_PORT_HOST), &irqs);
- /* Handle per channel interrupts */
- for (chan = 0; chan < LPASS_MAX_VA_CDC_DMA_CHANNELS; chan++) {
- if (irqs & LPAIF_IRQ_ALL(chan) && drvdata->va_substream[chan]) {
- rv = lpass_dma_interrupt_handler(
- drvdata->va_substream[chan],
- drvdata, chan, irqs);
- if (rv != IRQ_HANDLED)
- return rv;
- }
- }
- return IRQ_HANDLED;
- }
- static int lpass_platform_prealloc_cdc_dma_buffer(struct snd_soc_component *component,
- struct snd_pcm *pcm, int dai_id)
- {
- struct lpass_data *drvdata = snd_soc_component_get_drvdata(component);
- struct snd_pcm_substream *substream;
- struct snd_dma_buffer *buf;
- if (pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream)
- substream = pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream;
- else
- substream = pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream;
- buf = &substream->dma_buffer;
- buf->dev.dev = pcm->card->dev;
- buf->private_data = NULL;
- /* Assign Codec DMA buffer pointers */
- buf->dev.type = SNDRV_DMA_TYPE_CONTINUOUS;
- switch (dai_id) {
- case LPASS_CDC_DMA_RX0 ... LPASS_CDC_DMA_RX9:
- buf->bytes = lpass_platform_rxtx_hardware.buffer_bytes_max;
- buf->addr = drvdata->rxtx_cdc_dma_lpm_buf;
- break;
- case LPASS_CDC_DMA_TX0 ... LPASS_CDC_DMA_TX8:
- buf->bytes = lpass_platform_rxtx_hardware.buffer_bytes_max;
- buf->addr = drvdata->rxtx_cdc_dma_lpm_buf + LPASS_RXTX_CDC_DMA_LPM_BUFF_SIZE;
- break;
- case LPASS_CDC_DMA_VA_TX0 ... LPASS_CDC_DMA_VA_TX8:
- buf->bytes = lpass_platform_va_hardware.buffer_bytes_max;
- buf->addr = drvdata->va_cdc_dma_lpm_buf;
- break;
- default:
- break;
- }
- buf->area = (unsigned char * __force)memremap(buf->addr, buf->bytes, MEMREMAP_WC);
- return 0;
- }
- static int lpass_platform_pcm_new(struct snd_soc_component *component,
- struct snd_soc_pcm_runtime *soc_runtime)
- {
- struct snd_pcm *pcm = soc_runtime->pcm;
- struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(soc_runtime, 0);
- unsigned int dai_id = cpu_dai->driver->id;
- size_t size = lpass_platform_pcm_hardware.buffer_bytes_max;
- /*
- * Lpass codec dma can access only lpass lpm hardware memory.
- * ioremap is for HLOS to access hardware memory.
- */
- if (is_cdc_dma_port(dai_id))
- return lpass_platform_prealloc_cdc_dma_buffer(component, pcm, dai_id);
- return snd_pcm_set_fixed_buffer_all(pcm, SNDRV_DMA_TYPE_NONCOHERENT,
- component->dev, size);
- }
- static int lpass_platform_pcmops_suspend(struct snd_soc_component *component)
- {
- struct lpass_data *drvdata = snd_soc_component_get_drvdata(component);
- struct regmap *map;
- unsigned int dai_id = component->id;
- if (dai_id == LPASS_DP_RX)
- map = drvdata->hdmiif_map;
- else
- map = drvdata->lpaif_map;
- regcache_cache_only(map, true);
- regcache_mark_dirty(map);
- return 0;
- }
- static int lpass_platform_pcmops_resume(struct snd_soc_component *component)
- {
- struct lpass_data *drvdata = snd_soc_component_get_drvdata(component);
- struct regmap *map;
- unsigned int dai_id = component->id;
- if (dai_id == LPASS_DP_RX)
- map = drvdata->hdmiif_map;
- else
- map = drvdata->lpaif_map;
- regcache_cache_only(map, false);
- return regcache_sync(map);
- }
- static int lpass_platform_copy(struct snd_soc_component *component,
- struct snd_pcm_substream *substream, int channel,
- unsigned long pos, struct iov_iter *buf,
- unsigned long bytes)
- {
- struct snd_pcm_runtime *rt = substream->runtime;
- unsigned int dai_id = component->id;
- int ret = 0;
- void __iomem *dma_buf = (void __iomem *) (rt->dma_area + pos +
- channel * (rt->dma_bytes / rt->channels));
- if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
- if (is_cdc_dma_port(dai_id)) {
- ret = copy_from_iter_toio(dma_buf, buf, bytes);
- } else {
- if (copy_from_iter((void __force *)dma_buf, bytes, buf) != bytes)
- ret = -EFAULT;
- }
- } else if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) {
- if (is_cdc_dma_port(dai_id)) {
- ret = copy_to_iter_fromio(buf, dma_buf, bytes);
- } else {
- if (copy_to_iter((void __force *)dma_buf, bytes, buf) != bytes)
- ret = -EFAULT;
- }
- }
- return ret;
- }
- static const struct snd_soc_component_driver lpass_component_driver = {
- .name = DRV_NAME,
- .open = lpass_platform_pcmops_open,
- .close = lpass_platform_pcmops_close,
- .hw_params = lpass_platform_pcmops_hw_params,
- .hw_free = lpass_platform_pcmops_hw_free,
- .prepare = lpass_platform_pcmops_prepare,
- .trigger = lpass_platform_pcmops_trigger,
- .pointer = lpass_platform_pcmops_pointer,
- .mmap = lpass_platform_pcmops_mmap,
- .pcm_construct = lpass_platform_pcm_new,
- .suspend = lpass_platform_pcmops_suspend,
- .resume = lpass_platform_pcmops_resume,
- .copy = lpass_platform_copy,
- };
- int asoc_qcom_lpass_platform_register(struct platform_device *pdev)
- {
- struct lpass_data *drvdata = platform_get_drvdata(pdev);
- const struct lpass_variant *v = drvdata->variant;
- int ret;
- drvdata->lpaif_irq = platform_get_irq_byname(pdev, "lpass-irq-lpaif");
- if (drvdata->lpaif_irq < 0)
- return -ENODEV;
- /* ensure audio hardware is disabled */
- ret = regmap_write(drvdata->lpaif_map,
- LPAIF_IRQEN_REG(v, LPAIF_IRQ_PORT_HOST), 0);
- if (ret) {
- dev_err(&pdev->dev, "error writing to irqen reg: %d\n", ret);
- return ret;
- }
- ret = devm_request_irq(&pdev->dev, drvdata->lpaif_irq,
- lpass_platform_lpaif_irq, IRQF_TRIGGER_RISING,
- "lpass-irq-lpaif", drvdata);
- if (ret) {
- dev_err(&pdev->dev, "irq request failed: %d\n", ret);
- return ret;
- }
- ret = lpass_platform_alloc_dmactl_fields(&pdev->dev,
- drvdata->lpaif_map);
- if (ret) {
- dev_err(&pdev->dev,
- "error initializing dmactl fields: %d\n", ret);
- return ret;
- }
- if (drvdata->codec_dma_enable) {
- ret = regmap_write(drvdata->rxtx_lpaif_map,
- LPAIF_RXTX_IRQEN_REG(v, LPAIF_IRQ_PORT_HOST), 0x0);
- if (ret) {
- dev_err(&pdev->dev, "error writing to rxtx irqen reg: %d\n", ret);
- return ret;
- }
- ret = regmap_write(drvdata->va_lpaif_map,
- LPAIF_VA_IRQEN_REG(v, LPAIF_IRQ_PORT_HOST), 0x0);
- if (ret) {
- dev_err(&pdev->dev, "error writing to rxtx irqen reg: %d\n", ret);
- return ret;
- }
- drvdata->rxtxif_irq = platform_get_irq_byname(pdev, "lpass-irq-rxtxif");
- if (drvdata->rxtxif_irq < 0)
- return -ENODEV;
- ret = devm_request_irq(&pdev->dev, drvdata->rxtxif_irq,
- lpass_platform_rxtxif_irq, 0, "lpass-irq-rxtxif", drvdata);
- if (ret) {
- dev_err(&pdev->dev, "rxtx irq request failed: %d\n", ret);
- return ret;
- }
- ret = lpass_platform_alloc_rxtx_dmactl_fields(&pdev->dev,
- drvdata->rxtx_lpaif_map);
- if (ret) {
- dev_err(&pdev->dev,
- "error initializing rxtx dmactl fields: %d\n", ret);
- return ret;
- }
- drvdata->vaif_irq = platform_get_irq_byname(pdev, "lpass-irq-vaif");
- if (drvdata->vaif_irq < 0)
- return -ENODEV;
- ret = devm_request_irq(&pdev->dev, drvdata->vaif_irq,
- lpass_platform_vaif_irq, 0, "lpass-irq-vaif", drvdata);
- if (ret) {
- dev_err(&pdev->dev, "va irq request failed: %d\n", ret);
- return ret;
- }
- ret = lpass_platform_alloc_va_dmactl_fields(&pdev->dev,
- drvdata->va_lpaif_map);
- if (ret) {
- dev_err(&pdev->dev,
- "error initializing va dmactl fields: %d\n", ret);
- return ret;
- }
- }
- if (drvdata->hdmi_port_enable) {
- drvdata->hdmiif_irq = platform_get_irq_byname(pdev, "lpass-irq-hdmi");
- if (drvdata->hdmiif_irq < 0)
- return -ENODEV;
- ret = devm_request_irq(&pdev->dev, drvdata->hdmiif_irq,
- lpass_platform_hdmiif_irq, 0, "lpass-irq-hdmi", drvdata);
- if (ret) {
- dev_err(&pdev->dev, "irq hdmi request failed: %d\n", ret);
- return ret;
- }
- ret = regmap_write(drvdata->hdmiif_map,
- LPASS_HDMITX_APP_IRQEN_REG(v), 0);
- if (ret) {
- dev_err(&pdev->dev, "error writing to hdmi irqen reg: %d\n", ret);
- return ret;
- }
- ret = lpass_platform_alloc_hdmidmactl_fields(&pdev->dev,
- drvdata->hdmiif_map);
- if (ret) {
- dev_err(&pdev->dev,
- "error initializing hdmidmactl fields: %d\n", ret);
- return ret;
- }
- }
- return devm_snd_soc_register_component(&pdev->dev,
- &lpass_component_driver, NULL, 0);
- }
- EXPORT_SYMBOL_GPL(asoc_qcom_lpass_platform_register);
- MODULE_DESCRIPTION("QTi LPASS Platform Driver");
- MODULE_LICENSE("GPL");
|