1
2
3
4
5
6
7
8
9
10#include <linux/io.h>
11#include <linux/interrupt.h>
12#include <linux/module.h>
13#include <linux/platform_device.h>
14#include <drm/bridge/dw_hdmi.h>
15#include <drm/drm_edid.h>
16
17#include <sound/asoundef.h>
18#include <sound/core.h>
19#include <sound/initval.h>
20#include <sound/pcm.h>
21#include <sound/pcm_drm_eld.h>
22#include <sound/pcm_iec958.h>
23
24#include "dw-hdmi-audio.h"
25
26#define DRIVER_NAME "dw-hdmi-ahb-audio"
27
28
29enum {
30 HDMI_AHB_DMA_CONF0_SW_FIFO_RST = BIT(7),
31 HDMI_AHB_DMA_CONF0_EN_HLOCK = BIT(3),
32 HDMI_AHB_DMA_START_START = BIT(0),
33 HDMI_AHB_DMA_STOP_STOP = BIT(0),
34 HDMI_IH_MUTE_AHBDMAAUD_STAT0_ERROR = BIT(5),
35 HDMI_IH_MUTE_AHBDMAAUD_STAT0_LOST = BIT(4),
36 HDMI_IH_MUTE_AHBDMAAUD_STAT0_RETRY = BIT(3),
37 HDMI_IH_MUTE_AHBDMAAUD_STAT0_DONE = BIT(2),
38 HDMI_IH_MUTE_AHBDMAAUD_STAT0_BUFFFULL = BIT(1),
39 HDMI_IH_MUTE_AHBDMAAUD_STAT0_BUFFEMPTY = BIT(0),
40 HDMI_IH_MUTE_AHBDMAAUD_STAT0_ALL =
41 HDMI_IH_MUTE_AHBDMAAUD_STAT0_ERROR |
42 HDMI_IH_MUTE_AHBDMAAUD_STAT0_LOST |
43 HDMI_IH_MUTE_AHBDMAAUD_STAT0_RETRY |
44 HDMI_IH_MUTE_AHBDMAAUD_STAT0_DONE |
45 HDMI_IH_MUTE_AHBDMAAUD_STAT0_BUFFFULL |
46 HDMI_IH_MUTE_AHBDMAAUD_STAT0_BUFFEMPTY,
47 HDMI_IH_AHBDMAAUD_STAT0_ERROR = BIT(5),
48 HDMI_IH_AHBDMAAUD_STAT0_LOST = BIT(4),
49 HDMI_IH_AHBDMAAUD_STAT0_RETRY = BIT(3),
50 HDMI_IH_AHBDMAAUD_STAT0_DONE = BIT(2),
51 HDMI_IH_AHBDMAAUD_STAT0_BUFFFULL = BIT(1),
52 HDMI_IH_AHBDMAAUD_STAT0_BUFFEMPTY = BIT(0),
53 HDMI_IH_AHBDMAAUD_STAT0_ALL =
54 HDMI_IH_AHBDMAAUD_STAT0_ERROR |
55 HDMI_IH_AHBDMAAUD_STAT0_LOST |
56 HDMI_IH_AHBDMAAUD_STAT0_RETRY |
57 HDMI_IH_AHBDMAAUD_STAT0_DONE |
58 HDMI_IH_AHBDMAAUD_STAT0_BUFFFULL |
59 HDMI_IH_AHBDMAAUD_STAT0_BUFFEMPTY,
60 HDMI_AHB_DMA_CONF0_INCR16 = 2 << 1,
61 HDMI_AHB_DMA_CONF0_INCR8 = 1 << 1,
62 HDMI_AHB_DMA_CONF0_INCR4 = 0,
63 HDMI_AHB_DMA_CONF0_BURST_MODE = BIT(0),
64 HDMI_AHB_DMA_MASK_DONE = BIT(7),
65
66 HDMI_REVISION_ID = 0x0001,
67 HDMI_IH_AHBDMAAUD_STAT0 = 0x0109,
68 HDMI_IH_MUTE_AHBDMAAUD_STAT0 = 0x0189,
69 HDMI_FC_AUDICONF2 = 0x1027,
70 HDMI_FC_AUDSCONF = 0x1063,
71 HDMI_FC_AUDSCONF_LAYOUT1 = 1 << 0,
72 HDMI_FC_AUDSCONF_LAYOUT0 = 0 << 0,
73 HDMI_AHB_DMA_CONF0 = 0x3600,
74 HDMI_AHB_DMA_START = 0x3601,
75 HDMI_AHB_DMA_STOP = 0x3602,
76 HDMI_AHB_DMA_THRSLD = 0x3603,
77 HDMI_AHB_DMA_STRADDR0 = 0x3604,
78 HDMI_AHB_DMA_STPADDR0 = 0x3608,
79 HDMI_AHB_DMA_MASK = 0x3614,
80 HDMI_AHB_DMA_POL = 0x3615,
81 HDMI_AHB_DMA_CONF1 = 0x3616,
82 HDMI_AHB_DMA_BUFFPOL = 0x361a,
83};
84
85struct dw_hdmi_channel_conf {
86 u8 conf1;
87 u8 ca;
88};
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113static struct dw_hdmi_channel_conf default_hdmi_channel_config[7] = {
114 { 0x03, 0x00 },
115 { 0x0b, 0x02 },
116 { 0x33, 0x08 },
117 { 0x37, 0x09 },
118 { 0x3f, 0x0b },
119 { 0x7f, 0x0f },
120 { 0xff, 0x13 },
121};
122
123struct snd_dw_hdmi {
124 struct snd_card *card;
125 struct snd_pcm *pcm;
126 spinlock_t lock;
127 struct dw_hdmi_audio_data data;
128 struct snd_pcm_substream *substream;
129 void (*reformat)(struct snd_dw_hdmi *, size_t, size_t);
130 void *buf_src;
131 void *buf_dst;
132 dma_addr_t buf_addr;
133 unsigned buf_offset;
134 unsigned buf_period;
135 unsigned buf_size;
136 unsigned channels;
137 u8 revision;
138 u8 iec_offset;
139 u8 cs[192][8];
140};
141
142static void dw_hdmi_writel(u32 val, void __iomem *ptr)
143{
144 writeb_relaxed(val, ptr);
145 writeb_relaxed(val >> 8, ptr + 1);
146 writeb_relaxed(val >> 16, ptr + 2);
147 writeb_relaxed(val >> 24, ptr + 3);
148}
149
150
151
152
153
154
155
156
157
158
159
160static void dw_hdmi_reformat_iec958(struct snd_dw_hdmi *dw,
161 size_t offset, size_t bytes)
162{
163 u32 *src = dw->buf_src + offset;
164 u32 *dst = dw->buf_dst + offset;
165 u32 *end = dw->buf_src + offset + bytes;
166
167 do {
168 u32 b, sample = *src++;
169
170 b = (sample & 8) << (28 - 3);
171
172 sample >>= 4;
173
174 *dst++ = sample | b;
175 } while (src < end);
176}
177
178static u32 parity(u32 sample)
179{
180 sample ^= sample >> 16;
181 sample ^= sample >> 8;
182 sample ^= sample >> 4;
183 sample ^= sample >> 2;
184 sample ^= sample >> 1;
185 return (sample & 1) << 27;
186}
187
188static void dw_hdmi_reformat_s24(struct snd_dw_hdmi *dw,
189 size_t offset, size_t bytes)
190{
191 u32 *src = dw->buf_src + offset;
192 u32 *dst = dw->buf_dst + offset;
193 u32 *end = dw->buf_src + offset + bytes;
194
195 do {
196 unsigned i;
197 u8 *cs;
198
199 cs = dw->cs[dw->iec_offset++];
200 if (dw->iec_offset >= 192)
201 dw->iec_offset = 0;
202
203 i = dw->channels;
204 do {
205 u32 sample = *src++;
206
207 sample &= ~0xff000000;
208 sample |= *cs++ << 24;
209 sample |= parity(sample & ~0xf8000000);
210
211 *dst++ = sample;
212 } while (--i);
213 } while (src < end);
214}
215
216static void dw_hdmi_create_cs(struct snd_dw_hdmi *dw,
217 struct snd_pcm_runtime *runtime)
218{
219 u8 cs[4];
220 unsigned ch, i, j;
221
222 snd_pcm_create_iec958_consumer(runtime, cs, sizeof(cs));
223
224 memset(dw->cs, 0, sizeof(dw->cs));
225
226 for (ch = 0; ch < 8; ch++) {
227 cs[2] &= ~IEC958_AES2_CON_CHANNEL;
228 cs[2] |= (ch + 1) << 4;
229
230 for (i = 0; i < ARRAY_SIZE(cs); i++) {
231 unsigned c = cs[i];
232
233 for (j = 0; j < 8; j++, c >>= 1)
234 dw->cs[i * 8 + j][ch] = (c & 1) << 2;
235 }
236 }
237 dw->cs[0][0] |= BIT(4);
238}
239
240static void dw_hdmi_start_dma(struct snd_dw_hdmi *dw)
241{
242 void __iomem *base = dw->data.base;
243 unsigned offset = dw->buf_offset;
244 unsigned period = dw->buf_period;
245 u32 start, stop;
246
247 dw->reformat(dw, offset, period);
248
249
250 writeb_relaxed(HDMI_IH_AHBDMAAUD_STAT0_ALL,
251 base + HDMI_IH_AHBDMAAUD_STAT0);
252
253 start = dw->buf_addr + offset;
254 stop = start + period - 1;
255
256
257 dw_hdmi_writel(start, base + HDMI_AHB_DMA_STRADDR0);
258 dw_hdmi_writel(stop, base + HDMI_AHB_DMA_STPADDR0);
259
260 writeb_relaxed((u8)~HDMI_AHB_DMA_MASK_DONE, base + HDMI_AHB_DMA_MASK);
261 writeb(HDMI_AHB_DMA_START_START, base + HDMI_AHB_DMA_START);
262
263 offset += period;
264 if (offset >= dw->buf_size)
265 offset = 0;
266 dw->buf_offset = offset;
267}
268
269static void dw_hdmi_stop_dma(struct snd_dw_hdmi *dw)
270{
271
272 writeb_relaxed(~0, dw->data.base + HDMI_AHB_DMA_MASK);
273 writeb_relaxed(HDMI_AHB_DMA_STOP_STOP, dw->data.base + HDMI_AHB_DMA_STOP);
274}
275
276static irqreturn_t snd_dw_hdmi_irq(int irq, void *data)
277{
278 struct snd_dw_hdmi *dw = data;
279 struct snd_pcm_substream *substream;
280 unsigned stat;
281
282 stat = readb_relaxed(dw->data.base + HDMI_IH_AHBDMAAUD_STAT0);
283 if (!stat)
284 return IRQ_NONE;
285
286 writeb_relaxed(stat, dw->data.base + HDMI_IH_AHBDMAAUD_STAT0);
287
288 substream = dw->substream;
289 if (stat & HDMI_IH_AHBDMAAUD_STAT0_DONE && substream) {
290 snd_pcm_period_elapsed(substream);
291
292 spin_lock(&dw->lock);
293 if (dw->substream)
294 dw_hdmi_start_dma(dw);
295 spin_unlock(&dw->lock);
296 }
297
298 return IRQ_HANDLED;
299}
300
301static struct snd_pcm_hardware dw_hdmi_hw = {
302 .info = SNDRV_PCM_INFO_INTERLEAVED |
303 SNDRV_PCM_INFO_BLOCK_TRANSFER |
304 SNDRV_PCM_INFO_MMAP |
305 SNDRV_PCM_INFO_MMAP_VALID,
306 .formats = SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE |
307 SNDRV_PCM_FMTBIT_S24_LE,
308 .rates = SNDRV_PCM_RATE_32000 |
309 SNDRV_PCM_RATE_44100 |
310 SNDRV_PCM_RATE_48000 |
311 SNDRV_PCM_RATE_88200 |
312 SNDRV_PCM_RATE_96000 |
313 SNDRV_PCM_RATE_176400 |
314 SNDRV_PCM_RATE_192000,
315 .channels_min = 2,
316 .channels_max = 8,
317 .buffer_bytes_max = 1024 * 1024,
318 .period_bytes_min = 256,
319 .period_bytes_max = 8192,
320 .periods_min = 2,
321 .periods_max = 16,
322 .fifo_size = 0,
323};
324
325static int dw_hdmi_open(struct snd_pcm_substream *substream)
326{
327 struct snd_pcm_runtime *runtime = substream->runtime;
328 struct snd_dw_hdmi *dw = substream->private_data;
329 void __iomem *base = dw->data.base;
330 int ret;
331
332 runtime->hw = dw_hdmi_hw;
333
334 ret = snd_pcm_hw_constraint_eld(runtime, dw->data.eld);
335 if (ret < 0)
336 return ret;
337
338 ret = snd_pcm_limit_hw_rates(runtime);
339 if (ret < 0)
340 return ret;
341
342 ret = snd_pcm_hw_constraint_integer(runtime,
343 SNDRV_PCM_HW_PARAM_PERIODS);
344 if (ret < 0)
345 return ret;
346
347
348 ret = snd_pcm_hw_constraint_minmax(runtime,
349 SNDRV_PCM_HW_PARAM_BUFFER_SIZE,
350 0, substream->dma_buffer.bytes);
351 if (ret < 0)
352 return ret;
353
354
355 writeb_relaxed(HDMI_AHB_DMA_CONF0_SW_FIFO_RST,
356 base + HDMI_AHB_DMA_CONF0);
357
358
359 writeb_relaxed(~0, base + HDMI_AHB_DMA_POL);
360 writeb_relaxed(~0, base + HDMI_AHB_DMA_BUFFPOL);
361
362
363 writeb_relaxed(~0, base + HDMI_AHB_DMA_MASK);
364 writeb_relaxed(~0, base + HDMI_IH_AHBDMAAUD_STAT0);
365
366 ret = request_irq(dw->data.irq, snd_dw_hdmi_irq, IRQF_SHARED,
367 "dw-hdmi-audio", dw);
368 if (ret)
369 return ret;
370
371
372 writeb_relaxed(HDMI_IH_MUTE_AHBDMAAUD_STAT0_ALL &
373 ~HDMI_IH_MUTE_AHBDMAAUD_STAT0_DONE,
374 base + HDMI_IH_MUTE_AHBDMAAUD_STAT0);
375
376 return 0;
377}
378
379static int dw_hdmi_close(struct snd_pcm_substream *substream)
380{
381 struct snd_dw_hdmi *dw = substream->private_data;
382
383
384 writeb_relaxed(HDMI_IH_MUTE_AHBDMAAUD_STAT0_ALL,
385 dw->data.base + HDMI_IH_MUTE_AHBDMAAUD_STAT0);
386
387 free_irq(dw->data.irq, dw);
388
389 return 0;
390}
391
392static int dw_hdmi_hw_free(struct snd_pcm_substream *substream)
393{
394 return snd_pcm_lib_free_vmalloc_buffer(substream);
395}
396
397static int dw_hdmi_hw_params(struct snd_pcm_substream *substream,
398 struct snd_pcm_hw_params *params)
399{
400
401 return snd_pcm_lib_alloc_vmalloc_buffer(substream,
402 params_buffer_bytes(params));
403}
404
405static int dw_hdmi_prepare(struct snd_pcm_substream *substream)
406{
407 struct snd_pcm_runtime *runtime = substream->runtime;
408 struct snd_dw_hdmi *dw = substream->private_data;
409 u8 threshold, conf0, conf1, layout, ca;
410
411
412 switch (dw->revision) {
413 case 0x0a:
414 conf0 = HDMI_AHB_DMA_CONF0_BURST_MODE |
415 HDMI_AHB_DMA_CONF0_INCR4;
416 if (runtime->channels == 2)
417 threshold = 126;
418 else
419 threshold = 124;
420 break;
421 case 0x1a:
422 conf0 = HDMI_AHB_DMA_CONF0_BURST_MODE |
423 HDMI_AHB_DMA_CONF0_INCR8;
424 threshold = 128;
425 break;
426 default:
427
428 return -EINVAL;
429 }
430
431 dw_hdmi_set_sample_rate(dw->data.hdmi, runtime->rate);
432
433
434 runtime->hw.fifo_size = threshold * 32;
435
436 conf0 |= HDMI_AHB_DMA_CONF0_EN_HLOCK;
437 conf1 = default_hdmi_channel_config[runtime->channels - 2].conf1;
438 ca = default_hdmi_channel_config[runtime->channels - 2].ca;
439
440
441
442
443
444 if (runtime->channels > 2)
445 layout = HDMI_FC_AUDSCONF_LAYOUT1;
446 else
447 layout = HDMI_FC_AUDSCONF_LAYOUT0;
448
449 writeb_relaxed(threshold, dw->data.base + HDMI_AHB_DMA_THRSLD);
450 writeb_relaxed(conf0, dw->data.base + HDMI_AHB_DMA_CONF0);
451 writeb_relaxed(conf1, dw->data.base + HDMI_AHB_DMA_CONF1);
452 writeb_relaxed(layout, dw->data.base + HDMI_FC_AUDSCONF);
453 writeb_relaxed(ca, dw->data.base + HDMI_FC_AUDICONF2);
454
455 switch (runtime->format) {
456 case SNDRV_PCM_FORMAT_IEC958_SUBFRAME_LE:
457 dw->reformat = dw_hdmi_reformat_iec958;
458 break;
459 case SNDRV_PCM_FORMAT_S24_LE:
460 dw_hdmi_create_cs(dw, runtime);
461 dw->reformat = dw_hdmi_reformat_s24;
462 break;
463 }
464 dw->iec_offset = 0;
465 dw->channels = runtime->channels;
466 dw->buf_src = runtime->dma_area;
467 dw->buf_dst = substream->dma_buffer.area;
468 dw->buf_addr = substream->dma_buffer.addr;
469 dw->buf_period = snd_pcm_lib_period_bytes(substream);
470 dw->buf_size = snd_pcm_lib_buffer_bytes(substream);
471
472 return 0;
473}
474
475static int dw_hdmi_trigger(struct snd_pcm_substream *substream, int cmd)
476{
477 struct snd_dw_hdmi *dw = substream->private_data;
478 unsigned long flags;
479 int ret = 0;
480
481 switch (cmd) {
482 case SNDRV_PCM_TRIGGER_START:
483 spin_lock_irqsave(&dw->lock, flags);
484 dw->buf_offset = 0;
485 dw->substream = substream;
486 dw_hdmi_start_dma(dw);
487 dw_hdmi_audio_enable(dw->data.hdmi);
488 spin_unlock_irqrestore(&dw->lock, flags);
489 substream->runtime->delay = substream->runtime->period_size;
490 break;
491
492 case SNDRV_PCM_TRIGGER_STOP:
493 spin_lock_irqsave(&dw->lock, flags);
494 dw->substream = NULL;
495 dw_hdmi_stop_dma(dw);
496 dw_hdmi_audio_disable(dw->data.hdmi);
497 spin_unlock_irqrestore(&dw->lock, flags);
498 break;
499
500 default:
501 ret = -EINVAL;
502 break;
503 }
504
505 return ret;
506}
507
508static snd_pcm_uframes_t dw_hdmi_pointer(struct snd_pcm_substream *substream)
509{
510 struct snd_pcm_runtime *runtime = substream->runtime;
511 struct snd_dw_hdmi *dw = substream->private_data;
512
513
514
515
516
517 return bytes_to_frames(runtime, dw->buf_offset);
518}
519
520static const struct snd_pcm_ops snd_dw_hdmi_ops = {
521 .open = dw_hdmi_open,
522 .close = dw_hdmi_close,
523 .ioctl = snd_pcm_lib_ioctl,
524 .hw_params = dw_hdmi_hw_params,
525 .hw_free = dw_hdmi_hw_free,
526 .prepare = dw_hdmi_prepare,
527 .trigger = dw_hdmi_trigger,
528 .pointer = dw_hdmi_pointer,
529 .page = snd_pcm_lib_get_vmalloc_page,
530};
531
532static int snd_dw_hdmi_probe(struct platform_device *pdev)
533{
534 const struct dw_hdmi_audio_data *data = pdev->dev.platform_data;
535 struct device *dev = pdev->dev.parent;
536 struct snd_dw_hdmi *dw;
537 struct snd_card *card;
538 struct snd_pcm *pcm;
539 unsigned revision;
540 int ret;
541
542 writeb_relaxed(HDMI_IH_MUTE_AHBDMAAUD_STAT0_ALL,
543 data->base + HDMI_IH_MUTE_AHBDMAAUD_STAT0);
544 revision = readb_relaxed(data->base + HDMI_REVISION_ID);
545 if (revision != 0x0a && revision != 0x1a) {
546 dev_err(dev, "dw-hdmi-audio: unknown revision 0x%02x\n",
547 revision);
548 return -ENXIO;
549 }
550
551 ret = snd_card_new(dev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
552 THIS_MODULE, sizeof(struct snd_dw_hdmi), &card);
553 if (ret < 0)
554 return ret;
555
556 strlcpy(card->driver, DRIVER_NAME, sizeof(card->driver));
557 strlcpy(card->shortname, "DW-HDMI", sizeof(card->shortname));
558 snprintf(card->longname, sizeof(card->longname),
559 "%s rev 0x%02x, irq %d", card->shortname, revision,
560 data->irq);
561
562 dw = card->private_data;
563 dw->card = card;
564 dw->data = *data;
565 dw->revision = revision;
566
567 spin_lock_init(&dw->lock);
568
569 ret = snd_pcm_new(card, "DW HDMI", 0, 1, 0, &pcm);
570 if (ret < 0)
571 goto err;
572
573 dw->pcm = pcm;
574 pcm->private_data = dw;
575 strlcpy(pcm->name, DRIVER_NAME, sizeof(pcm->name));
576 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &snd_dw_hdmi_ops);
577
578
579
580
581
582 snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
583 dev, 128 * 1024, 1024 * 1024);
584
585 ret = snd_card_register(card);
586 if (ret < 0)
587 goto err;
588
589 platform_set_drvdata(pdev, dw);
590
591 return 0;
592
593err:
594 snd_card_free(card);
595 return ret;
596}
597
598static int snd_dw_hdmi_remove(struct platform_device *pdev)
599{
600 struct snd_dw_hdmi *dw = platform_get_drvdata(pdev);
601
602 snd_card_free(dw->card);
603
604 return 0;
605}
606
607#if defined(CONFIG_PM_SLEEP) && defined(IS_NOT_BROKEN)
608
609
610
611
612static int snd_dw_hdmi_suspend(struct device *dev)
613{
614 struct snd_dw_hdmi *dw = dev_get_drvdata(dev);
615
616 snd_power_change_state(dw->card, SNDRV_CTL_POWER_D3cold);
617 snd_pcm_suspend_all(dw->pcm);
618
619 return 0;
620}
621
622static int snd_dw_hdmi_resume(struct device *dev)
623{
624 struct snd_dw_hdmi *dw = dev_get_drvdata(dev);
625
626 snd_power_change_state(dw->card, SNDRV_CTL_POWER_D0);
627
628 return 0;
629}
630
631static SIMPLE_DEV_PM_OPS(snd_dw_hdmi_pm, snd_dw_hdmi_suspend,
632 snd_dw_hdmi_resume);
633#define PM_OPS &snd_dw_hdmi_pm
634#else
635#define PM_OPS NULL
636#endif
637
638static struct platform_driver snd_dw_hdmi_driver = {
639 .probe = snd_dw_hdmi_probe,
640 .remove = snd_dw_hdmi_remove,
641 .driver = {
642 .name = DRIVER_NAME,
643 .pm = PM_OPS,
644 },
645};
646
647module_platform_driver(snd_dw_hdmi_driver);
648
649MODULE_AUTHOR("Russell King <rmk+kernel@arm.linux.org.uk>");
650MODULE_DESCRIPTION("Synopsis Designware HDMI AHB ALSA interface");
651MODULE_LICENSE("GPL v2");
652MODULE_ALIAS("platform:" DRIVER_NAME);
653
