162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0+ 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * AMD ALSA SoC Pink Sardine SoundWire DMA Driver 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright 2023 Advanced Micro Devices, Inc. 662306a36Sopenharmony_ci */ 762306a36Sopenharmony_ci 862306a36Sopenharmony_ci#include <linux/err.h> 962306a36Sopenharmony_ci#include <linux/io.h> 1062306a36Sopenharmony_ci#include <linux/module.h> 1162306a36Sopenharmony_ci#include <linux/platform_device.h> 1262306a36Sopenharmony_ci#include <sound/pcm_params.h> 1362306a36Sopenharmony_ci#include <sound/soc.h> 1462306a36Sopenharmony_ci#include <sound/soc-dai.h> 1562306a36Sopenharmony_ci#include <linux/pm_runtime.h> 1662306a36Sopenharmony_ci#include <linux/soundwire/sdw_amd.h> 1762306a36Sopenharmony_ci#include "acp63.h" 1862306a36Sopenharmony_ci 1962306a36Sopenharmony_ci#define DRV_NAME "amd_ps_sdw_dma" 2062306a36Sopenharmony_ci 2162306a36Sopenharmony_cistatic struct sdw_dma_ring_buf_reg sdw0_dma_ring_buf_reg[ACP63_SDW0_DMA_MAX_STREAMS] = { 2262306a36Sopenharmony_ci {ACP_AUDIO0_TX_DMA_SIZE, ACP_AUDIO0_TX_FIFOADDR, ACP_AUDIO0_TX_FIFOSIZE, 2362306a36Sopenharmony_ci ACP_AUDIO0_TX_RINGBUFSIZE, ACP_AUDIO0_TX_RINGBUFADDR, ACP_AUDIO0_TX_INTR_WATERMARK_SIZE, 2462306a36Sopenharmony_ci ACP_AUDIO0_TX_LINEARPOSITIONCNTR_LOW, ACP_AUDIO0_TX_LINEARPOSITIONCNTR_HIGH}, 2562306a36Sopenharmony_ci {ACP_AUDIO1_TX_DMA_SIZE, ACP_AUDIO1_TX_FIFOADDR, ACP_AUDIO1_TX_FIFOSIZE, 2662306a36Sopenharmony_ci ACP_AUDIO1_TX_RINGBUFSIZE, ACP_AUDIO1_TX_RINGBUFADDR, ACP_AUDIO1_TX_INTR_WATERMARK_SIZE, 2762306a36Sopenharmony_ci ACP_AUDIO1_TX_LINEARPOSITIONCNTR_LOW, ACP_AUDIO1_TX_LINEARPOSITIONCNTR_HIGH}, 2862306a36Sopenharmony_ci {ACP_AUDIO2_TX_DMA_SIZE, ACP_AUDIO2_TX_FIFOADDR, ACP_AUDIO2_TX_FIFOSIZE, 2962306a36Sopenharmony_ci ACP_AUDIO2_TX_RINGBUFSIZE, ACP_AUDIO2_TX_RINGBUFADDR, ACP_AUDIO2_TX_INTR_WATERMARK_SIZE, 3062306a36Sopenharmony_ci ACP_AUDIO2_TX_LINEARPOSITIONCNTR_LOW, ACP_AUDIO2_TX_LINEARPOSITIONCNTR_HIGH}, 3162306a36Sopenharmony_ci {ACP_AUDIO0_RX_DMA_SIZE, ACP_AUDIO0_RX_FIFOADDR, ACP_AUDIO0_RX_FIFOSIZE, 3262306a36Sopenharmony_ci ACP_AUDIO0_RX_RINGBUFSIZE, ACP_AUDIO0_RX_RINGBUFADDR, ACP_AUDIO0_RX_INTR_WATERMARK_SIZE, 3362306a36Sopenharmony_ci ACP_AUDIO0_RX_LINEARPOSITIONCNTR_LOW, ACP_AUDIO0_RX_LINEARPOSITIONCNTR_HIGH}, 3462306a36Sopenharmony_ci {ACP_AUDIO1_RX_DMA_SIZE, ACP_AUDIO1_RX_FIFOADDR, ACP_AUDIO1_RX_FIFOSIZE, 3562306a36Sopenharmony_ci ACP_AUDIO1_RX_RINGBUFSIZE, ACP_AUDIO1_RX_RINGBUFADDR, ACP_AUDIO1_RX_INTR_WATERMARK_SIZE, 3662306a36Sopenharmony_ci ACP_AUDIO1_RX_LINEARPOSITIONCNTR_LOW, ACP_AUDIO1_RX_LINEARPOSITIONCNTR_HIGH}, 3762306a36Sopenharmony_ci {ACP_AUDIO2_RX_DMA_SIZE, ACP_AUDIO2_RX_FIFOADDR, ACP_AUDIO2_RX_FIFOSIZE, 3862306a36Sopenharmony_ci ACP_AUDIO2_RX_RINGBUFSIZE, ACP_AUDIO2_RX_RINGBUFADDR, ACP_AUDIO2_RX_INTR_WATERMARK_SIZE, 3962306a36Sopenharmony_ci ACP_AUDIO2_RX_LINEARPOSITIONCNTR_LOW, ACP_AUDIO2_RX_LINEARPOSITIONCNTR_HIGH} 4062306a36Sopenharmony_ci}; 4162306a36Sopenharmony_ci 4262306a36Sopenharmony_ci/* 4362306a36Sopenharmony_ci * SDW1 instance supports one TX stream and one RX stream. 4462306a36Sopenharmony_ci * For TX/RX streams DMA registers programming for SDW1 instance, it uses ACP_P1_AUDIO1 register 4562306a36Sopenharmony_ci * set as per hardware register documentation 4662306a36Sopenharmony_ci */ 4762306a36Sopenharmony_cistatic struct sdw_dma_ring_buf_reg sdw1_dma_ring_buf_reg[ACP63_SDW1_DMA_MAX_STREAMS] = { 4862306a36Sopenharmony_ci {ACP_P1_AUDIO1_TX_DMA_SIZE, ACP_P1_AUDIO1_TX_FIFOADDR, ACP_P1_AUDIO1_TX_FIFOSIZE, 4962306a36Sopenharmony_ci ACP_P1_AUDIO1_TX_RINGBUFSIZE, ACP_P1_AUDIO1_TX_RINGBUFADDR, 5062306a36Sopenharmony_ci ACP_P1_AUDIO1_TX_INTR_WATERMARK_SIZE, 5162306a36Sopenharmony_ci ACP_P1_AUDIO1_TX_LINEARPOSITIONCNTR_LOW, ACP_P1_AUDIO1_TX_LINEARPOSITIONCNTR_HIGH}, 5262306a36Sopenharmony_ci {ACP_P1_AUDIO1_RX_DMA_SIZE, ACP_P1_AUDIO1_RX_FIFOADDR, ACP_P1_AUDIO1_RX_FIFOSIZE, 5362306a36Sopenharmony_ci ACP_P1_AUDIO1_RX_RINGBUFSIZE, ACP_P1_AUDIO1_RX_RINGBUFADDR, 5462306a36Sopenharmony_ci ACP_P1_AUDIO1_RX_INTR_WATERMARK_SIZE, 5562306a36Sopenharmony_ci ACP_P1_AUDIO1_RX_LINEARPOSITIONCNTR_LOW, ACP_P1_AUDIO1_RX_LINEARPOSITIONCNTR_HIGH}, 5662306a36Sopenharmony_ci}; 5762306a36Sopenharmony_ci 5862306a36Sopenharmony_cistatic u32 sdw0_dma_enable_reg[ACP63_SDW0_DMA_MAX_STREAMS] = { 5962306a36Sopenharmony_ci ACP_SW0_AUDIO0_TX_EN, 6062306a36Sopenharmony_ci ACP_SW0_AUDIO1_TX_EN, 6162306a36Sopenharmony_ci ACP_SW0_AUDIO2_TX_EN, 6262306a36Sopenharmony_ci ACP_SW0_AUDIO0_RX_EN, 6362306a36Sopenharmony_ci ACP_SW0_AUDIO1_RX_EN, 6462306a36Sopenharmony_ci ACP_SW0_AUDIO2_RX_EN, 6562306a36Sopenharmony_ci}; 6662306a36Sopenharmony_ci 6762306a36Sopenharmony_ci/* 6862306a36Sopenharmony_ci * SDW1 instance supports one TX stream and one RX stream. 6962306a36Sopenharmony_ci * For TX/RX streams DMA enable register programming for SDW1 instance, 7062306a36Sopenharmony_ci * it uses ACP_SW1_AUDIO1_TX_EN and ACP_SW1_AUDIO1_RX_EN registers 7162306a36Sopenharmony_ci * as per hardware register documentation. 7262306a36Sopenharmony_ci */ 7362306a36Sopenharmony_cistatic u32 sdw1_dma_enable_reg[ACP63_SDW1_DMA_MAX_STREAMS] = { 7462306a36Sopenharmony_ci ACP_SW1_AUDIO1_TX_EN, 7562306a36Sopenharmony_ci ACP_SW1_AUDIO1_RX_EN, 7662306a36Sopenharmony_ci}; 7762306a36Sopenharmony_ci 7862306a36Sopenharmony_cistatic const struct snd_pcm_hardware acp63_sdw_hardware_playback = { 7962306a36Sopenharmony_ci .info = SNDRV_PCM_INFO_INTERLEAVED | 8062306a36Sopenharmony_ci SNDRV_PCM_INFO_BLOCK_TRANSFER | 8162306a36Sopenharmony_ci SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_MMAP_VALID | 8262306a36Sopenharmony_ci SNDRV_PCM_INFO_PAUSE | SNDRV_PCM_INFO_RESUME, 8362306a36Sopenharmony_ci .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S8 | 8462306a36Sopenharmony_ci SNDRV_PCM_FMTBIT_U8 | SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE, 8562306a36Sopenharmony_ci .channels_min = 2, 8662306a36Sopenharmony_ci .channels_max = 2, 8762306a36Sopenharmony_ci .rates = SNDRV_PCM_RATE_48000, 8862306a36Sopenharmony_ci .rate_min = 48000, 8962306a36Sopenharmony_ci .rate_max = 48000, 9062306a36Sopenharmony_ci .buffer_bytes_max = SDW_PLAYBACK_MAX_NUM_PERIODS * SDW_PLAYBACK_MAX_PERIOD_SIZE, 9162306a36Sopenharmony_ci .period_bytes_min = SDW_PLAYBACK_MIN_PERIOD_SIZE, 9262306a36Sopenharmony_ci .period_bytes_max = SDW_PLAYBACK_MAX_PERIOD_SIZE, 9362306a36Sopenharmony_ci .periods_min = SDW_PLAYBACK_MIN_NUM_PERIODS, 9462306a36Sopenharmony_ci .periods_max = SDW_PLAYBACK_MAX_NUM_PERIODS, 9562306a36Sopenharmony_ci}; 9662306a36Sopenharmony_ci 9762306a36Sopenharmony_cistatic const struct snd_pcm_hardware acp63_sdw_hardware_capture = { 9862306a36Sopenharmony_ci .info = SNDRV_PCM_INFO_INTERLEAVED | 9962306a36Sopenharmony_ci SNDRV_PCM_INFO_BLOCK_TRANSFER | 10062306a36Sopenharmony_ci SNDRV_PCM_INFO_MMAP | 10162306a36Sopenharmony_ci SNDRV_PCM_INFO_MMAP_VALID | 10262306a36Sopenharmony_ci SNDRV_PCM_INFO_PAUSE | SNDRV_PCM_INFO_RESUME, 10362306a36Sopenharmony_ci .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S8 | 10462306a36Sopenharmony_ci SNDRV_PCM_FMTBIT_U8 | SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE, 10562306a36Sopenharmony_ci .channels_min = 2, 10662306a36Sopenharmony_ci .channels_max = 2, 10762306a36Sopenharmony_ci .rates = SNDRV_PCM_RATE_48000, 10862306a36Sopenharmony_ci .rate_min = 48000, 10962306a36Sopenharmony_ci .rate_max = 48000, 11062306a36Sopenharmony_ci .buffer_bytes_max = SDW_CAPTURE_MAX_NUM_PERIODS * SDW_CAPTURE_MAX_PERIOD_SIZE, 11162306a36Sopenharmony_ci .period_bytes_min = SDW_CAPTURE_MIN_PERIOD_SIZE, 11262306a36Sopenharmony_ci .period_bytes_max = SDW_CAPTURE_MAX_PERIOD_SIZE, 11362306a36Sopenharmony_ci .periods_min = SDW_CAPTURE_MIN_NUM_PERIODS, 11462306a36Sopenharmony_ci .periods_max = SDW_CAPTURE_MAX_NUM_PERIODS, 11562306a36Sopenharmony_ci}; 11662306a36Sopenharmony_ci 11762306a36Sopenharmony_cistatic void acp63_enable_disable_sdw_dma_interrupts(void __iomem *acp_base, bool enable) 11862306a36Sopenharmony_ci{ 11962306a36Sopenharmony_ci u32 ext_intr_cntl, ext_intr_cntl1; 12062306a36Sopenharmony_ci u32 irq_mask = ACP_SDW_DMA_IRQ_MASK; 12162306a36Sopenharmony_ci u32 irq_mask1 = ACP_P1_SDW_DMA_IRQ_MASK; 12262306a36Sopenharmony_ci 12362306a36Sopenharmony_ci if (enable) { 12462306a36Sopenharmony_ci ext_intr_cntl = readl(acp_base + ACP_EXTERNAL_INTR_CNTL); 12562306a36Sopenharmony_ci ext_intr_cntl |= irq_mask; 12662306a36Sopenharmony_ci writel(ext_intr_cntl, acp_base + ACP_EXTERNAL_INTR_CNTL); 12762306a36Sopenharmony_ci ext_intr_cntl1 = readl(acp_base + ACP_EXTERNAL_INTR_CNTL1); 12862306a36Sopenharmony_ci ext_intr_cntl1 |= irq_mask1; 12962306a36Sopenharmony_ci writel(ext_intr_cntl1, acp_base + ACP_EXTERNAL_INTR_CNTL1); 13062306a36Sopenharmony_ci } else { 13162306a36Sopenharmony_ci ext_intr_cntl = readl(acp_base + ACP_EXTERNAL_INTR_CNTL); 13262306a36Sopenharmony_ci ext_intr_cntl &= ~irq_mask; 13362306a36Sopenharmony_ci writel(ext_intr_cntl, acp_base + ACP_EXTERNAL_INTR_CNTL); 13462306a36Sopenharmony_ci ext_intr_cntl1 = readl(acp_base + ACP_EXTERNAL_INTR_CNTL1); 13562306a36Sopenharmony_ci ext_intr_cntl1 &= ~irq_mask1; 13662306a36Sopenharmony_ci writel(ext_intr_cntl1, acp_base + ACP_EXTERNAL_INTR_CNTL1); 13762306a36Sopenharmony_ci } 13862306a36Sopenharmony_ci} 13962306a36Sopenharmony_ci 14062306a36Sopenharmony_cistatic void acp63_config_dma(struct acp_sdw_dma_stream *stream, void __iomem *acp_base, 14162306a36Sopenharmony_ci u32 stream_id) 14262306a36Sopenharmony_ci{ 14362306a36Sopenharmony_ci u16 page_idx; 14462306a36Sopenharmony_ci u32 low, high, val; 14562306a36Sopenharmony_ci u32 sdw_dma_pte_offset; 14662306a36Sopenharmony_ci dma_addr_t addr; 14762306a36Sopenharmony_ci 14862306a36Sopenharmony_ci addr = stream->dma_addr; 14962306a36Sopenharmony_ci sdw_dma_pte_offset = SDW_PTE_OFFSET(stream->instance); 15062306a36Sopenharmony_ci val = sdw_dma_pte_offset + (stream_id * ACP_SDW_PTE_OFFSET); 15162306a36Sopenharmony_ci 15262306a36Sopenharmony_ci /* Group Enable */ 15362306a36Sopenharmony_ci writel(ACP_SDW_SRAM_PTE_OFFSET | BIT(31), acp_base + ACPAXI2AXI_ATU_BASE_ADDR_GRP_2); 15462306a36Sopenharmony_ci writel(PAGE_SIZE_4K_ENABLE, acp_base + ACPAXI2AXI_ATU_PAGE_SIZE_GRP_2); 15562306a36Sopenharmony_ci for (page_idx = 0; page_idx < stream->num_pages; page_idx++) { 15662306a36Sopenharmony_ci /* Load the low address of page int ACP SRAM through SRBM */ 15762306a36Sopenharmony_ci low = lower_32_bits(addr); 15862306a36Sopenharmony_ci high = upper_32_bits(addr); 15962306a36Sopenharmony_ci 16062306a36Sopenharmony_ci writel(low, acp_base + ACP_SCRATCH_REG_0 + val); 16162306a36Sopenharmony_ci high |= BIT(31); 16262306a36Sopenharmony_ci writel(high, acp_base + ACP_SCRATCH_REG_0 + val + 4); 16362306a36Sopenharmony_ci val += 8; 16462306a36Sopenharmony_ci addr += PAGE_SIZE; 16562306a36Sopenharmony_ci } 16662306a36Sopenharmony_ci writel(0x1, acp_base + ACPAXI2AXI_ATU_CTRL); 16762306a36Sopenharmony_ci} 16862306a36Sopenharmony_ci 16962306a36Sopenharmony_cistatic int acp63_configure_sdw_ringbuffer(void __iomem *acp_base, u32 stream_id, u32 size, 17062306a36Sopenharmony_ci u32 manager_instance) 17162306a36Sopenharmony_ci{ 17262306a36Sopenharmony_ci u32 reg_dma_size; 17362306a36Sopenharmony_ci u32 reg_fifo_addr; 17462306a36Sopenharmony_ci u32 reg_fifo_size; 17562306a36Sopenharmony_ci u32 reg_ring_buf_size; 17662306a36Sopenharmony_ci u32 reg_ring_buf_addr; 17762306a36Sopenharmony_ci u32 sdw_fifo_addr; 17862306a36Sopenharmony_ci u32 sdw_fifo_offset; 17962306a36Sopenharmony_ci u32 sdw_ring_buf_addr; 18062306a36Sopenharmony_ci u32 sdw_ring_buf_size; 18162306a36Sopenharmony_ci u32 sdw_mem_window_offset; 18262306a36Sopenharmony_ci 18362306a36Sopenharmony_ci switch (manager_instance) { 18462306a36Sopenharmony_ci case ACP_SDW0: 18562306a36Sopenharmony_ci reg_dma_size = sdw0_dma_ring_buf_reg[stream_id].reg_dma_size; 18662306a36Sopenharmony_ci reg_fifo_addr = sdw0_dma_ring_buf_reg[stream_id].reg_fifo_addr; 18762306a36Sopenharmony_ci reg_fifo_size = sdw0_dma_ring_buf_reg[stream_id].reg_fifo_size; 18862306a36Sopenharmony_ci reg_ring_buf_size = sdw0_dma_ring_buf_reg[stream_id].reg_ring_buf_size; 18962306a36Sopenharmony_ci reg_ring_buf_addr = sdw0_dma_ring_buf_reg[stream_id].reg_ring_buf_addr; 19062306a36Sopenharmony_ci break; 19162306a36Sopenharmony_ci case ACP_SDW1: 19262306a36Sopenharmony_ci reg_dma_size = sdw1_dma_ring_buf_reg[stream_id].reg_dma_size; 19362306a36Sopenharmony_ci reg_fifo_addr = sdw1_dma_ring_buf_reg[stream_id].reg_fifo_addr; 19462306a36Sopenharmony_ci reg_fifo_size = sdw1_dma_ring_buf_reg[stream_id].reg_fifo_size; 19562306a36Sopenharmony_ci reg_ring_buf_size = sdw1_dma_ring_buf_reg[stream_id].reg_ring_buf_size; 19662306a36Sopenharmony_ci reg_ring_buf_addr = sdw1_dma_ring_buf_reg[stream_id].reg_ring_buf_addr; 19762306a36Sopenharmony_ci break; 19862306a36Sopenharmony_ci default: 19962306a36Sopenharmony_ci return -EINVAL; 20062306a36Sopenharmony_ci } 20162306a36Sopenharmony_ci sdw_fifo_offset = ACP_SDW_FIFO_OFFSET(manager_instance); 20262306a36Sopenharmony_ci sdw_mem_window_offset = SDW_MEM_WINDOW_START(manager_instance); 20362306a36Sopenharmony_ci sdw_fifo_addr = sdw_fifo_offset + (stream_id * SDW_FIFO_OFFSET); 20462306a36Sopenharmony_ci sdw_ring_buf_addr = sdw_mem_window_offset + (stream_id * ACP_SDW_RING_BUFF_ADDR_OFFSET); 20562306a36Sopenharmony_ci sdw_ring_buf_size = size; 20662306a36Sopenharmony_ci writel(sdw_ring_buf_size, acp_base + reg_ring_buf_size); 20762306a36Sopenharmony_ci writel(sdw_ring_buf_addr, acp_base + reg_ring_buf_addr); 20862306a36Sopenharmony_ci writel(sdw_fifo_addr, acp_base + reg_fifo_addr); 20962306a36Sopenharmony_ci writel(SDW_DMA_SIZE, acp_base + reg_dma_size); 21062306a36Sopenharmony_ci writel(SDW_FIFO_SIZE, acp_base + reg_fifo_size); 21162306a36Sopenharmony_ci return 0; 21262306a36Sopenharmony_ci} 21362306a36Sopenharmony_ci 21462306a36Sopenharmony_cistatic int acp63_sdw_dma_open(struct snd_soc_component *component, 21562306a36Sopenharmony_ci struct snd_pcm_substream *substream) 21662306a36Sopenharmony_ci{ 21762306a36Sopenharmony_ci struct snd_pcm_runtime *runtime; 21862306a36Sopenharmony_ci struct acp_sdw_dma_stream *stream; 21962306a36Sopenharmony_ci struct snd_soc_dai *cpu_dai; 22062306a36Sopenharmony_ci struct amd_sdw_manager *amd_manager; 22162306a36Sopenharmony_ci struct snd_soc_pcm_runtime *prtd = substream->private_data; 22262306a36Sopenharmony_ci int ret; 22362306a36Sopenharmony_ci 22462306a36Sopenharmony_ci runtime = substream->runtime; 22562306a36Sopenharmony_ci cpu_dai = asoc_rtd_to_cpu(prtd, 0); 22662306a36Sopenharmony_ci amd_manager = snd_soc_dai_get_drvdata(cpu_dai); 22762306a36Sopenharmony_ci stream = kzalloc(sizeof(*stream), GFP_KERNEL); 22862306a36Sopenharmony_ci if (!stream) 22962306a36Sopenharmony_ci return -ENOMEM; 23062306a36Sopenharmony_ci 23162306a36Sopenharmony_ci if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 23262306a36Sopenharmony_ci runtime->hw = acp63_sdw_hardware_playback; 23362306a36Sopenharmony_ci else 23462306a36Sopenharmony_ci runtime->hw = acp63_sdw_hardware_capture; 23562306a36Sopenharmony_ci ret = snd_pcm_hw_constraint_integer(runtime, 23662306a36Sopenharmony_ci SNDRV_PCM_HW_PARAM_PERIODS); 23762306a36Sopenharmony_ci if (ret < 0) { 23862306a36Sopenharmony_ci dev_err(component->dev, "set integer constraint failed\n"); 23962306a36Sopenharmony_ci kfree(stream); 24062306a36Sopenharmony_ci return ret; 24162306a36Sopenharmony_ci } 24262306a36Sopenharmony_ci 24362306a36Sopenharmony_ci stream->stream_id = cpu_dai->id; 24462306a36Sopenharmony_ci stream->instance = amd_manager->instance; 24562306a36Sopenharmony_ci runtime->private_data = stream; 24662306a36Sopenharmony_ci return ret; 24762306a36Sopenharmony_ci} 24862306a36Sopenharmony_ci 24962306a36Sopenharmony_cistatic int acp63_sdw_dma_hw_params(struct snd_soc_component *component, 25062306a36Sopenharmony_ci struct snd_pcm_substream *substream, 25162306a36Sopenharmony_ci struct snd_pcm_hw_params *params) 25262306a36Sopenharmony_ci{ 25362306a36Sopenharmony_ci struct acp_sdw_dma_stream *stream; 25462306a36Sopenharmony_ci struct sdw_dma_dev_data *sdw_data; 25562306a36Sopenharmony_ci u32 period_bytes; 25662306a36Sopenharmony_ci u32 water_mark_size_reg; 25762306a36Sopenharmony_ci u32 irq_mask, ext_intr_ctrl; 25862306a36Sopenharmony_ci u64 size; 25962306a36Sopenharmony_ci u32 stream_id; 26062306a36Sopenharmony_ci u32 acp_ext_intr_cntl_reg; 26162306a36Sopenharmony_ci int ret; 26262306a36Sopenharmony_ci 26362306a36Sopenharmony_ci sdw_data = dev_get_drvdata(component->dev); 26462306a36Sopenharmony_ci stream = substream->runtime->private_data; 26562306a36Sopenharmony_ci if (!stream) 26662306a36Sopenharmony_ci return -EINVAL; 26762306a36Sopenharmony_ci stream_id = stream->stream_id; 26862306a36Sopenharmony_ci switch (stream->instance) { 26962306a36Sopenharmony_ci case ACP_SDW0: 27062306a36Sopenharmony_ci sdw_data->sdw0_dma_stream[stream_id] = substream; 27162306a36Sopenharmony_ci water_mark_size_reg = sdw0_dma_ring_buf_reg[stream_id].water_mark_size_reg; 27262306a36Sopenharmony_ci acp_ext_intr_cntl_reg = ACP_EXTERNAL_INTR_CNTL; 27362306a36Sopenharmony_ci if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 27462306a36Sopenharmony_ci irq_mask = BIT(SDW0_DMA_TX_IRQ_MASK(stream_id)); 27562306a36Sopenharmony_ci else 27662306a36Sopenharmony_ci irq_mask = BIT(SDW0_DMA_RX_IRQ_MASK(stream_id)); 27762306a36Sopenharmony_ci break; 27862306a36Sopenharmony_ci case ACP_SDW1: 27962306a36Sopenharmony_ci sdw_data->sdw1_dma_stream[stream_id] = substream; 28062306a36Sopenharmony_ci acp_ext_intr_cntl_reg = ACP_EXTERNAL_INTR_CNTL1; 28162306a36Sopenharmony_ci water_mark_size_reg = sdw1_dma_ring_buf_reg[stream_id].water_mark_size_reg; 28262306a36Sopenharmony_ci irq_mask = BIT(SDW1_DMA_IRQ_MASK(stream_id)); 28362306a36Sopenharmony_ci break; 28462306a36Sopenharmony_ci default: 28562306a36Sopenharmony_ci return -EINVAL; 28662306a36Sopenharmony_ci } 28762306a36Sopenharmony_ci size = params_buffer_bytes(params); 28862306a36Sopenharmony_ci period_bytes = params_period_bytes(params); 28962306a36Sopenharmony_ci stream->dma_addr = substream->runtime->dma_addr; 29062306a36Sopenharmony_ci stream->num_pages = (PAGE_ALIGN(size) >> PAGE_SHIFT); 29162306a36Sopenharmony_ci acp63_config_dma(stream, sdw_data->acp_base, stream_id); 29262306a36Sopenharmony_ci ret = acp63_configure_sdw_ringbuffer(sdw_data->acp_base, stream_id, size, 29362306a36Sopenharmony_ci stream->instance); 29462306a36Sopenharmony_ci if (ret) { 29562306a36Sopenharmony_ci dev_err(component->dev, "Invalid DMA channel\n"); 29662306a36Sopenharmony_ci return -EINVAL; 29762306a36Sopenharmony_ci } 29862306a36Sopenharmony_ci ext_intr_ctrl = readl(sdw_data->acp_base + acp_ext_intr_cntl_reg); 29962306a36Sopenharmony_ci ext_intr_ctrl |= irq_mask; 30062306a36Sopenharmony_ci writel(ext_intr_ctrl, sdw_data->acp_base + acp_ext_intr_cntl_reg); 30162306a36Sopenharmony_ci writel(period_bytes, sdw_data->acp_base + water_mark_size_reg); 30262306a36Sopenharmony_ci return 0; 30362306a36Sopenharmony_ci} 30462306a36Sopenharmony_ci 30562306a36Sopenharmony_cistatic u64 acp63_sdw_get_byte_count(struct acp_sdw_dma_stream *stream, void __iomem *acp_base) 30662306a36Sopenharmony_ci{ 30762306a36Sopenharmony_ci union acp_sdw_dma_count byte_count; 30862306a36Sopenharmony_ci u32 pos_low_reg, pos_high_reg; 30962306a36Sopenharmony_ci 31062306a36Sopenharmony_ci byte_count.bytescount = 0; 31162306a36Sopenharmony_ci switch (stream->instance) { 31262306a36Sopenharmony_ci case ACP_SDW0: 31362306a36Sopenharmony_ci pos_low_reg = sdw0_dma_ring_buf_reg[stream->stream_id].pos_low_reg; 31462306a36Sopenharmony_ci pos_high_reg = sdw0_dma_ring_buf_reg[stream->stream_id].pos_high_reg; 31562306a36Sopenharmony_ci break; 31662306a36Sopenharmony_ci case ACP_SDW1: 31762306a36Sopenharmony_ci pos_low_reg = sdw1_dma_ring_buf_reg[stream->stream_id].pos_low_reg; 31862306a36Sopenharmony_ci pos_high_reg = sdw1_dma_ring_buf_reg[stream->stream_id].pos_high_reg; 31962306a36Sopenharmony_ci break; 32062306a36Sopenharmony_ci default: 32162306a36Sopenharmony_ci goto POINTER_RETURN_BYTES; 32262306a36Sopenharmony_ci } 32362306a36Sopenharmony_ci if (pos_low_reg) { 32462306a36Sopenharmony_ci byte_count.bcount.high = readl(acp_base + pos_high_reg); 32562306a36Sopenharmony_ci byte_count.bcount.low = readl(acp_base + pos_low_reg); 32662306a36Sopenharmony_ci } 32762306a36Sopenharmony_ciPOINTER_RETURN_BYTES: 32862306a36Sopenharmony_ci return byte_count.bytescount; 32962306a36Sopenharmony_ci} 33062306a36Sopenharmony_ci 33162306a36Sopenharmony_cistatic snd_pcm_uframes_t acp63_sdw_dma_pointer(struct snd_soc_component *comp, 33262306a36Sopenharmony_ci struct snd_pcm_substream *substream) 33362306a36Sopenharmony_ci{ 33462306a36Sopenharmony_ci struct sdw_dma_dev_data *sdw_data; 33562306a36Sopenharmony_ci struct acp_sdw_dma_stream *stream; 33662306a36Sopenharmony_ci u32 pos, buffersize; 33762306a36Sopenharmony_ci u64 bytescount; 33862306a36Sopenharmony_ci 33962306a36Sopenharmony_ci sdw_data = dev_get_drvdata(comp->dev); 34062306a36Sopenharmony_ci stream = substream->runtime->private_data; 34162306a36Sopenharmony_ci buffersize = frames_to_bytes(substream->runtime, 34262306a36Sopenharmony_ci substream->runtime->buffer_size); 34362306a36Sopenharmony_ci bytescount = acp63_sdw_get_byte_count(stream, sdw_data->acp_base); 34462306a36Sopenharmony_ci if (bytescount > stream->bytescount) 34562306a36Sopenharmony_ci bytescount -= stream->bytescount; 34662306a36Sopenharmony_ci pos = do_div(bytescount, buffersize); 34762306a36Sopenharmony_ci return bytes_to_frames(substream->runtime, pos); 34862306a36Sopenharmony_ci} 34962306a36Sopenharmony_ci 35062306a36Sopenharmony_cistatic int acp63_sdw_dma_new(struct snd_soc_component *component, 35162306a36Sopenharmony_ci struct snd_soc_pcm_runtime *rtd) 35262306a36Sopenharmony_ci{ 35362306a36Sopenharmony_ci struct device *parent = component->dev->parent; 35462306a36Sopenharmony_ci 35562306a36Sopenharmony_ci snd_pcm_set_managed_buffer_all(rtd->pcm, SNDRV_DMA_TYPE_DEV, 35662306a36Sopenharmony_ci parent, SDW_MIN_BUFFER, SDW_MAX_BUFFER); 35762306a36Sopenharmony_ci return 0; 35862306a36Sopenharmony_ci} 35962306a36Sopenharmony_ci 36062306a36Sopenharmony_cistatic int acp63_sdw_dma_close(struct snd_soc_component *component, 36162306a36Sopenharmony_ci struct snd_pcm_substream *substream) 36262306a36Sopenharmony_ci{ 36362306a36Sopenharmony_ci struct sdw_dma_dev_data *sdw_data; 36462306a36Sopenharmony_ci struct acp_sdw_dma_stream *stream; 36562306a36Sopenharmony_ci 36662306a36Sopenharmony_ci sdw_data = dev_get_drvdata(component->dev); 36762306a36Sopenharmony_ci stream = substream->runtime->private_data; 36862306a36Sopenharmony_ci if (!stream) 36962306a36Sopenharmony_ci return -EINVAL; 37062306a36Sopenharmony_ci switch (stream->instance) { 37162306a36Sopenharmony_ci case ACP_SDW0: 37262306a36Sopenharmony_ci sdw_data->sdw0_dma_stream[stream->stream_id] = NULL; 37362306a36Sopenharmony_ci break; 37462306a36Sopenharmony_ci case ACP_SDW1: 37562306a36Sopenharmony_ci sdw_data->sdw1_dma_stream[stream->stream_id] = NULL; 37662306a36Sopenharmony_ci break; 37762306a36Sopenharmony_ci default: 37862306a36Sopenharmony_ci return -EINVAL; 37962306a36Sopenharmony_ci } 38062306a36Sopenharmony_ci kfree(stream); 38162306a36Sopenharmony_ci return 0; 38262306a36Sopenharmony_ci} 38362306a36Sopenharmony_ci 38462306a36Sopenharmony_cistatic int acp63_sdw_dma_enable(struct snd_pcm_substream *substream, 38562306a36Sopenharmony_ci void __iomem *acp_base, bool sdw_dma_enable) 38662306a36Sopenharmony_ci{ 38762306a36Sopenharmony_ci struct acp_sdw_dma_stream *stream; 38862306a36Sopenharmony_ci u32 stream_id; 38962306a36Sopenharmony_ci u32 sdw_dma_en_reg; 39062306a36Sopenharmony_ci u32 sdw_dma_en_stat_reg; 39162306a36Sopenharmony_ci u32 sdw_dma_stat; 39262306a36Sopenharmony_ci u32 dma_enable; 39362306a36Sopenharmony_ci 39462306a36Sopenharmony_ci stream = substream->runtime->private_data; 39562306a36Sopenharmony_ci stream_id = stream->stream_id; 39662306a36Sopenharmony_ci switch (stream->instance) { 39762306a36Sopenharmony_ci case ACP_SDW0: 39862306a36Sopenharmony_ci sdw_dma_en_reg = sdw0_dma_enable_reg[stream_id]; 39962306a36Sopenharmony_ci break; 40062306a36Sopenharmony_ci case ACP_SDW1: 40162306a36Sopenharmony_ci sdw_dma_en_reg = sdw1_dma_enable_reg[stream_id]; 40262306a36Sopenharmony_ci break; 40362306a36Sopenharmony_ci default: 40462306a36Sopenharmony_ci return -EINVAL; 40562306a36Sopenharmony_ci } 40662306a36Sopenharmony_ci sdw_dma_en_stat_reg = sdw_dma_en_reg + 4; 40762306a36Sopenharmony_ci dma_enable = sdw_dma_enable; 40862306a36Sopenharmony_ci writel(dma_enable, acp_base + sdw_dma_en_reg); 40962306a36Sopenharmony_ci return readl_poll_timeout(acp_base + sdw_dma_en_stat_reg, sdw_dma_stat, 41062306a36Sopenharmony_ci (sdw_dma_stat == dma_enable), ACP_DELAY_US, ACP_COUNTER); 41162306a36Sopenharmony_ci} 41262306a36Sopenharmony_ci 41362306a36Sopenharmony_cistatic int acp63_sdw_dma_trigger(struct snd_soc_component *comp, 41462306a36Sopenharmony_ci struct snd_pcm_substream *substream, 41562306a36Sopenharmony_ci int cmd) 41662306a36Sopenharmony_ci{ 41762306a36Sopenharmony_ci struct sdw_dma_dev_data *sdw_data; 41862306a36Sopenharmony_ci int ret; 41962306a36Sopenharmony_ci 42062306a36Sopenharmony_ci sdw_data = dev_get_drvdata(comp->dev); 42162306a36Sopenharmony_ci switch (cmd) { 42262306a36Sopenharmony_ci case SNDRV_PCM_TRIGGER_START: 42362306a36Sopenharmony_ci case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 42462306a36Sopenharmony_ci case SNDRV_PCM_TRIGGER_RESUME: 42562306a36Sopenharmony_ci ret = acp63_sdw_dma_enable(substream, sdw_data->acp_base, true); 42662306a36Sopenharmony_ci break; 42762306a36Sopenharmony_ci case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 42862306a36Sopenharmony_ci case SNDRV_PCM_TRIGGER_SUSPEND: 42962306a36Sopenharmony_ci case SNDRV_PCM_TRIGGER_STOP: 43062306a36Sopenharmony_ci ret = acp63_sdw_dma_enable(substream, sdw_data->acp_base, false); 43162306a36Sopenharmony_ci break; 43262306a36Sopenharmony_ci default: 43362306a36Sopenharmony_ci ret = -EINVAL; 43462306a36Sopenharmony_ci } 43562306a36Sopenharmony_ci if (ret) 43662306a36Sopenharmony_ci dev_err(comp->dev, "trigger %d failed: %d", cmd, ret); 43762306a36Sopenharmony_ci return ret; 43862306a36Sopenharmony_ci} 43962306a36Sopenharmony_ci 44062306a36Sopenharmony_cistatic const struct snd_soc_component_driver acp63_sdw_component = { 44162306a36Sopenharmony_ci .name = DRV_NAME, 44262306a36Sopenharmony_ci .open = acp63_sdw_dma_open, 44362306a36Sopenharmony_ci .close = acp63_sdw_dma_close, 44462306a36Sopenharmony_ci .hw_params = acp63_sdw_dma_hw_params, 44562306a36Sopenharmony_ci .trigger = acp63_sdw_dma_trigger, 44662306a36Sopenharmony_ci .pointer = acp63_sdw_dma_pointer, 44762306a36Sopenharmony_ci .pcm_construct = acp63_sdw_dma_new, 44862306a36Sopenharmony_ci}; 44962306a36Sopenharmony_ci 45062306a36Sopenharmony_cistatic int acp63_sdw_platform_probe(struct platform_device *pdev) 45162306a36Sopenharmony_ci{ 45262306a36Sopenharmony_ci struct resource *res; 45362306a36Sopenharmony_ci struct sdw_dma_dev_data *sdw_data; 45462306a36Sopenharmony_ci struct acp63_dev_data *acp_data; 45562306a36Sopenharmony_ci struct device *parent; 45662306a36Sopenharmony_ci int status; 45762306a36Sopenharmony_ci 45862306a36Sopenharmony_ci parent = pdev->dev.parent; 45962306a36Sopenharmony_ci acp_data = dev_get_drvdata(parent); 46062306a36Sopenharmony_ci res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 46162306a36Sopenharmony_ci if (!res) { 46262306a36Sopenharmony_ci dev_err(&pdev->dev, "IORESOURCE_MEM FAILED\n"); 46362306a36Sopenharmony_ci return -ENODEV; 46462306a36Sopenharmony_ci } 46562306a36Sopenharmony_ci 46662306a36Sopenharmony_ci sdw_data = devm_kzalloc(&pdev->dev, sizeof(*sdw_data), GFP_KERNEL); 46762306a36Sopenharmony_ci if (!sdw_data) 46862306a36Sopenharmony_ci return -ENOMEM; 46962306a36Sopenharmony_ci 47062306a36Sopenharmony_ci sdw_data->acp_base = devm_ioremap(&pdev->dev, res->start, resource_size(res)); 47162306a36Sopenharmony_ci if (!sdw_data->acp_base) 47262306a36Sopenharmony_ci return -ENOMEM; 47362306a36Sopenharmony_ci 47462306a36Sopenharmony_ci sdw_data->acp_lock = &acp_data->acp_lock; 47562306a36Sopenharmony_ci dev_set_drvdata(&pdev->dev, sdw_data); 47662306a36Sopenharmony_ci status = devm_snd_soc_register_component(&pdev->dev, 47762306a36Sopenharmony_ci &acp63_sdw_component, 47862306a36Sopenharmony_ci NULL, 0); 47962306a36Sopenharmony_ci if (status) { 48062306a36Sopenharmony_ci dev_err(&pdev->dev, "Fail to register sdw dma component\n"); 48162306a36Sopenharmony_ci return status; 48262306a36Sopenharmony_ci } 48362306a36Sopenharmony_ci pm_runtime_set_autosuspend_delay(&pdev->dev, ACP_SUSPEND_DELAY_MS); 48462306a36Sopenharmony_ci pm_runtime_use_autosuspend(&pdev->dev); 48562306a36Sopenharmony_ci pm_runtime_mark_last_busy(&pdev->dev); 48662306a36Sopenharmony_ci pm_runtime_set_active(&pdev->dev); 48762306a36Sopenharmony_ci pm_runtime_enable(&pdev->dev); 48862306a36Sopenharmony_ci return 0; 48962306a36Sopenharmony_ci} 49062306a36Sopenharmony_ci 49162306a36Sopenharmony_cistatic void acp63_sdw_platform_remove(struct platform_device *pdev) 49262306a36Sopenharmony_ci{ 49362306a36Sopenharmony_ci pm_runtime_disable(&pdev->dev); 49462306a36Sopenharmony_ci} 49562306a36Sopenharmony_ci 49662306a36Sopenharmony_cistatic int acp_restore_sdw_dma_config(struct sdw_dma_dev_data *sdw_data) 49762306a36Sopenharmony_ci{ 49862306a36Sopenharmony_ci struct acp_sdw_dma_stream *stream; 49962306a36Sopenharmony_ci struct snd_pcm_substream *substream; 50062306a36Sopenharmony_ci struct snd_pcm_runtime *runtime; 50162306a36Sopenharmony_ci u32 period_bytes, buf_size, water_mark_size_reg; 50262306a36Sopenharmony_ci u32 stream_count; 50362306a36Sopenharmony_ci int index, instance, ret; 50462306a36Sopenharmony_ci 50562306a36Sopenharmony_ci for (instance = 0; instance < AMD_SDW_MAX_MANAGERS; instance++) { 50662306a36Sopenharmony_ci if (instance == ACP_SDW0) 50762306a36Sopenharmony_ci stream_count = ACP63_SDW0_DMA_MAX_STREAMS; 50862306a36Sopenharmony_ci else 50962306a36Sopenharmony_ci stream_count = ACP63_SDW1_DMA_MAX_STREAMS; 51062306a36Sopenharmony_ci 51162306a36Sopenharmony_ci for (index = 0; index < stream_count; index++) { 51262306a36Sopenharmony_ci if (instance == ACP_SDW0) { 51362306a36Sopenharmony_ci substream = sdw_data->sdw0_dma_stream[index]; 51462306a36Sopenharmony_ci water_mark_size_reg = 51562306a36Sopenharmony_ci sdw0_dma_ring_buf_reg[index].water_mark_size_reg; 51662306a36Sopenharmony_ci } else { 51762306a36Sopenharmony_ci substream = sdw_data->sdw1_dma_stream[index]; 51862306a36Sopenharmony_ci water_mark_size_reg = 51962306a36Sopenharmony_ci sdw1_dma_ring_buf_reg[index].water_mark_size_reg; 52062306a36Sopenharmony_ci } 52162306a36Sopenharmony_ci 52262306a36Sopenharmony_ci if (substream && substream->runtime) { 52362306a36Sopenharmony_ci runtime = substream->runtime; 52462306a36Sopenharmony_ci stream = runtime->private_data; 52562306a36Sopenharmony_ci period_bytes = frames_to_bytes(runtime, runtime->period_size); 52662306a36Sopenharmony_ci buf_size = frames_to_bytes(runtime, runtime->buffer_size); 52762306a36Sopenharmony_ci acp63_config_dma(stream, sdw_data->acp_base, index); 52862306a36Sopenharmony_ci ret = acp63_configure_sdw_ringbuffer(sdw_data->acp_base, index, 52962306a36Sopenharmony_ci buf_size, instance); 53062306a36Sopenharmony_ci if (ret) 53162306a36Sopenharmony_ci return ret; 53262306a36Sopenharmony_ci writel(period_bytes, sdw_data->acp_base + water_mark_size_reg); 53362306a36Sopenharmony_ci } 53462306a36Sopenharmony_ci } 53562306a36Sopenharmony_ci } 53662306a36Sopenharmony_ci acp63_enable_disable_sdw_dma_interrupts(sdw_data->acp_base, true); 53762306a36Sopenharmony_ci return 0; 53862306a36Sopenharmony_ci} 53962306a36Sopenharmony_ci 54062306a36Sopenharmony_cistatic int __maybe_unused acp63_sdw_pcm_resume(struct device *dev) 54162306a36Sopenharmony_ci{ 54262306a36Sopenharmony_ci struct sdw_dma_dev_data *sdw_data; 54362306a36Sopenharmony_ci 54462306a36Sopenharmony_ci sdw_data = dev_get_drvdata(dev); 54562306a36Sopenharmony_ci return acp_restore_sdw_dma_config(sdw_data); 54662306a36Sopenharmony_ci} 54762306a36Sopenharmony_ci 54862306a36Sopenharmony_cistatic const struct dev_pm_ops acp63_pm_ops = { 54962306a36Sopenharmony_ci SET_SYSTEM_SLEEP_PM_OPS(NULL, acp63_sdw_pcm_resume) 55062306a36Sopenharmony_ci}; 55162306a36Sopenharmony_ci 55262306a36Sopenharmony_cistatic struct platform_driver acp63_sdw_dma_driver = { 55362306a36Sopenharmony_ci .probe = acp63_sdw_platform_probe, 55462306a36Sopenharmony_ci .remove_new = acp63_sdw_platform_remove, 55562306a36Sopenharmony_ci .driver = { 55662306a36Sopenharmony_ci .name = "amd_ps_sdw_dma", 55762306a36Sopenharmony_ci .pm = &acp63_pm_ops, 55862306a36Sopenharmony_ci }, 55962306a36Sopenharmony_ci}; 56062306a36Sopenharmony_ci 56162306a36Sopenharmony_cimodule_platform_driver(acp63_sdw_dma_driver); 56262306a36Sopenharmony_ci 56362306a36Sopenharmony_ciMODULE_AUTHOR("Vijendar.Mukunda@amd.com"); 56462306a36Sopenharmony_ciMODULE_DESCRIPTION("AMD ACP6.3 PS SDW DMA Driver"); 56562306a36Sopenharmony_ciMODULE_LICENSE("GPL"); 56662306a36Sopenharmony_ciMODULE_ALIAS("platform:" DRV_NAME); 567