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