12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385 |
- // 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 <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);
- 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);
- 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);
- 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);
- 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 = asoc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(soc_runtime, 0);
- struct lpass_data *drvdata = snd_soc_component_get_drvdata(component);
- 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 = asoc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(soc_runtime, 0);
- struct lpass_data *drvdata = snd_soc_component_get_drvdata(component);
- 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 = asoc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = asoc_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 = asoc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = asoc_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;
- 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 = asoc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = asoc_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 = asoc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = asoc_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;
- 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 = asoc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = asoc_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;
- 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 = asoc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = asoc_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;
- 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 = asoc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = asoc_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;
- 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 = asoc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = asoc_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;
- 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 = asoc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = asoc_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 = asoc_substream_to_rtd(substream);
- struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(soc_runtime, 0);
- 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;
- 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;
- 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;
- 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;
- 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 = asoc_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_DEV,
- 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, void __user *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_user_toio(dma_buf, buf, bytes);
- } else {
- if (copy_from_user((void __force *)dma_buf, buf, bytes))
- ret = -EFAULT;
- }
- } else if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) {
- if (is_cdc_dma_port(dai_id)) {
- ret = copy_to_user_fromio(buf, dma_buf, bytes);
- } else {
- if (copy_to_user(buf, (void __force *)dma_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_user = lpass_platform_copy,
- };
- int asoc_qcom_lpass_platform_register(struct platform_device *pdev)
- {
- struct lpass_data *drvdata = platform_get_drvdata(pdev);
- 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 v2");
|