18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 28c2ecf20Sopenharmony_ci// 38c2ecf20Sopenharmony_ci// Copyright (C) 2020 Intel Corporation. 48c2ecf20Sopenharmony_ci// 58c2ecf20Sopenharmony_ci// Intel KeemBay Platform driver. 68c2ecf20Sopenharmony_ci// 78c2ecf20Sopenharmony_ci 88c2ecf20Sopenharmony_ci#include <linux/clk.h> 98c2ecf20Sopenharmony_ci#include <linux/io.h> 108c2ecf20Sopenharmony_ci#include <linux/module.h> 118c2ecf20Sopenharmony_ci#include <linux/of.h> 128c2ecf20Sopenharmony_ci#include <linux/of_device.h> 138c2ecf20Sopenharmony_ci#include <sound/pcm.h> 148c2ecf20Sopenharmony_ci#include <sound/pcm_params.h> 158c2ecf20Sopenharmony_ci#include <sound/soc.h> 168c2ecf20Sopenharmony_ci#include "kmb_platform.h" 178c2ecf20Sopenharmony_ci 188c2ecf20Sopenharmony_ci#define PERIODS_MIN 2 198c2ecf20Sopenharmony_ci#define PERIODS_MAX 48 208c2ecf20Sopenharmony_ci#define PERIOD_BYTES_MIN 4096 218c2ecf20Sopenharmony_ci#define BUFFER_BYTES_MAX (PERIODS_MAX * PERIOD_BYTES_MIN) 228c2ecf20Sopenharmony_ci#define TDM_OPERATION 5 238c2ecf20Sopenharmony_ci#define I2S_OPERATION 0 248c2ecf20Sopenharmony_ci#define DATA_WIDTH_CONFIG_BIT 6 258c2ecf20Sopenharmony_ci#define TDM_CHANNEL_CONFIG_BIT 3 268c2ecf20Sopenharmony_ci 278c2ecf20Sopenharmony_cistatic const struct snd_pcm_hardware kmb_pcm_hardware = { 288c2ecf20Sopenharmony_ci .info = SNDRV_PCM_INFO_INTERLEAVED | 298c2ecf20Sopenharmony_ci SNDRV_PCM_INFO_MMAP | 308c2ecf20Sopenharmony_ci SNDRV_PCM_INFO_MMAP_VALID | 318c2ecf20Sopenharmony_ci SNDRV_PCM_INFO_BATCH | 328c2ecf20Sopenharmony_ci SNDRV_PCM_INFO_BLOCK_TRANSFER, 338c2ecf20Sopenharmony_ci .rates = SNDRV_PCM_RATE_8000 | 348c2ecf20Sopenharmony_ci SNDRV_PCM_RATE_16000 | 358c2ecf20Sopenharmony_ci SNDRV_PCM_RATE_48000, 368c2ecf20Sopenharmony_ci .rate_min = 8000, 378c2ecf20Sopenharmony_ci .rate_max = 48000, 388c2ecf20Sopenharmony_ci .formats = SNDRV_PCM_FMTBIT_S16_LE | 398c2ecf20Sopenharmony_ci SNDRV_PCM_FMTBIT_S24_LE | 408c2ecf20Sopenharmony_ci SNDRV_PCM_FMTBIT_S32_LE, 418c2ecf20Sopenharmony_ci .channels_min = 2, 428c2ecf20Sopenharmony_ci .channels_max = 2, 438c2ecf20Sopenharmony_ci .buffer_bytes_max = BUFFER_BYTES_MAX, 448c2ecf20Sopenharmony_ci .period_bytes_min = PERIOD_BYTES_MIN, 458c2ecf20Sopenharmony_ci .period_bytes_max = BUFFER_BYTES_MAX / PERIODS_MIN, 468c2ecf20Sopenharmony_ci .periods_min = PERIODS_MIN, 478c2ecf20Sopenharmony_ci .periods_max = PERIODS_MAX, 488c2ecf20Sopenharmony_ci .fifo_size = 16, 498c2ecf20Sopenharmony_ci}; 508c2ecf20Sopenharmony_ci 518c2ecf20Sopenharmony_cistatic unsigned int kmb_pcm_tx_fn(struct kmb_i2s_info *kmb_i2s, 528c2ecf20Sopenharmony_ci struct snd_pcm_runtime *runtime, 538c2ecf20Sopenharmony_ci unsigned int tx_ptr, bool *period_elapsed) 548c2ecf20Sopenharmony_ci{ 558c2ecf20Sopenharmony_ci unsigned int period_pos = tx_ptr % runtime->period_size; 568c2ecf20Sopenharmony_ci void __iomem *i2s_base = kmb_i2s->i2s_base; 578c2ecf20Sopenharmony_ci void *buf = runtime->dma_area; 588c2ecf20Sopenharmony_ci int i; 598c2ecf20Sopenharmony_ci 608c2ecf20Sopenharmony_ci /* KMB i2s uses two separate L/R FIFO */ 618c2ecf20Sopenharmony_ci for (i = 0; i < kmb_i2s->fifo_th; i++) { 628c2ecf20Sopenharmony_ci if (kmb_i2s->config.data_width == 16) { 638c2ecf20Sopenharmony_ci writel(((u16(*)[2])buf)[tx_ptr][0], i2s_base + LRBR_LTHR(0)); 648c2ecf20Sopenharmony_ci writel(((u16(*)[2])buf)[tx_ptr][1], i2s_base + RRBR_RTHR(0)); 658c2ecf20Sopenharmony_ci } else { 668c2ecf20Sopenharmony_ci writel(((u32(*)[2])buf)[tx_ptr][0], i2s_base + LRBR_LTHR(0)); 678c2ecf20Sopenharmony_ci writel(((u32(*)[2])buf)[tx_ptr][1], i2s_base + RRBR_RTHR(0)); 688c2ecf20Sopenharmony_ci } 698c2ecf20Sopenharmony_ci 708c2ecf20Sopenharmony_ci period_pos++; 718c2ecf20Sopenharmony_ci 728c2ecf20Sopenharmony_ci if (++tx_ptr >= runtime->buffer_size) 738c2ecf20Sopenharmony_ci tx_ptr = 0; 748c2ecf20Sopenharmony_ci } 758c2ecf20Sopenharmony_ci 768c2ecf20Sopenharmony_ci *period_elapsed = period_pos >= runtime->period_size; 778c2ecf20Sopenharmony_ci 788c2ecf20Sopenharmony_ci return tx_ptr; 798c2ecf20Sopenharmony_ci} 808c2ecf20Sopenharmony_ci 818c2ecf20Sopenharmony_cistatic unsigned int kmb_pcm_rx_fn(struct kmb_i2s_info *kmb_i2s, 828c2ecf20Sopenharmony_ci struct snd_pcm_runtime *runtime, 838c2ecf20Sopenharmony_ci unsigned int rx_ptr, bool *period_elapsed) 848c2ecf20Sopenharmony_ci{ 858c2ecf20Sopenharmony_ci unsigned int period_pos = rx_ptr % runtime->period_size; 868c2ecf20Sopenharmony_ci void __iomem *i2s_base = kmb_i2s->i2s_base; 878c2ecf20Sopenharmony_ci int chan = kmb_i2s->config.chan_nr; 888c2ecf20Sopenharmony_ci void *buf = runtime->dma_area; 898c2ecf20Sopenharmony_ci int i, j; 908c2ecf20Sopenharmony_ci 918c2ecf20Sopenharmony_ci /* KMB i2s uses two separate L/R FIFO */ 928c2ecf20Sopenharmony_ci for (i = 0; i < kmb_i2s->fifo_th; i++) { 938c2ecf20Sopenharmony_ci for (j = 0; j < chan / 2; j++) { 948c2ecf20Sopenharmony_ci if (kmb_i2s->config.data_width == 16) { 958c2ecf20Sopenharmony_ci ((u16 *)buf)[rx_ptr * chan + (j * 2)] = 968c2ecf20Sopenharmony_ci readl(i2s_base + LRBR_LTHR(j)); 978c2ecf20Sopenharmony_ci ((u16 *)buf)[rx_ptr * chan + ((j * 2) + 1)] = 988c2ecf20Sopenharmony_ci readl(i2s_base + RRBR_RTHR(j)); 998c2ecf20Sopenharmony_ci } else { 1008c2ecf20Sopenharmony_ci ((u32 *)buf)[rx_ptr * chan + (j * 2)] = 1018c2ecf20Sopenharmony_ci readl(i2s_base + LRBR_LTHR(j)); 1028c2ecf20Sopenharmony_ci ((u32 *)buf)[rx_ptr * chan + ((j * 2) + 1)] = 1038c2ecf20Sopenharmony_ci readl(i2s_base + RRBR_RTHR(j)); 1048c2ecf20Sopenharmony_ci } 1058c2ecf20Sopenharmony_ci } 1068c2ecf20Sopenharmony_ci period_pos++; 1078c2ecf20Sopenharmony_ci 1088c2ecf20Sopenharmony_ci if (++rx_ptr >= runtime->buffer_size) 1098c2ecf20Sopenharmony_ci rx_ptr = 0; 1108c2ecf20Sopenharmony_ci } 1118c2ecf20Sopenharmony_ci 1128c2ecf20Sopenharmony_ci *period_elapsed = period_pos >= runtime->period_size; 1138c2ecf20Sopenharmony_ci 1148c2ecf20Sopenharmony_ci return rx_ptr; 1158c2ecf20Sopenharmony_ci} 1168c2ecf20Sopenharmony_ci 1178c2ecf20Sopenharmony_cistatic inline void kmb_i2s_disable_channels(struct kmb_i2s_info *kmb_i2s, 1188c2ecf20Sopenharmony_ci u32 stream) 1198c2ecf20Sopenharmony_ci{ 1208c2ecf20Sopenharmony_ci u32 i; 1218c2ecf20Sopenharmony_ci 1228c2ecf20Sopenharmony_ci /* Disable all channels regardless of configuration*/ 1238c2ecf20Sopenharmony_ci if (stream == SNDRV_PCM_STREAM_PLAYBACK) { 1248c2ecf20Sopenharmony_ci for (i = 0; i < MAX_ISR; i++) 1258c2ecf20Sopenharmony_ci writel(0, kmb_i2s->i2s_base + TER(i)); 1268c2ecf20Sopenharmony_ci } else { 1278c2ecf20Sopenharmony_ci for (i = 0; i < MAX_ISR; i++) 1288c2ecf20Sopenharmony_ci writel(0, kmb_i2s->i2s_base + RER(i)); 1298c2ecf20Sopenharmony_ci } 1308c2ecf20Sopenharmony_ci} 1318c2ecf20Sopenharmony_ci 1328c2ecf20Sopenharmony_cistatic inline void kmb_i2s_clear_irqs(struct kmb_i2s_info *kmb_i2s, u32 stream) 1338c2ecf20Sopenharmony_ci{ 1348c2ecf20Sopenharmony_ci struct i2s_clk_config_data *config = &kmb_i2s->config; 1358c2ecf20Sopenharmony_ci u32 i; 1368c2ecf20Sopenharmony_ci 1378c2ecf20Sopenharmony_ci if (stream == SNDRV_PCM_STREAM_PLAYBACK) { 1388c2ecf20Sopenharmony_ci for (i = 0; i < config->chan_nr / 2; i++) 1398c2ecf20Sopenharmony_ci readl(kmb_i2s->i2s_base + TOR(i)); 1408c2ecf20Sopenharmony_ci } else { 1418c2ecf20Sopenharmony_ci for (i = 0; i < config->chan_nr / 2; i++) 1428c2ecf20Sopenharmony_ci readl(kmb_i2s->i2s_base + ROR(i)); 1438c2ecf20Sopenharmony_ci } 1448c2ecf20Sopenharmony_ci} 1458c2ecf20Sopenharmony_ci 1468c2ecf20Sopenharmony_cistatic inline void kmb_i2s_irq_trigger(struct kmb_i2s_info *kmb_i2s, 1478c2ecf20Sopenharmony_ci u32 stream, int chan_nr, bool trigger) 1488c2ecf20Sopenharmony_ci{ 1498c2ecf20Sopenharmony_ci u32 i, irq; 1508c2ecf20Sopenharmony_ci u32 flag; 1518c2ecf20Sopenharmony_ci 1528c2ecf20Sopenharmony_ci if (stream == SNDRV_PCM_STREAM_PLAYBACK) 1538c2ecf20Sopenharmony_ci flag = TX_INT_FLAG; 1548c2ecf20Sopenharmony_ci else 1558c2ecf20Sopenharmony_ci flag = RX_INT_FLAG; 1568c2ecf20Sopenharmony_ci 1578c2ecf20Sopenharmony_ci for (i = 0; i < chan_nr / 2; i++) { 1588c2ecf20Sopenharmony_ci irq = readl(kmb_i2s->i2s_base + IMR(i)); 1598c2ecf20Sopenharmony_ci 1608c2ecf20Sopenharmony_ci if (trigger) 1618c2ecf20Sopenharmony_ci irq = irq & ~flag; 1628c2ecf20Sopenharmony_ci else 1638c2ecf20Sopenharmony_ci irq = irq | flag; 1648c2ecf20Sopenharmony_ci 1658c2ecf20Sopenharmony_ci writel(irq, kmb_i2s->i2s_base + IMR(i)); 1668c2ecf20Sopenharmony_ci } 1678c2ecf20Sopenharmony_ci} 1688c2ecf20Sopenharmony_ci 1698c2ecf20Sopenharmony_cistatic void kmb_pcm_operation(struct kmb_i2s_info *kmb_i2s, bool playback) 1708c2ecf20Sopenharmony_ci{ 1718c2ecf20Sopenharmony_ci struct snd_pcm_substream *substream; 1728c2ecf20Sopenharmony_ci bool period_elapsed; 1738c2ecf20Sopenharmony_ci unsigned int new_ptr; 1748c2ecf20Sopenharmony_ci unsigned int ptr; 1758c2ecf20Sopenharmony_ci 1768c2ecf20Sopenharmony_ci if (playback) 1778c2ecf20Sopenharmony_ci substream = kmb_i2s->tx_substream; 1788c2ecf20Sopenharmony_ci else 1798c2ecf20Sopenharmony_ci substream = kmb_i2s->rx_substream; 1808c2ecf20Sopenharmony_ci 1818c2ecf20Sopenharmony_ci if (!substream || !snd_pcm_running(substream)) 1828c2ecf20Sopenharmony_ci return; 1838c2ecf20Sopenharmony_ci 1848c2ecf20Sopenharmony_ci if (playback) { 1858c2ecf20Sopenharmony_ci ptr = kmb_i2s->tx_ptr; 1868c2ecf20Sopenharmony_ci new_ptr = kmb_pcm_tx_fn(kmb_i2s, substream->runtime, 1878c2ecf20Sopenharmony_ci ptr, &period_elapsed); 1888c2ecf20Sopenharmony_ci cmpxchg(&kmb_i2s->tx_ptr, ptr, new_ptr); 1898c2ecf20Sopenharmony_ci } else { 1908c2ecf20Sopenharmony_ci ptr = kmb_i2s->rx_ptr; 1918c2ecf20Sopenharmony_ci new_ptr = kmb_pcm_rx_fn(kmb_i2s, substream->runtime, 1928c2ecf20Sopenharmony_ci ptr, &period_elapsed); 1938c2ecf20Sopenharmony_ci cmpxchg(&kmb_i2s->rx_ptr, ptr, new_ptr); 1948c2ecf20Sopenharmony_ci } 1958c2ecf20Sopenharmony_ci 1968c2ecf20Sopenharmony_ci if (period_elapsed) 1978c2ecf20Sopenharmony_ci snd_pcm_period_elapsed(substream); 1988c2ecf20Sopenharmony_ci} 1998c2ecf20Sopenharmony_ci 2008c2ecf20Sopenharmony_cistatic int kmb_pcm_open(struct snd_soc_component *component, 2018c2ecf20Sopenharmony_ci struct snd_pcm_substream *substream) 2028c2ecf20Sopenharmony_ci{ 2038c2ecf20Sopenharmony_ci struct snd_pcm_runtime *runtime = substream->runtime; 2048c2ecf20Sopenharmony_ci struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 2058c2ecf20Sopenharmony_ci struct kmb_i2s_info *kmb_i2s; 2068c2ecf20Sopenharmony_ci 2078c2ecf20Sopenharmony_ci kmb_i2s = snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(rtd, 0)); 2088c2ecf20Sopenharmony_ci snd_soc_set_runtime_hwparams(substream, &kmb_pcm_hardware); 2098c2ecf20Sopenharmony_ci snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS); 2108c2ecf20Sopenharmony_ci runtime->private_data = kmb_i2s; 2118c2ecf20Sopenharmony_ci 2128c2ecf20Sopenharmony_ci return 0; 2138c2ecf20Sopenharmony_ci} 2148c2ecf20Sopenharmony_ci 2158c2ecf20Sopenharmony_cistatic int kmb_pcm_trigger(struct snd_soc_component *component, 2168c2ecf20Sopenharmony_ci struct snd_pcm_substream *substream, int cmd) 2178c2ecf20Sopenharmony_ci{ 2188c2ecf20Sopenharmony_ci struct snd_pcm_runtime *runtime = substream->runtime; 2198c2ecf20Sopenharmony_ci struct kmb_i2s_info *kmb_i2s = runtime->private_data; 2208c2ecf20Sopenharmony_ci 2218c2ecf20Sopenharmony_ci switch (cmd) { 2228c2ecf20Sopenharmony_ci case SNDRV_PCM_TRIGGER_START: 2238c2ecf20Sopenharmony_ci if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 2248c2ecf20Sopenharmony_ci kmb_i2s->tx_ptr = 0; 2258c2ecf20Sopenharmony_ci kmb_i2s->tx_substream = substream; 2268c2ecf20Sopenharmony_ci } else { 2278c2ecf20Sopenharmony_ci kmb_i2s->rx_ptr = 0; 2288c2ecf20Sopenharmony_ci kmb_i2s->rx_substream = substream; 2298c2ecf20Sopenharmony_ci } 2308c2ecf20Sopenharmony_ci break; 2318c2ecf20Sopenharmony_ci case SNDRV_PCM_TRIGGER_STOP: 2328c2ecf20Sopenharmony_ci if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 2338c2ecf20Sopenharmony_ci kmb_i2s->tx_substream = NULL; 2348c2ecf20Sopenharmony_ci else 2358c2ecf20Sopenharmony_ci kmb_i2s->rx_substream = NULL; 2368c2ecf20Sopenharmony_ci break; 2378c2ecf20Sopenharmony_ci default: 2388c2ecf20Sopenharmony_ci return -EINVAL; 2398c2ecf20Sopenharmony_ci } 2408c2ecf20Sopenharmony_ci 2418c2ecf20Sopenharmony_ci return 0; 2428c2ecf20Sopenharmony_ci} 2438c2ecf20Sopenharmony_ci 2448c2ecf20Sopenharmony_cistatic irqreturn_t kmb_i2s_irq_handler(int irq, void *dev_id) 2458c2ecf20Sopenharmony_ci{ 2468c2ecf20Sopenharmony_ci struct kmb_i2s_info *kmb_i2s = dev_id; 2478c2ecf20Sopenharmony_ci struct i2s_clk_config_data *config = &kmb_i2s->config; 2488c2ecf20Sopenharmony_ci irqreturn_t ret = IRQ_NONE; 2498c2ecf20Sopenharmony_ci u32 tx_enabled = 0; 2508c2ecf20Sopenharmony_ci u32 isr[4]; 2518c2ecf20Sopenharmony_ci int i; 2528c2ecf20Sopenharmony_ci 2538c2ecf20Sopenharmony_ci for (i = 0; i < config->chan_nr / 2; i++) 2548c2ecf20Sopenharmony_ci isr[i] = readl(kmb_i2s->i2s_base + ISR(i)); 2558c2ecf20Sopenharmony_ci 2568c2ecf20Sopenharmony_ci kmb_i2s_clear_irqs(kmb_i2s, SNDRV_PCM_STREAM_PLAYBACK); 2578c2ecf20Sopenharmony_ci kmb_i2s_clear_irqs(kmb_i2s, SNDRV_PCM_STREAM_CAPTURE); 2588c2ecf20Sopenharmony_ci /* Only check TX interrupt if TX is active */ 2598c2ecf20Sopenharmony_ci tx_enabled = readl(kmb_i2s->i2s_base + ITER); 2608c2ecf20Sopenharmony_ci 2618c2ecf20Sopenharmony_ci /* 2628c2ecf20Sopenharmony_ci * Data available. Retrieve samples from FIFO 2638c2ecf20Sopenharmony_ci */ 2648c2ecf20Sopenharmony_ci 2658c2ecf20Sopenharmony_ci /* 2668c2ecf20Sopenharmony_ci * 8 channel audio will have isr[0..2] triggered, 2678c2ecf20Sopenharmony_ci * reading the specific isr based on the audio configuration, 2688c2ecf20Sopenharmony_ci * to avoid reading the buffers too early. 2698c2ecf20Sopenharmony_ci */ 2708c2ecf20Sopenharmony_ci switch (config->chan_nr) { 2718c2ecf20Sopenharmony_ci case 2: 2728c2ecf20Sopenharmony_ci if (isr[0] & ISR_RXDA) 2738c2ecf20Sopenharmony_ci kmb_pcm_operation(kmb_i2s, false); 2748c2ecf20Sopenharmony_ci ret = IRQ_HANDLED; 2758c2ecf20Sopenharmony_ci break; 2768c2ecf20Sopenharmony_ci case 4: 2778c2ecf20Sopenharmony_ci if (isr[1] & ISR_RXDA) 2788c2ecf20Sopenharmony_ci kmb_pcm_operation(kmb_i2s, false); 2798c2ecf20Sopenharmony_ci ret = IRQ_HANDLED; 2808c2ecf20Sopenharmony_ci break; 2818c2ecf20Sopenharmony_ci case 8: 2828c2ecf20Sopenharmony_ci if (isr[3] & ISR_RXDA) 2838c2ecf20Sopenharmony_ci kmb_pcm_operation(kmb_i2s, false); 2848c2ecf20Sopenharmony_ci ret = IRQ_HANDLED; 2858c2ecf20Sopenharmony_ci break; 2868c2ecf20Sopenharmony_ci } 2878c2ecf20Sopenharmony_ci 2888c2ecf20Sopenharmony_ci for (i = 0; i < config->chan_nr / 2; i++) { 2898c2ecf20Sopenharmony_ci /* 2908c2ecf20Sopenharmony_ci * Check if TX fifo is empty. If empty fill FIFO with samples 2918c2ecf20Sopenharmony_ci */ 2928c2ecf20Sopenharmony_ci if ((isr[i] & ISR_TXFE) && tx_enabled) { 2938c2ecf20Sopenharmony_ci kmb_pcm_operation(kmb_i2s, true); 2948c2ecf20Sopenharmony_ci ret = IRQ_HANDLED; 2958c2ecf20Sopenharmony_ci } 2968c2ecf20Sopenharmony_ci 2978c2ecf20Sopenharmony_ci /* Error Handling: TX */ 2988c2ecf20Sopenharmony_ci if (isr[i] & ISR_TXFO) { 2998c2ecf20Sopenharmony_ci dev_dbg(kmb_i2s->dev, "TX overrun (ch_id=%d)\n", i); 3008c2ecf20Sopenharmony_ci ret = IRQ_HANDLED; 3018c2ecf20Sopenharmony_ci } 3028c2ecf20Sopenharmony_ci /* Error Handling: RX */ 3038c2ecf20Sopenharmony_ci if (isr[i] & ISR_RXFO) { 3048c2ecf20Sopenharmony_ci dev_dbg(kmb_i2s->dev, "RX overrun (ch_id=%d)\n", i); 3058c2ecf20Sopenharmony_ci ret = IRQ_HANDLED; 3068c2ecf20Sopenharmony_ci } 3078c2ecf20Sopenharmony_ci } 3088c2ecf20Sopenharmony_ci 3098c2ecf20Sopenharmony_ci return ret; 3108c2ecf20Sopenharmony_ci} 3118c2ecf20Sopenharmony_ci 3128c2ecf20Sopenharmony_cistatic int kmb_platform_pcm_new(struct snd_soc_component *component, 3138c2ecf20Sopenharmony_ci struct snd_soc_pcm_runtime *soc_runtime) 3148c2ecf20Sopenharmony_ci{ 3158c2ecf20Sopenharmony_ci size_t size = kmb_pcm_hardware.buffer_bytes_max; 3168c2ecf20Sopenharmony_ci /* Use SNDRV_DMA_TYPE_CONTINUOUS as KMB doesn't use PCI sg buffer */ 3178c2ecf20Sopenharmony_ci snd_pcm_set_managed_buffer_all(soc_runtime->pcm, 3188c2ecf20Sopenharmony_ci SNDRV_DMA_TYPE_CONTINUOUS, 3198c2ecf20Sopenharmony_ci NULL, size, size); 3208c2ecf20Sopenharmony_ci return 0; 3218c2ecf20Sopenharmony_ci} 3228c2ecf20Sopenharmony_ci 3238c2ecf20Sopenharmony_cistatic snd_pcm_uframes_t kmb_pcm_pointer(struct snd_soc_component *component, 3248c2ecf20Sopenharmony_ci struct snd_pcm_substream *substream) 3258c2ecf20Sopenharmony_ci{ 3268c2ecf20Sopenharmony_ci struct snd_pcm_runtime *runtime = substream->runtime; 3278c2ecf20Sopenharmony_ci struct kmb_i2s_info *kmb_i2s = runtime->private_data; 3288c2ecf20Sopenharmony_ci snd_pcm_uframes_t pos; 3298c2ecf20Sopenharmony_ci 3308c2ecf20Sopenharmony_ci if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 3318c2ecf20Sopenharmony_ci pos = kmb_i2s->tx_ptr; 3328c2ecf20Sopenharmony_ci else 3338c2ecf20Sopenharmony_ci pos = kmb_i2s->rx_ptr; 3348c2ecf20Sopenharmony_ci 3358c2ecf20Sopenharmony_ci return pos < runtime->buffer_size ? pos : 0; 3368c2ecf20Sopenharmony_ci} 3378c2ecf20Sopenharmony_ci 3388c2ecf20Sopenharmony_cistatic const struct snd_soc_component_driver kmb_component = { 3398c2ecf20Sopenharmony_ci .name = "kmb", 3408c2ecf20Sopenharmony_ci .pcm_construct = kmb_platform_pcm_new, 3418c2ecf20Sopenharmony_ci .open = kmb_pcm_open, 3428c2ecf20Sopenharmony_ci .trigger = kmb_pcm_trigger, 3438c2ecf20Sopenharmony_ci .pointer = kmb_pcm_pointer, 3448c2ecf20Sopenharmony_ci}; 3458c2ecf20Sopenharmony_ci 3468c2ecf20Sopenharmony_cistatic void kmb_i2s_start(struct kmb_i2s_info *kmb_i2s, 3478c2ecf20Sopenharmony_ci struct snd_pcm_substream *substream) 3488c2ecf20Sopenharmony_ci{ 3498c2ecf20Sopenharmony_ci struct i2s_clk_config_data *config = &kmb_i2s->config; 3508c2ecf20Sopenharmony_ci 3518c2ecf20Sopenharmony_ci /* I2S Programming sequence in Keem_Bay_VPU_DB_v1.1 */ 3528c2ecf20Sopenharmony_ci writel(1, kmb_i2s->i2s_base + IER); 3538c2ecf20Sopenharmony_ci 3548c2ecf20Sopenharmony_ci if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 3558c2ecf20Sopenharmony_ci writel(1, kmb_i2s->i2s_base + ITER); 3568c2ecf20Sopenharmony_ci else 3578c2ecf20Sopenharmony_ci writel(1, kmb_i2s->i2s_base + IRER); 3588c2ecf20Sopenharmony_ci 3598c2ecf20Sopenharmony_ci kmb_i2s_irq_trigger(kmb_i2s, substream->stream, config->chan_nr, true); 3608c2ecf20Sopenharmony_ci 3618c2ecf20Sopenharmony_ci if (kmb_i2s->master) 3628c2ecf20Sopenharmony_ci writel(1, kmb_i2s->i2s_base + CER); 3638c2ecf20Sopenharmony_ci else 3648c2ecf20Sopenharmony_ci writel(0, kmb_i2s->i2s_base + CER); 3658c2ecf20Sopenharmony_ci} 3668c2ecf20Sopenharmony_ci 3678c2ecf20Sopenharmony_cistatic void kmb_i2s_stop(struct kmb_i2s_info *kmb_i2s, 3688c2ecf20Sopenharmony_ci struct snd_pcm_substream *substream) 3698c2ecf20Sopenharmony_ci{ 3708c2ecf20Sopenharmony_ci /* I2S Programming sequence in Keem_Bay_VPU_DB_v1.1 */ 3718c2ecf20Sopenharmony_ci kmb_i2s_clear_irqs(kmb_i2s, substream->stream); 3728c2ecf20Sopenharmony_ci 3738c2ecf20Sopenharmony_ci if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 3748c2ecf20Sopenharmony_ci writel(0, kmb_i2s->i2s_base + ITER); 3758c2ecf20Sopenharmony_ci else 3768c2ecf20Sopenharmony_ci writel(0, kmb_i2s->i2s_base + IRER); 3778c2ecf20Sopenharmony_ci 3788c2ecf20Sopenharmony_ci kmb_i2s_irq_trigger(kmb_i2s, substream->stream, 8, false); 3798c2ecf20Sopenharmony_ci 3808c2ecf20Sopenharmony_ci if (!kmb_i2s->active) { 3818c2ecf20Sopenharmony_ci writel(0, kmb_i2s->i2s_base + CER); 3828c2ecf20Sopenharmony_ci writel(0, kmb_i2s->i2s_base + IER); 3838c2ecf20Sopenharmony_ci } 3848c2ecf20Sopenharmony_ci} 3858c2ecf20Sopenharmony_ci 3868c2ecf20Sopenharmony_cistatic void kmb_disable_clk(void *clk) 3878c2ecf20Sopenharmony_ci{ 3888c2ecf20Sopenharmony_ci clk_disable_unprepare(clk); 3898c2ecf20Sopenharmony_ci} 3908c2ecf20Sopenharmony_ci 3918c2ecf20Sopenharmony_cistatic int kmb_set_dai_fmt(struct snd_soc_dai *cpu_dai, unsigned int fmt) 3928c2ecf20Sopenharmony_ci{ 3938c2ecf20Sopenharmony_ci struct kmb_i2s_info *kmb_i2s = snd_soc_dai_get_drvdata(cpu_dai); 3948c2ecf20Sopenharmony_ci int ret; 3958c2ecf20Sopenharmony_ci 3968c2ecf20Sopenharmony_ci switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { 3978c2ecf20Sopenharmony_ci case SND_SOC_DAIFMT_CBM_CFM: 3988c2ecf20Sopenharmony_ci kmb_i2s->master = false; 3998c2ecf20Sopenharmony_ci ret = 0; 4008c2ecf20Sopenharmony_ci break; 4018c2ecf20Sopenharmony_ci case SND_SOC_DAIFMT_CBS_CFS: 4028c2ecf20Sopenharmony_ci writel(MASTER_MODE, kmb_i2s->pss_base + I2S_GEN_CFG_0); 4038c2ecf20Sopenharmony_ci 4048c2ecf20Sopenharmony_ci ret = clk_prepare_enable(kmb_i2s->clk_i2s); 4058c2ecf20Sopenharmony_ci if (ret < 0) 4068c2ecf20Sopenharmony_ci return ret; 4078c2ecf20Sopenharmony_ci 4088c2ecf20Sopenharmony_ci ret = devm_add_action_or_reset(kmb_i2s->dev, kmb_disable_clk, 4098c2ecf20Sopenharmony_ci kmb_i2s->clk_i2s); 4108c2ecf20Sopenharmony_ci if (ret) 4118c2ecf20Sopenharmony_ci return ret; 4128c2ecf20Sopenharmony_ci 4138c2ecf20Sopenharmony_ci kmb_i2s->master = true; 4148c2ecf20Sopenharmony_ci break; 4158c2ecf20Sopenharmony_ci default: 4168c2ecf20Sopenharmony_ci return -EINVAL; 4178c2ecf20Sopenharmony_ci } 4188c2ecf20Sopenharmony_ci 4198c2ecf20Sopenharmony_ci return ret; 4208c2ecf20Sopenharmony_ci} 4218c2ecf20Sopenharmony_ci 4228c2ecf20Sopenharmony_cistatic int kmb_dai_trigger(struct snd_pcm_substream *substream, 4238c2ecf20Sopenharmony_ci int cmd, struct snd_soc_dai *cpu_dai) 4248c2ecf20Sopenharmony_ci{ 4258c2ecf20Sopenharmony_ci struct kmb_i2s_info *kmb_i2s = snd_soc_dai_get_drvdata(cpu_dai); 4268c2ecf20Sopenharmony_ci 4278c2ecf20Sopenharmony_ci switch (cmd) { 4288c2ecf20Sopenharmony_ci case SNDRV_PCM_TRIGGER_START: 4298c2ecf20Sopenharmony_ci /* Keep track of i2s activity before turn off 4308c2ecf20Sopenharmony_ci * the i2s interface 4318c2ecf20Sopenharmony_ci */ 4328c2ecf20Sopenharmony_ci kmb_i2s->active++; 4338c2ecf20Sopenharmony_ci kmb_i2s_start(kmb_i2s, substream); 4348c2ecf20Sopenharmony_ci break; 4358c2ecf20Sopenharmony_ci case SNDRV_PCM_TRIGGER_STOP: 4368c2ecf20Sopenharmony_ci kmb_i2s->active--; 4378c2ecf20Sopenharmony_ci kmb_i2s_stop(kmb_i2s, substream); 4388c2ecf20Sopenharmony_ci break; 4398c2ecf20Sopenharmony_ci default: 4408c2ecf20Sopenharmony_ci return -EINVAL; 4418c2ecf20Sopenharmony_ci } 4428c2ecf20Sopenharmony_ci 4438c2ecf20Sopenharmony_ci return 0; 4448c2ecf20Sopenharmony_ci} 4458c2ecf20Sopenharmony_ci 4468c2ecf20Sopenharmony_cistatic void kmb_i2s_config(struct kmb_i2s_info *kmb_i2s, int stream) 4478c2ecf20Sopenharmony_ci{ 4488c2ecf20Sopenharmony_ci struct i2s_clk_config_data *config = &kmb_i2s->config; 4498c2ecf20Sopenharmony_ci u32 ch_reg; 4508c2ecf20Sopenharmony_ci 4518c2ecf20Sopenharmony_ci kmb_i2s_disable_channels(kmb_i2s, stream); 4528c2ecf20Sopenharmony_ci 4538c2ecf20Sopenharmony_ci for (ch_reg = 0; ch_reg < config->chan_nr / 2; ch_reg++) { 4548c2ecf20Sopenharmony_ci if (stream == SNDRV_PCM_STREAM_PLAYBACK) { 4558c2ecf20Sopenharmony_ci writel(kmb_i2s->xfer_resolution, 4568c2ecf20Sopenharmony_ci kmb_i2s->i2s_base + TCR(ch_reg)); 4578c2ecf20Sopenharmony_ci 4588c2ecf20Sopenharmony_ci writel(kmb_i2s->fifo_th - 1, 4598c2ecf20Sopenharmony_ci kmb_i2s->i2s_base + TFCR(ch_reg)); 4608c2ecf20Sopenharmony_ci 4618c2ecf20Sopenharmony_ci writel(1, kmb_i2s->i2s_base + TER(ch_reg)); 4628c2ecf20Sopenharmony_ci } else { 4638c2ecf20Sopenharmony_ci writel(kmb_i2s->xfer_resolution, 4648c2ecf20Sopenharmony_ci kmb_i2s->i2s_base + RCR(ch_reg)); 4658c2ecf20Sopenharmony_ci 4668c2ecf20Sopenharmony_ci writel(kmb_i2s->fifo_th - 1, 4678c2ecf20Sopenharmony_ci kmb_i2s->i2s_base + RFCR(ch_reg)); 4688c2ecf20Sopenharmony_ci 4698c2ecf20Sopenharmony_ci writel(1, kmb_i2s->i2s_base + RER(ch_reg)); 4708c2ecf20Sopenharmony_ci } 4718c2ecf20Sopenharmony_ci } 4728c2ecf20Sopenharmony_ci} 4738c2ecf20Sopenharmony_ci 4748c2ecf20Sopenharmony_cistatic int kmb_dai_hw_params(struct snd_pcm_substream *substream, 4758c2ecf20Sopenharmony_ci struct snd_pcm_hw_params *hw_params, 4768c2ecf20Sopenharmony_ci struct snd_soc_dai *cpu_dai) 4778c2ecf20Sopenharmony_ci{ 4788c2ecf20Sopenharmony_ci struct kmb_i2s_info *kmb_i2s = snd_soc_dai_get_drvdata(cpu_dai); 4798c2ecf20Sopenharmony_ci struct i2s_clk_config_data *config = &kmb_i2s->config; 4808c2ecf20Sopenharmony_ci u32 write_val; 4818c2ecf20Sopenharmony_ci int ret; 4828c2ecf20Sopenharmony_ci 4838c2ecf20Sopenharmony_ci switch (params_format(hw_params)) { 4848c2ecf20Sopenharmony_ci case SNDRV_PCM_FORMAT_S16_LE: 4858c2ecf20Sopenharmony_ci config->data_width = 16; 4868c2ecf20Sopenharmony_ci kmb_i2s->ccr = 0x00; 4878c2ecf20Sopenharmony_ci kmb_i2s->xfer_resolution = 0x02; 4888c2ecf20Sopenharmony_ci break; 4898c2ecf20Sopenharmony_ci case SNDRV_PCM_FORMAT_S24_LE: 4908c2ecf20Sopenharmony_ci config->data_width = 32; 4918c2ecf20Sopenharmony_ci kmb_i2s->ccr = 0x14; 4928c2ecf20Sopenharmony_ci kmb_i2s->xfer_resolution = 0x05; 4938c2ecf20Sopenharmony_ci break; 4948c2ecf20Sopenharmony_ci case SNDRV_PCM_FORMAT_S32_LE: 4958c2ecf20Sopenharmony_ci config->data_width = 32; 4968c2ecf20Sopenharmony_ci kmb_i2s->ccr = 0x10; 4978c2ecf20Sopenharmony_ci kmb_i2s->xfer_resolution = 0x05; 4988c2ecf20Sopenharmony_ci break; 4998c2ecf20Sopenharmony_ci default: 5008c2ecf20Sopenharmony_ci dev_err(kmb_i2s->dev, "kmb: unsupported PCM fmt"); 5018c2ecf20Sopenharmony_ci return -EINVAL; 5028c2ecf20Sopenharmony_ci } 5038c2ecf20Sopenharmony_ci 5048c2ecf20Sopenharmony_ci config->chan_nr = params_channels(hw_params); 5058c2ecf20Sopenharmony_ci 5068c2ecf20Sopenharmony_ci switch (config->chan_nr) { 5078c2ecf20Sopenharmony_ci case 8: 5088c2ecf20Sopenharmony_ci case 4: 5098c2ecf20Sopenharmony_ci /* 5108c2ecf20Sopenharmony_ci * Platform is not capable of providing clocks for 5118c2ecf20Sopenharmony_ci * multi channel audio 5128c2ecf20Sopenharmony_ci */ 5138c2ecf20Sopenharmony_ci if (kmb_i2s->master) 5148c2ecf20Sopenharmony_ci return -EINVAL; 5158c2ecf20Sopenharmony_ci 5168c2ecf20Sopenharmony_ci write_val = ((config->chan_nr / 2) << TDM_CHANNEL_CONFIG_BIT) | 5178c2ecf20Sopenharmony_ci (config->data_width << DATA_WIDTH_CONFIG_BIT) | 5188c2ecf20Sopenharmony_ci TDM_OPERATION; 5198c2ecf20Sopenharmony_ci 5208c2ecf20Sopenharmony_ci writel(write_val, kmb_i2s->pss_base + I2S_GEN_CFG_0); 5218c2ecf20Sopenharmony_ci break; 5228c2ecf20Sopenharmony_ci case 2: 5238c2ecf20Sopenharmony_ci /* 5248c2ecf20Sopenharmony_ci * Platform is only capable of providing clocks need for 5258c2ecf20Sopenharmony_ci * 2 channel master mode 5268c2ecf20Sopenharmony_ci */ 5278c2ecf20Sopenharmony_ci if (!(kmb_i2s->master)) 5288c2ecf20Sopenharmony_ci return -EINVAL; 5298c2ecf20Sopenharmony_ci 5308c2ecf20Sopenharmony_ci write_val = ((config->chan_nr / 2) << TDM_CHANNEL_CONFIG_BIT) | 5318c2ecf20Sopenharmony_ci (config->data_width << DATA_WIDTH_CONFIG_BIT) | 5328c2ecf20Sopenharmony_ci MASTER_MODE | I2S_OPERATION; 5338c2ecf20Sopenharmony_ci 5348c2ecf20Sopenharmony_ci writel(write_val, kmb_i2s->pss_base + I2S_GEN_CFG_0); 5358c2ecf20Sopenharmony_ci break; 5368c2ecf20Sopenharmony_ci default: 5378c2ecf20Sopenharmony_ci dev_dbg(kmb_i2s->dev, "channel not supported\n"); 5388c2ecf20Sopenharmony_ci return -EINVAL; 5398c2ecf20Sopenharmony_ci } 5408c2ecf20Sopenharmony_ci 5418c2ecf20Sopenharmony_ci kmb_i2s_config(kmb_i2s, substream->stream); 5428c2ecf20Sopenharmony_ci 5438c2ecf20Sopenharmony_ci writel(kmb_i2s->ccr, kmb_i2s->i2s_base + CCR); 5448c2ecf20Sopenharmony_ci 5458c2ecf20Sopenharmony_ci config->sample_rate = params_rate(hw_params); 5468c2ecf20Sopenharmony_ci 5478c2ecf20Sopenharmony_ci if (kmb_i2s->master) { 5488c2ecf20Sopenharmony_ci /* Only 2 ch supported in Master mode */ 5498c2ecf20Sopenharmony_ci u32 bitclk = config->sample_rate * config->data_width * 2; 5508c2ecf20Sopenharmony_ci 5518c2ecf20Sopenharmony_ci ret = clk_set_rate(kmb_i2s->clk_i2s, bitclk); 5528c2ecf20Sopenharmony_ci if (ret) { 5538c2ecf20Sopenharmony_ci dev_err(kmb_i2s->dev, 5548c2ecf20Sopenharmony_ci "Can't set I2S clock rate: %d\n", ret); 5558c2ecf20Sopenharmony_ci return ret; 5568c2ecf20Sopenharmony_ci } 5578c2ecf20Sopenharmony_ci } 5588c2ecf20Sopenharmony_ci 5598c2ecf20Sopenharmony_ci return 0; 5608c2ecf20Sopenharmony_ci} 5618c2ecf20Sopenharmony_ci 5628c2ecf20Sopenharmony_cistatic int kmb_dai_prepare(struct snd_pcm_substream *substream, 5638c2ecf20Sopenharmony_ci struct snd_soc_dai *cpu_dai) 5648c2ecf20Sopenharmony_ci{ 5658c2ecf20Sopenharmony_ci struct kmb_i2s_info *kmb_i2s = snd_soc_dai_get_drvdata(cpu_dai); 5668c2ecf20Sopenharmony_ci 5678c2ecf20Sopenharmony_ci if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 5688c2ecf20Sopenharmony_ci writel(1, kmb_i2s->i2s_base + TXFFR); 5698c2ecf20Sopenharmony_ci else 5708c2ecf20Sopenharmony_ci writel(1, kmb_i2s->i2s_base + RXFFR); 5718c2ecf20Sopenharmony_ci 5728c2ecf20Sopenharmony_ci return 0; 5738c2ecf20Sopenharmony_ci} 5748c2ecf20Sopenharmony_ci 5758c2ecf20Sopenharmony_cistatic struct snd_soc_dai_ops kmb_dai_ops = { 5768c2ecf20Sopenharmony_ci .trigger = kmb_dai_trigger, 5778c2ecf20Sopenharmony_ci .hw_params = kmb_dai_hw_params, 5788c2ecf20Sopenharmony_ci .prepare = kmb_dai_prepare, 5798c2ecf20Sopenharmony_ci .set_fmt = kmb_set_dai_fmt, 5808c2ecf20Sopenharmony_ci}; 5818c2ecf20Sopenharmony_ci 5828c2ecf20Sopenharmony_cistatic struct snd_soc_dai_driver intel_kmb_i2s_dai[] = { 5838c2ecf20Sopenharmony_ci { 5848c2ecf20Sopenharmony_ci .name = "intel_kmb_i2s", 5858c2ecf20Sopenharmony_ci .playback = { 5868c2ecf20Sopenharmony_ci .channels_min = 2, 5878c2ecf20Sopenharmony_ci .channels_max = 2, 5888c2ecf20Sopenharmony_ci .rates = SNDRV_PCM_RATE_8000 | 5898c2ecf20Sopenharmony_ci SNDRV_PCM_RATE_16000 | 5908c2ecf20Sopenharmony_ci SNDRV_PCM_RATE_48000, 5918c2ecf20Sopenharmony_ci .rate_min = 8000, 5928c2ecf20Sopenharmony_ci .rate_max = 48000, 5938c2ecf20Sopenharmony_ci .formats = (SNDRV_PCM_FMTBIT_S32_LE | 5948c2ecf20Sopenharmony_ci SNDRV_PCM_FMTBIT_S24_LE | 5958c2ecf20Sopenharmony_ci SNDRV_PCM_FMTBIT_S16_LE), 5968c2ecf20Sopenharmony_ci }, 5978c2ecf20Sopenharmony_ci .capture = { 5988c2ecf20Sopenharmony_ci .channels_min = 2, 5998c2ecf20Sopenharmony_ci .channels_max = 2, 6008c2ecf20Sopenharmony_ci .rates = SNDRV_PCM_RATE_8000 | 6018c2ecf20Sopenharmony_ci SNDRV_PCM_RATE_16000 | 6028c2ecf20Sopenharmony_ci SNDRV_PCM_RATE_48000, 6038c2ecf20Sopenharmony_ci .rate_min = 8000, 6048c2ecf20Sopenharmony_ci .rate_max = 48000, 6058c2ecf20Sopenharmony_ci .formats = (SNDRV_PCM_FMTBIT_S32_LE | 6068c2ecf20Sopenharmony_ci SNDRV_PCM_FMTBIT_S24_LE | 6078c2ecf20Sopenharmony_ci SNDRV_PCM_FMTBIT_S16_LE), 6088c2ecf20Sopenharmony_ci }, 6098c2ecf20Sopenharmony_ci .ops = &kmb_dai_ops, 6108c2ecf20Sopenharmony_ci }, 6118c2ecf20Sopenharmony_ci}; 6128c2ecf20Sopenharmony_ci 6138c2ecf20Sopenharmony_cistatic struct snd_soc_dai_driver intel_kmb_tdm_dai[] = { 6148c2ecf20Sopenharmony_ci { 6158c2ecf20Sopenharmony_ci .name = "intel_kmb_tdm", 6168c2ecf20Sopenharmony_ci .capture = { 6178c2ecf20Sopenharmony_ci .channels_min = 4, 6188c2ecf20Sopenharmony_ci .channels_max = 8, 6198c2ecf20Sopenharmony_ci .rates = SNDRV_PCM_RATE_8000 | 6208c2ecf20Sopenharmony_ci SNDRV_PCM_RATE_16000 | 6218c2ecf20Sopenharmony_ci SNDRV_PCM_RATE_48000, 6228c2ecf20Sopenharmony_ci .rate_min = 8000, 6238c2ecf20Sopenharmony_ci .rate_max = 48000, 6248c2ecf20Sopenharmony_ci .formats = (SNDRV_PCM_FMTBIT_S32_LE | 6258c2ecf20Sopenharmony_ci SNDRV_PCM_FMTBIT_S24_LE | 6268c2ecf20Sopenharmony_ci SNDRV_PCM_FMTBIT_S16_LE), 6278c2ecf20Sopenharmony_ci }, 6288c2ecf20Sopenharmony_ci .ops = &kmb_dai_ops, 6298c2ecf20Sopenharmony_ci }, 6308c2ecf20Sopenharmony_ci}; 6318c2ecf20Sopenharmony_ci 6328c2ecf20Sopenharmony_cistatic const struct of_device_id kmb_plat_of_match[] = { 6338c2ecf20Sopenharmony_ci { .compatible = "intel,keembay-i2s", .data = &intel_kmb_i2s_dai}, 6348c2ecf20Sopenharmony_ci { .compatible = "intel,keembay-tdm", .data = &intel_kmb_tdm_dai}, 6358c2ecf20Sopenharmony_ci {} 6368c2ecf20Sopenharmony_ci}; 6378c2ecf20Sopenharmony_ci 6388c2ecf20Sopenharmony_cistatic int kmb_plat_dai_probe(struct platform_device *pdev) 6398c2ecf20Sopenharmony_ci{ 6408c2ecf20Sopenharmony_ci struct snd_soc_dai_driver *kmb_i2s_dai; 6418c2ecf20Sopenharmony_ci const struct of_device_id *match; 6428c2ecf20Sopenharmony_ci struct device *dev = &pdev->dev; 6438c2ecf20Sopenharmony_ci struct kmb_i2s_info *kmb_i2s; 6448c2ecf20Sopenharmony_ci int ret, irq; 6458c2ecf20Sopenharmony_ci u32 comp1_reg; 6468c2ecf20Sopenharmony_ci 6478c2ecf20Sopenharmony_ci kmb_i2s = devm_kzalloc(dev, sizeof(*kmb_i2s), GFP_KERNEL); 6488c2ecf20Sopenharmony_ci if (!kmb_i2s) 6498c2ecf20Sopenharmony_ci return -ENOMEM; 6508c2ecf20Sopenharmony_ci 6518c2ecf20Sopenharmony_ci kmb_i2s_dai = devm_kzalloc(dev, sizeof(*kmb_i2s_dai), GFP_KERNEL); 6528c2ecf20Sopenharmony_ci if (!kmb_i2s_dai) 6538c2ecf20Sopenharmony_ci return -ENOMEM; 6548c2ecf20Sopenharmony_ci 6558c2ecf20Sopenharmony_ci match = of_match_device(kmb_plat_of_match, &pdev->dev); 6568c2ecf20Sopenharmony_ci if (!match) { 6578c2ecf20Sopenharmony_ci dev_err(&pdev->dev, "Error: No device match found\n"); 6588c2ecf20Sopenharmony_ci return -ENODEV; 6598c2ecf20Sopenharmony_ci } 6608c2ecf20Sopenharmony_ci kmb_i2s_dai = (struct snd_soc_dai_driver *) match->data; 6618c2ecf20Sopenharmony_ci 6628c2ecf20Sopenharmony_ci /* Prepare the related clocks */ 6638c2ecf20Sopenharmony_ci kmb_i2s->clk_apb = devm_clk_get(dev, "apb_clk"); 6648c2ecf20Sopenharmony_ci if (IS_ERR(kmb_i2s->clk_apb)) { 6658c2ecf20Sopenharmony_ci dev_err(dev, "Failed to get apb clock\n"); 6668c2ecf20Sopenharmony_ci return PTR_ERR(kmb_i2s->clk_apb); 6678c2ecf20Sopenharmony_ci } 6688c2ecf20Sopenharmony_ci 6698c2ecf20Sopenharmony_ci ret = clk_prepare_enable(kmb_i2s->clk_apb); 6708c2ecf20Sopenharmony_ci if (ret < 0) 6718c2ecf20Sopenharmony_ci return ret; 6728c2ecf20Sopenharmony_ci 6738c2ecf20Sopenharmony_ci ret = devm_add_action_or_reset(dev, kmb_disable_clk, kmb_i2s->clk_apb); 6748c2ecf20Sopenharmony_ci if (ret) { 6758c2ecf20Sopenharmony_ci dev_err(dev, "Failed to add clk_apb reset action\n"); 6768c2ecf20Sopenharmony_ci return ret; 6778c2ecf20Sopenharmony_ci } 6788c2ecf20Sopenharmony_ci 6798c2ecf20Sopenharmony_ci kmb_i2s->clk_i2s = devm_clk_get(dev, "osc"); 6808c2ecf20Sopenharmony_ci if (IS_ERR(kmb_i2s->clk_i2s)) { 6818c2ecf20Sopenharmony_ci dev_err(dev, "Failed to get osc clock\n"); 6828c2ecf20Sopenharmony_ci return PTR_ERR(kmb_i2s->clk_i2s); 6838c2ecf20Sopenharmony_ci } 6848c2ecf20Sopenharmony_ci 6858c2ecf20Sopenharmony_ci kmb_i2s->i2s_base = devm_platform_ioremap_resource(pdev, 0); 6868c2ecf20Sopenharmony_ci if (IS_ERR(kmb_i2s->i2s_base)) 6878c2ecf20Sopenharmony_ci return PTR_ERR(kmb_i2s->i2s_base); 6888c2ecf20Sopenharmony_ci 6898c2ecf20Sopenharmony_ci kmb_i2s->pss_base = devm_platform_ioremap_resource(pdev, 1); 6908c2ecf20Sopenharmony_ci if (IS_ERR(kmb_i2s->pss_base)) 6918c2ecf20Sopenharmony_ci return PTR_ERR(kmb_i2s->pss_base); 6928c2ecf20Sopenharmony_ci 6938c2ecf20Sopenharmony_ci kmb_i2s->dev = &pdev->dev; 6948c2ecf20Sopenharmony_ci 6958c2ecf20Sopenharmony_ci irq = platform_get_irq_optional(pdev, 0); 6968c2ecf20Sopenharmony_ci if (irq > 0) { 6978c2ecf20Sopenharmony_ci ret = devm_request_irq(dev, irq, kmb_i2s_irq_handler, 0, 6988c2ecf20Sopenharmony_ci pdev->name, kmb_i2s); 6998c2ecf20Sopenharmony_ci if (ret < 0) { 7008c2ecf20Sopenharmony_ci dev_err(dev, "failed to request irq\n"); 7018c2ecf20Sopenharmony_ci return ret; 7028c2ecf20Sopenharmony_ci } 7038c2ecf20Sopenharmony_ci } 7048c2ecf20Sopenharmony_ci 7058c2ecf20Sopenharmony_ci comp1_reg = readl(kmb_i2s->i2s_base + I2S_COMP_PARAM_1); 7068c2ecf20Sopenharmony_ci 7078c2ecf20Sopenharmony_ci kmb_i2s->fifo_th = (1 << COMP1_FIFO_DEPTH(comp1_reg)) / 2; 7088c2ecf20Sopenharmony_ci 7098c2ecf20Sopenharmony_ci ret = devm_snd_soc_register_component(dev, &kmb_component, 7108c2ecf20Sopenharmony_ci kmb_i2s_dai, 1); 7118c2ecf20Sopenharmony_ci if (ret) { 7128c2ecf20Sopenharmony_ci dev_err(dev, "not able to register dai\n"); 7138c2ecf20Sopenharmony_ci return ret; 7148c2ecf20Sopenharmony_ci } 7158c2ecf20Sopenharmony_ci 7168c2ecf20Sopenharmony_ci /* To ensure none of the channels are enabled at boot up */ 7178c2ecf20Sopenharmony_ci kmb_i2s_disable_channels(kmb_i2s, SNDRV_PCM_STREAM_PLAYBACK); 7188c2ecf20Sopenharmony_ci kmb_i2s_disable_channels(kmb_i2s, SNDRV_PCM_STREAM_CAPTURE); 7198c2ecf20Sopenharmony_ci 7208c2ecf20Sopenharmony_ci dev_set_drvdata(dev, kmb_i2s); 7218c2ecf20Sopenharmony_ci 7228c2ecf20Sopenharmony_ci return ret; 7238c2ecf20Sopenharmony_ci} 7248c2ecf20Sopenharmony_ci 7258c2ecf20Sopenharmony_cistatic struct platform_driver kmb_plat_dai_driver = { 7268c2ecf20Sopenharmony_ci .driver = { 7278c2ecf20Sopenharmony_ci .name = "kmb-plat-dai", 7288c2ecf20Sopenharmony_ci .of_match_table = kmb_plat_of_match, 7298c2ecf20Sopenharmony_ci }, 7308c2ecf20Sopenharmony_ci .probe = kmb_plat_dai_probe, 7318c2ecf20Sopenharmony_ci}; 7328c2ecf20Sopenharmony_ci 7338c2ecf20Sopenharmony_cimodule_platform_driver(kmb_plat_dai_driver); 7348c2ecf20Sopenharmony_ci 7358c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("ASoC Intel KeemBay Platform driver"); 7368c2ecf20Sopenharmony_ciMODULE_AUTHOR("Sia Jee Heng <jee.heng.sia@intel.com>"); 7378c2ecf20Sopenharmony_ciMODULE_AUTHOR("Sit, Michael Wei Hong <michael.wei.hong.sit@intel.com>"); 7388c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL v2"); 7398c2ecf20Sopenharmony_ciMODULE_ALIAS("platform:kmb_platform"); 740