1 // SPDX-License-Identifier: GPL-2.0-or-later 1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /* 2 /*
3 * kirkwood-dma.c 3 * kirkwood-dma.c
4 * 4 *
5 * (c) 2010 Arnaud Patard <apatard@mandriva.co 5 * (c) 2010 Arnaud Patard <apatard@mandriva.com>
6 * (c) 2010 Arnaud Patard <arnaud.patard@rtp-n 6 * (c) 2010 Arnaud Patard <arnaud.patard@rtp-net.org>
7 */ 7 */
8 8
9 #include <linux/init.h> 9 #include <linux/init.h>
10 #include <linux/module.h> 10 #include <linux/module.h>
11 #include <linux/device.h> 11 #include <linux/device.h>
12 #include <linux/io.h> 12 #include <linux/io.h>
13 #include <linux/slab.h> 13 #include <linux/slab.h>
14 #include <linux/interrupt.h> 14 #include <linux/interrupt.h>
15 #include <linux/dma-mapping.h> 15 #include <linux/dma-mapping.h>
16 #include <linux/mbus.h> 16 #include <linux/mbus.h>
17 #include <sound/soc.h> 17 #include <sound/soc.h>
18 #include "kirkwood.h" 18 #include "kirkwood.h"
19 19
20 static struct kirkwood_dma_data *kirkwood_priv 20 static struct kirkwood_dma_data *kirkwood_priv(struct snd_pcm_substream *subs)
21 { 21 {
22 struct snd_soc_pcm_runtime *soc_runtim !! 22 struct snd_soc_pcm_runtime *soc_runtime = subs->private_data;
23 return snd_soc_dai_get_drvdata(snd_soc !! 23 return snd_soc_dai_get_drvdata(asoc_rtd_to_cpu(soc_runtime, 0));
24 } 24 }
25 25
26 static const struct snd_pcm_hardware kirkwood_ 26 static const struct snd_pcm_hardware kirkwood_dma_snd_hw = {
27 .info = SNDRV_PCM_INFO_INTERLEAVED | 27 .info = SNDRV_PCM_INFO_INTERLEAVED |
28 SNDRV_PCM_INFO_MMAP | 28 SNDRV_PCM_INFO_MMAP |
29 SNDRV_PCM_INFO_MMAP_VALID | 29 SNDRV_PCM_INFO_MMAP_VALID |
30 SNDRV_PCM_INFO_BLOCK_TRANSFER 30 SNDRV_PCM_INFO_BLOCK_TRANSFER |
31 SNDRV_PCM_INFO_PAUSE | 31 SNDRV_PCM_INFO_PAUSE |
32 SNDRV_PCM_INFO_NO_PERIOD_WAKEU 32 SNDRV_PCM_INFO_NO_PERIOD_WAKEUP,
33 .buffer_bytes_max = KIRKWOOD_SND 33 .buffer_bytes_max = KIRKWOOD_SND_MAX_BUFFER_BYTES,
34 .period_bytes_min = KIRKWOOD_SND 34 .period_bytes_min = KIRKWOOD_SND_MIN_PERIOD_BYTES,
35 .period_bytes_max = KIRKWOOD_SND 35 .period_bytes_max = KIRKWOOD_SND_MAX_PERIOD_BYTES,
36 .periods_min = KIRKWOOD_SND 36 .periods_min = KIRKWOOD_SND_MIN_PERIODS,
37 .periods_max = KIRKWOOD_SND 37 .periods_max = KIRKWOOD_SND_MAX_PERIODS,
38 .fifo_size = 0, 38 .fifo_size = 0,
39 }; 39 };
40 40
41 static irqreturn_t kirkwood_dma_irq(int irq, v 41 static irqreturn_t kirkwood_dma_irq(int irq, void *dev_id)
42 { 42 {
43 struct kirkwood_dma_data *priv = dev_i 43 struct kirkwood_dma_data *priv = dev_id;
44 unsigned long mask, status, cause; 44 unsigned long mask, status, cause;
45 45
46 mask = readl(priv->io + KIRKWOOD_INT_M 46 mask = readl(priv->io + KIRKWOOD_INT_MASK);
47 status = readl(priv->io + KIRKWOOD_INT 47 status = readl(priv->io + KIRKWOOD_INT_CAUSE) & mask;
48 48
49 cause = readl(priv->io + KIRKWOOD_ERR_ 49 cause = readl(priv->io + KIRKWOOD_ERR_CAUSE);
50 if (unlikely(cause)) { 50 if (unlikely(cause)) {
51 printk(KERN_WARNING "%s: got e 51 printk(KERN_WARNING "%s: got err interrupt 0x%lx\n",
52 __func__, caus 52 __func__, cause);
53 writel(cause, priv->io + KIRKW 53 writel(cause, priv->io + KIRKWOOD_ERR_CAUSE);
54 } 54 }
55 55
56 /* we've enabled only bytes interrupts 56 /* we've enabled only bytes interrupts ... */
57 if (status & ~(KIRKWOOD_INT_CAUSE_PLAY 57 if (status & ~(KIRKWOOD_INT_CAUSE_PLAY_BYTES | \
58 KIRKWOOD_INT_CAUSE_REC 58 KIRKWOOD_INT_CAUSE_REC_BYTES)) {
59 printk(KERN_WARNING "%s: unexp 59 printk(KERN_WARNING "%s: unexpected interrupt %lx\n",
60 __func__, status); 60 __func__, status);
61 return IRQ_NONE; 61 return IRQ_NONE;
62 } 62 }
63 63
64 /* ack int */ 64 /* ack int */
65 writel(status, priv->io + KIRKWOOD_INT 65 writel(status, priv->io + KIRKWOOD_INT_CAUSE);
66 66
67 if (status & KIRKWOOD_INT_CAUSE_PLAY_B 67 if (status & KIRKWOOD_INT_CAUSE_PLAY_BYTES)
68 snd_pcm_period_elapsed(priv->s 68 snd_pcm_period_elapsed(priv->substream_play);
69 69
70 if (status & KIRKWOOD_INT_CAUSE_REC_BY 70 if (status & KIRKWOOD_INT_CAUSE_REC_BYTES)
71 snd_pcm_period_elapsed(priv->s 71 snd_pcm_period_elapsed(priv->substream_rec);
72 72
73 return IRQ_HANDLED; 73 return IRQ_HANDLED;
74 } 74 }
75 75
76 static void 76 static void
77 kirkwood_dma_conf_mbus_windows(void __iomem *b 77 kirkwood_dma_conf_mbus_windows(void __iomem *base, int win,
78 unsigned long d 78 unsigned long dma,
79 const struct mb 79 const struct mbus_dram_target_info *dram)
80 { 80 {
81 int i; 81 int i;
82 82
83 /* First disable and clear windows */ 83 /* First disable and clear windows */
84 writel(0, base + KIRKWOOD_AUDIO_WIN_CT 84 writel(0, base + KIRKWOOD_AUDIO_WIN_CTRL_REG(win));
85 writel(0, base + KIRKWOOD_AUDIO_WIN_BA 85 writel(0, base + KIRKWOOD_AUDIO_WIN_BASE_REG(win));
86 86
87 /* try to find matching cs for current 87 /* try to find matching cs for current dma address */
88 for (i = 0; i < dram->num_cs; i++) { 88 for (i = 0; i < dram->num_cs; i++) {
89 const struct mbus_dram_window !! 89 const struct mbus_dram_window *cs = dram->cs + i;
90 if ((cs->base & 0xffff0000) < 90 if ((cs->base & 0xffff0000) < (dma & 0xffff0000)) {
91 writel(cs->base & 0xff 91 writel(cs->base & 0xffff0000,
92 base + KIRKWOO 92 base + KIRKWOOD_AUDIO_WIN_BASE_REG(win));
93 writel(((cs->size - 1) 93 writel(((cs->size - 1) & 0xffff0000) |
94 (cs->mbus_attr 94 (cs->mbus_attr << 8) |
95 (dram->mbus_dr 95 (dram->mbus_dram_target_id << 4) | 1,
96 base + KIRKWOO 96 base + KIRKWOOD_AUDIO_WIN_CTRL_REG(win));
97 } 97 }
98 } 98 }
99 } 99 }
100 100
101 static int kirkwood_dma_open(struct snd_soc_co 101 static int kirkwood_dma_open(struct snd_soc_component *component,
102 struct snd_pcm_su 102 struct snd_pcm_substream *substream)
103 { 103 {
104 int err; 104 int err;
105 struct snd_pcm_runtime *runtime = subs 105 struct snd_pcm_runtime *runtime = substream->runtime;
106 struct kirkwood_dma_data *priv = kirkw 106 struct kirkwood_dma_data *priv = kirkwood_priv(substream);
>> 107 const struct mbus_dram_target_info *dram;
>> 108 unsigned long addr;
107 109
108 snd_soc_set_runtime_hwparams(substream 110 snd_soc_set_runtime_hwparams(substream, &kirkwood_dma_snd_hw);
109 111
110 /* Ensure that all constraints linked 112 /* Ensure that all constraints linked to dma burst are fulfilled */
111 err = snd_pcm_hw_constraint_minmax(run 113 err = snd_pcm_hw_constraint_minmax(runtime,
112 SNDRV_PCM_HW_PARAM_BUF 114 SNDRV_PCM_HW_PARAM_BUFFER_BYTES,
113 priv->burst * 2, 115 priv->burst * 2,
114 KIRKWOOD_AUDIO_BUF_MAX 116 KIRKWOOD_AUDIO_BUF_MAX-1);
115 if (err < 0) 117 if (err < 0)
116 return err; 118 return err;
117 119
118 err = snd_pcm_hw_constraint_step(runti 120 err = snd_pcm_hw_constraint_step(runtime, 0,
119 SNDRV_PCM_HW_PARAM_BUF 121 SNDRV_PCM_HW_PARAM_BUFFER_BYTES,
120 priv->burst); 122 priv->burst);
121 if (err < 0) 123 if (err < 0)
122 return err; 124 return err;
123 125
124 err = snd_pcm_hw_constraint_step(subst 126 err = snd_pcm_hw_constraint_step(substream->runtime, 0,
125 SNDRV_PCM_HW_PARAM_PE 127 SNDRV_PCM_HW_PARAM_PERIOD_BYTES,
126 priv->burst); 128 priv->burst);
127 if (err < 0) 129 if (err < 0)
128 return err; 130 return err;
129 131
130 if (!priv->substream_play && !priv->su 132 if (!priv->substream_play && !priv->substream_rec) {
131 err = request_irq(priv->irq, k 133 err = request_irq(priv->irq, kirkwood_dma_irq, IRQF_SHARED,
132 "kirkwood-i2 134 "kirkwood-i2s", priv);
133 if (err) 135 if (err)
134 return err; 136 return err;
135 137
136 /* 138 /*
137 * Enable Error interrupts. We 139 * Enable Error interrupts. We're only ack'ing them but
138 * it's useful for diagnostics 140 * it's useful for diagnostics
139 */ 141 */
140 writel((unsigned int)-1, priv- 142 writel((unsigned int)-1, priv->io + KIRKWOOD_ERR_MASK);
141 } 143 }
142 144
>> 145 dram = mv_mbus_dram_info();
>> 146 addr = substream->dma_buffer.addr;
143 if (substream->stream == SNDRV_PCM_STR 147 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
144 if (priv->substream_play) 148 if (priv->substream_play)
145 return -EBUSY; 149 return -EBUSY;
146 priv->substream_play = substre 150 priv->substream_play = substream;
>> 151 kirkwood_dma_conf_mbus_windows(priv->io,
>> 152 KIRKWOOD_PLAYBACK_WIN, addr, dram);
147 } else { 153 } else {
148 if (priv->substream_rec) 154 if (priv->substream_rec)
149 return -EBUSY; 155 return -EBUSY;
150 priv->substream_rec = substrea 156 priv->substream_rec = substream;
>> 157 kirkwood_dma_conf_mbus_windows(priv->io,
>> 158 KIRKWOOD_RECORD_WIN, addr, dram);
151 } 159 }
152 160
153 return 0; 161 return 0;
154 } 162 }
155 163
156 static int kirkwood_dma_close(struct snd_soc_c 164 static int kirkwood_dma_close(struct snd_soc_component *component,
157 struct snd_pcm_s 165 struct snd_pcm_substream *substream)
158 { 166 {
159 struct kirkwood_dma_data *priv = kirkw 167 struct kirkwood_dma_data *priv = kirkwood_priv(substream);
160 168
161 if (!priv) 169 if (!priv)
162 return 0; 170 return 0;
163 171
164 if (substream->stream == SNDRV_PCM_STR 172 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
165 priv->substream_play = NULL; 173 priv->substream_play = NULL;
166 else 174 else
167 priv->substream_rec = NULL; 175 priv->substream_rec = NULL;
168 176
169 if (!priv->substream_play && !priv->su 177 if (!priv->substream_play && !priv->substream_rec) {
170 writel(0, priv->io + KIRKWOOD_ 178 writel(0, priv->io + KIRKWOOD_ERR_MASK);
171 free_irq(priv->irq, priv); 179 free_irq(priv->irq, priv);
172 } 180 }
173 181
174 return 0; 182 return 0;
175 } 183 }
176 184
177 static int kirkwood_dma_hw_params(struct snd_s 185 static int kirkwood_dma_hw_params(struct snd_soc_component *component,
178 struct snd_p 186 struct snd_pcm_substream *substream,
179 struct snd_p 187 struct snd_pcm_hw_params *params)
180 { 188 {
181 struct kirkwood_dma_data *priv = kirkw !! 189 struct snd_pcm_runtime *runtime = substream->runtime;
182 const struct mbus_dram_target_info *dr <<
183 unsigned long addr = substream->runtim <<
184 190
185 if (!dram) !! 191 snd_pcm_set_runtime_buffer(substream, &substream->dma_buffer);
186 return 0; !! 192 runtime->dma_bytes = params_buffer_bytes(params);
187 193
188 if (substream->stream == SNDRV_PCM_STR !! 194 return 0;
189 kirkwood_dma_conf_mbus_windows !! 195 }
190 KIRKWOOD_PLAYBACK_WIN, !! 196
191 else !! 197 static int kirkwood_dma_hw_free(struct snd_soc_component *component,
192 kirkwood_dma_conf_mbus_windows !! 198 struct snd_pcm_substream *substream)
193 KIRKWOOD_RECORD_WIN, a !! 199 {
>> 200 snd_pcm_set_runtime_buffer(substream, NULL);
194 return 0; 201 return 0;
195 } 202 }
196 203
197 static int kirkwood_dma_prepare(struct snd_soc 204 static int kirkwood_dma_prepare(struct snd_soc_component *component,
198 struct snd_pcm 205 struct snd_pcm_substream *substream)
199 { 206 {
200 struct snd_pcm_runtime *runtime = subs 207 struct snd_pcm_runtime *runtime = substream->runtime;
201 struct kirkwood_dma_data *priv = kirkw 208 struct kirkwood_dma_data *priv = kirkwood_priv(substream);
202 unsigned long size, count; 209 unsigned long size, count;
203 210
204 /* compute buffer size in term of "wor 211 /* compute buffer size in term of "words" as requested in specs */
205 size = frames_to_bytes(runtime, runtim 212 size = frames_to_bytes(runtime, runtime->buffer_size);
206 size = (size>>2)-1; 213 size = (size>>2)-1;
207 count = snd_pcm_lib_period_bytes(subst 214 count = snd_pcm_lib_period_bytes(substream);
208 215
209 if (substream->stream == SNDRV_PCM_STR 216 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
210 writel(count, priv->io + KIRKW 217 writel(count, priv->io + KIRKWOOD_PLAY_BYTE_INT_COUNT);
211 writel(runtime->dma_addr, priv 218 writel(runtime->dma_addr, priv->io + KIRKWOOD_PLAY_BUF_ADDR);
212 writel(size, priv->io + KIRKWO 219 writel(size, priv->io + KIRKWOOD_PLAY_BUF_SIZE);
213 } else { 220 } else {
214 writel(count, priv->io + KIRKW 221 writel(count, priv->io + KIRKWOOD_REC_BYTE_INT_COUNT);
215 writel(runtime->dma_addr, priv 222 writel(runtime->dma_addr, priv->io + KIRKWOOD_REC_BUF_ADDR);
216 writel(size, priv->io + KIRKWO 223 writel(size, priv->io + KIRKWOOD_REC_BUF_SIZE);
217 } 224 }
218 225
219 226
220 return 0; 227 return 0;
221 } 228 }
222 229
223 static snd_pcm_uframes_t kirkwood_dma_pointer( 230 static snd_pcm_uframes_t kirkwood_dma_pointer(
224 struct snd_soc_component *component, 231 struct snd_soc_component *component,
225 struct snd_pcm_substream *substream) 232 struct snd_pcm_substream *substream)
226 { 233 {
227 struct kirkwood_dma_data *priv = kirkw 234 struct kirkwood_dma_data *priv = kirkwood_priv(substream);
228 snd_pcm_uframes_t count; 235 snd_pcm_uframes_t count;
229 236
230 if (substream->stream == SNDRV_PCM_STR 237 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
231 count = bytes_to_frames(substr 238 count = bytes_to_frames(substream->runtime,
232 readl(priv->io + KIRKW 239 readl(priv->io + KIRKWOOD_PLAY_BYTE_COUNT));
233 else 240 else
234 count = bytes_to_frames(substr 241 count = bytes_to_frames(substream->runtime,
235 readl(priv->io + KIRKW 242 readl(priv->io + KIRKWOOD_REC_BYTE_COUNT));
236 243
237 return count; 244 return count;
238 } 245 }
239 246
>> 247 static int kirkwood_dma_preallocate_dma_buffer(struct snd_pcm *pcm,
>> 248 int stream)
>> 249 {
>> 250 struct snd_pcm_substream *substream = pcm->streams[stream].substream;
>> 251 struct snd_dma_buffer *buf = &substream->dma_buffer;
>> 252 size_t size = kirkwood_dma_snd_hw.buffer_bytes_max;
>> 253
>> 254 buf->dev.type = SNDRV_DMA_TYPE_DEV;
>> 255 buf->dev.dev = pcm->card->dev;
>> 256 buf->area = dma_alloc_coherent(pcm->card->dev, size,
>> 257 &buf->addr, GFP_KERNEL);
>> 258 if (!buf->area)
>> 259 return -ENOMEM;
>> 260 buf->bytes = size;
>> 261 buf->private_data = NULL;
>> 262
>> 263 return 0;
>> 264 }
>> 265
240 static int kirkwood_dma_new(struct snd_soc_com 266 static int kirkwood_dma_new(struct snd_soc_component *component,
241 struct snd_soc_pcm 267 struct snd_soc_pcm_runtime *rtd)
242 { 268 {
243 size_t size = kirkwood_dma_snd_hw.buff <<
244 struct snd_card *card = rtd->card->snd 269 struct snd_card *card = rtd->card->snd_card;
>> 270 struct snd_pcm *pcm = rtd->pcm;
245 int ret; 271 int ret;
246 272
247 ret = dma_coerce_mask_and_coherent(car 273 ret = dma_coerce_mask_and_coherent(card->dev, DMA_BIT_MASK(32));
248 if (ret) 274 if (ret)
249 return ret; 275 return ret;
250 276
251 snd_pcm_set_managed_buffer_all(rtd->pc !! 277 if (pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream) {
252 card->d !! 278 ret = kirkwood_dma_preallocate_dma_buffer(pcm,
>> 279 SNDRV_PCM_STREAM_PLAYBACK);
>> 280 if (ret)
>> 281 return ret;
>> 282 }
>> 283
>> 284 if (pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream) {
>> 285 ret = kirkwood_dma_preallocate_dma_buffer(pcm,
>> 286 SNDRV_PCM_STREAM_CAPTURE);
>> 287 if (ret)
>> 288 return ret;
>> 289 }
253 290
254 return 0; 291 return 0;
255 } 292 }
256 293
>> 294 static void kirkwood_dma_free_dma_buffers(struct snd_soc_component *component,
>> 295 struct snd_pcm *pcm)
>> 296 {
>> 297 struct snd_pcm_substream *substream;
>> 298 struct snd_dma_buffer *buf;
>> 299 int stream;
>> 300
>> 301 for (stream = 0; stream < 2; stream++) {
>> 302 substream = pcm->streams[stream].substream;
>> 303 if (!substream)
>> 304 continue;
>> 305 buf = &substream->dma_buffer;
>> 306 if (!buf->area)
>> 307 continue;
>> 308
>> 309 dma_free_coherent(pcm->card->dev, buf->bytes,
>> 310 buf->area, buf->addr);
>> 311 buf->area = NULL;
>> 312 }
>> 313 }
>> 314
257 const struct snd_soc_component_driver kirkwood 315 const struct snd_soc_component_driver kirkwood_soc_component = {
258 .name = DRV_NAME, 316 .name = DRV_NAME,
259 .open = kirkwood_dma_open, 317 .open = kirkwood_dma_open,
260 .close = kirkwood_dma_close, 318 .close = kirkwood_dma_close,
261 .hw_params = kirkwood_dma_hw_para 319 .hw_params = kirkwood_dma_hw_params,
>> 320 .hw_free = kirkwood_dma_hw_free,
262 .prepare = kirkwood_dma_prepare 321 .prepare = kirkwood_dma_prepare,
263 .pointer = kirkwood_dma_pointer 322 .pointer = kirkwood_dma_pointer,
264 .pcm_construct = kirkwood_dma_new, 323 .pcm_construct = kirkwood_dma_new,
>> 324 .pcm_destruct = kirkwood_dma_free_dma_buffers,
265 }; 325 };
266 326
Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.