1 | // SPDX-License-Identifier: GPL-2.0 |
2 | // |
3 | // Copyright (c) 2020 BayLibre, SAS. |
4 | // Author: Jerome Brunet <jbrunet@baylibre.com> |
5 | |
6 | #include <linux/bitfield.h> |
7 | #include <linux/clk.h> |
8 | #include <linux/dma-mapping.h> |
9 | #include <sound/pcm_params.h> |
10 | #include <sound/soc.h> |
11 | #include <sound/soc-dai.h> |
12 | |
13 | #include "aiu-fifo.h" |
14 | |
15 | #define AIU_MEM_START 0x00 |
16 | #define AIU_MEM_RD 0x04 |
17 | #define AIU_MEM_END 0x08 |
18 | #define AIU_MEM_MASKS 0x0c |
19 | #define AIU_MEM_MASK_CH_RD GENMASK(7, 0) |
20 | #define AIU_MEM_MASK_CH_MEM GENMASK(15, 8) |
21 | #define AIU_MEM_CONTROL 0x10 |
22 | #define AIU_MEM_CONTROL_INIT BIT(0) |
23 | #define AIU_MEM_CONTROL_FILL_EN BIT(1) |
24 | #define AIU_MEM_CONTROL_EMPTY_EN BIT(2) |
25 | |
26 | static struct snd_soc_dai *aiu_fifo_dai(struct snd_pcm_substream *ss) |
27 | { |
28 | struct snd_soc_pcm_runtime *rtd = ss->private_data; |
29 | |
30 | return snd_soc_rtd_to_cpu(rtd, 0); |
31 | } |
32 | |
33 | snd_pcm_uframes_t aiu_fifo_pointer(struct snd_soc_component *component, |
34 | struct snd_pcm_substream *substream) |
35 | { |
36 | struct snd_soc_dai *dai = aiu_fifo_dai(ss: substream); |
37 | struct aiu_fifo *fifo = snd_soc_dai_dma_data_get_playback(dai); |
38 | struct snd_pcm_runtime *runtime = substream->runtime; |
39 | unsigned int addr; |
40 | |
41 | addr = snd_soc_component_read(component, reg: fifo->mem_offset + AIU_MEM_RD); |
42 | |
43 | return bytes_to_frames(runtime, size: addr - (unsigned int)runtime->dma_addr); |
44 | } |
45 | |
46 | static void aiu_fifo_enable(struct snd_soc_dai *dai, bool enable) |
47 | { |
48 | struct snd_soc_component *component = dai->component; |
49 | struct aiu_fifo *fifo = snd_soc_dai_dma_data_get_playback(dai); |
50 | unsigned int en_mask = (AIU_MEM_CONTROL_FILL_EN | |
51 | AIU_MEM_CONTROL_EMPTY_EN); |
52 | |
53 | snd_soc_component_update_bits(component, |
54 | reg: fifo->mem_offset + AIU_MEM_CONTROL, |
55 | mask: en_mask, val: enable ? en_mask : 0); |
56 | } |
57 | |
58 | int aiu_fifo_trigger(struct snd_pcm_substream *substream, int cmd, |
59 | struct snd_soc_dai *dai) |
60 | { |
61 | switch (cmd) { |
62 | case SNDRV_PCM_TRIGGER_START: |
63 | case SNDRV_PCM_TRIGGER_RESUME: |
64 | case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: |
65 | aiu_fifo_enable(dai, enable: true); |
66 | break; |
67 | case SNDRV_PCM_TRIGGER_SUSPEND: |
68 | case SNDRV_PCM_TRIGGER_PAUSE_PUSH: |
69 | case SNDRV_PCM_TRIGGER_STOP: |
70 | aiu_fifo_enable(dai, enable: false); |
71 | break; |
72 | default: |
73 | return -EINVAL; |
74 | } |
75 | |
76 | return 0; |
77 | } |
78 | |
79 | int aiu_fifo_prepare(struct snd_pcm_substream *substream, |
80 | struct snd_soc_dai *dai) |
81 | { |
82 | struct snd_soc_component *component = dai->component; |
83 | struct aiu_fifo *fifo = snd_soc_dai_dma_data_get_playback(dai); |
84 | |
85 | snd_soc_component_update_bits(component, |
86 | reg: fifo->mem_offset + AIU_MEM_CONTROL, |
87 | AIU_MEM_CONTROL_INIT, |
88 | AIU_MEM_CONTROL_INIT); |
89 | snd_soc_component_update_bits(component, |
90 | reg: fifo->mem_offset + AIU_MEM_CONTROL, |
91 | AIU_MEM_CONTROL_INIT, val: 0); |
92 | return 0; |
93 | } |
94 | |
95 | int aiu_fifo_hw_params(struct snd_pcm_substream *substream, |
96 | struct snd_pcm_hw_params *params, |
97 | struct snd_soc_dai *dai) |
98 | { |
99 | struct snd_pcm_runtime *runtime = substream->runtime; |
100 | struct snd_soc_component *component = dai->component; |
101 | struct aiu_fifo *fifo = snd_soc_dai_dma_data_get_playback(dai); |
102 | dma_addr_t end; |
103 | |
104 | /* Setup the fifo boundaries */ |
105 | end = runtime->dma_addr + runtime->dma_bytes - fifo->fifo_block; |
106 | snd_soc_component_write(component, reg: fifo->mem_offset + AIU_MEM_START, |
107 | val: runtime->dma_addr); |
108 | snd_soc_component_write(component, reg: fifo->mem_offset + AIU_MEM_RD, |
109 | val: runtime->dma_addr); |
110 | snd_soc_component_write(component, reg: fifo->mem_offset + AIU_MEM_END, |
111 | val: end); |
112 | |
113 | /* Setup the fifo to read all the memory - no skip */ |
114 | snd_soc_component_update_bits(component, |
115 | reg: fifo->mem_offset + AIU_MEM_MASKS, |
116 | AIU_MEM_MASK_CH_RD | AIU_MEM_MASK_CH_MEM, |
117 | FIELD_PREP(AIU_MEM_MASK_CH_RD, 0xff) | |
118 | FIELD_PREP(AIU_MEM_MASK_CH_MEM, 0xff)); |
119 | |
120 | return 0; |
121 | } |
122 | |
123 | static irqreturn_t aiu_fifo_isr(int irq, void *dev_id) |
124 | { |
125 | struct snd_pcm_substream *playback = dev_id; |
126 | |
127 | snd_pcm_period_elapsed(substream: playback); |
128 | |
129 | return IRQ_HANDLED; |
130 | } |
131 | |
132 | int aiu_fifo_startup(struct snd_pcm_substream *substream, |
133 | struct snd_soc_dai *dai) |
134 | { |
135 | struct aiu_fifo *fifo = snd_soc_dai_dma_data_get_playback(dai); |
136 | int ret; |
137 | |
138 | snd_soc_set_runtime_hwparams(substream, hw: fifo->pcm); |
139 | |
140 | /* |
141 | * Make sure the buffer and period size are multiple of the fifo burst |
142 | * size |
143 | */ |
144 | ret = snd_pcm_hw_constraint_step(runtime: substream->runtime, cond: 0, |
145 | SNDRV_PCM_HW_PARAM_BUFFER_BYTES, |
146 | step: fifo->fifo_block); |
147 | if (ret) |
148 | return ret; |
149 | |
150 | ret = snd_pcm_hw_constraint_step(runtime: substream->runtime, cond: 0, |
151 | SNDRV_PCM_HW_PARAM_PERIOD_BYTES, |
152 | step: fifo->fifo_block); |
153 | if (ret) |
154 | return ret; |
155 | |
156 | ret = clk_prepare_enable(clk: fifo->pclk); |
157 | if (ret) |
158 | return ret; |
159 | |
160 | ret = request_irq(irq: fifo->irq, handler: aiu_fifo_isr, flags: 0, name: dev_name(dev: dai->dev), |
161 | dev: substream); |
162 | if (ret) |
163 | clk_disable_unprepare(clk: fifo->pclk); |
164 | |
165 | return ret; |
166 | } |
167 | |
168 | void aiu_fifo_shutdown(struct snd_pcm_substream *substream, |
169 | struct snd_soc_dai *dai) |
170 | { |
171 | struct aiu_fifo *fifo = snd_soc_dai_dma_data_get_playback(dai); |
172 | |
173 | free_irq(fifo->irq, substream); |
174 | clk_disable_unprepare(clk: fifo->pclk); |
175 | } |
176 | |
177 | int aiu_fifo_pcm_new(struct snd_soc_pcm_runtime *rtd, |
178 | struct snd_soc_dai *dai) |
179 | { |
180 | struct snd_card *card = rtd->card->snd_card; |
181 | struct aiu_fifo *fifo = snd_soc_dai_dma_data_get_playback(dai); |
182 | size_t size = fifo->pcm->buffer_bytes_max; |
183 | int ret; |
184 | |
185 | ret = dma_coerce_mask_and_coherent(dev: card->dev, DMA_BIT_MASK(32)); |
186 | if (ret) |
187 | return ret; |
188 | |
189 | snd_pcm_set_managed_buffer_all(pcm: rtd->pcm, SNDRV_DMA_TYPE_DEV, |
190 | data: card->dev, size, max: size); |
191 | |
192 | return 0; |
193 | } |
194 | |
195 | int aiu_fifo_dai_probe(struct snd_soc_dai *dai) |
196 | { |
197 | struct aiu_fifo *fifo; |
198 | |
199 | fifo = kzalloc(size: sizeof(*fifo), GFP_KERNEL); |
200 | if (!fifo) |
201 | return -ENOMEM; |
202 | |
203 | snd_soc_dai_dma_data_set_playback(dai, fifo); |
204 | |
205 | return 0; |
206 | } |
207 | |
208 | int aiu_fifo_dai_remove(struct snd_soc_dai *dai) |
209 | { |
210 | struct aiu_fifo *fifo = snd_soc_dai_dma_data_get_playback(dai); |
211 | |
212 | kfree(objp: fifo); |
213 | |
214 | return 0; |
215 | } |
216 | |