22 #include "dw-hdmi-audio.h"
24 #define DRIVER_NAME "dw-hdmi-ahb-audio"
154 static void dw_hdmi_reformat_iec958(struct snd_dw_hdmi *dw,  in dw_hdmi_reformat_iec958()  argument
157 	u32 *src = dw->buf_src + offset;  in dw_hdmi_reformat_iec958()
158 	u32 *dst = dw->buf_dst + offset;  in dw_hdmi_reformat_iec958()
159 	u32 *end = dw->buf_src + offset + bytes;  in dw_hdmi_reformat_iec958()
182 static void dw_hdmi_reformat_s24(struct snd_dw_hdmi *dw,  in dw_hdmi_reformat_s24()  argument
185 	u32 *src = dw->buf_src + offset;  in dw_hdmi_reformat_s24()
186 	u32 *dst = dw->buf_dst + offset;  in dw_hdmi_reformat_s24()
187 	u32 *end = dw->buf_src + offset + bytes;  in dw_hdmi_reformat_s24()
193 		cs = dw->cs[dw->iec_offset++];  in dw_hdmi_reformat_s24()
194 		if (dw->iec_offset >= 192)  in dw_hdmi_reformat_s24()
195 			dw->iec_offset = 0;  in dw_hdmi_reformat_s24()
197 		i = dw->channels;  in dw_hdmi_reformat_s24()
210 static void dw_hdmi_create_cs(struct snd_dw_hdmi *dw,  in dw_hdmi_create_cs()  argument
218 	memset(dw->cs, 0, sizeof(dw->cs));  in dw_hdmi_create_cs()
228 				dw->cs[i * 8 + j][ch] = (c & 1) << 2;  in dw_hdmi_create_cs()
231 	dw->cs[0][0] |= BIT(4);  in dw_hdmi_create_cs()
234 static void dw_hdmi_start_dma(struct snd_dw_hdmi *dw)  in dw_hdmi_start_dma()  argument
236 	void __iomem *base = dw->data.base;  in dw_hdmi_start_dma()
237 	unsigned offset = dw->buf_offset;  in dw_hdmi_start_dma()
238 	unsigned period = dw->buf_period;  in dw_hdmi_start_dma()
241 	dw->reformat(dw, offset, period);  in dw_hdmi_start_dma()
247 	start = dw->buf_addr + offset;  in dw_hdmi_start_dma()
258 	if (offset >= dw->buf_size)  in dw_hdmi_start_dma()
260 	dw->buf_offset = offset;  in dw_hdmi_start_dma()
263 static void dw_hdmi_stop_dma(struct snd_dw_hdmi *dw)  in dw_hdmi_stop_dma()  argument
266 	writeb_relaxed(~0, dw->data.base + HDMI_AHB_DMA_MASK);  in dw_hdmi_stop_dma()
267 	writeb_relaxed(HDMI_AHB_DMA_STOP_STOP, dw->data.base + HDMI_AHB_DMA_STOP);  in dw_hdmi_stop_dma()
272 	struct snd_dw_hdmi *dw = data;  in snd_dw_hdmi_irq()  local
276 	stat = readb_relaxed(dw->data.base + HDMI_IH_AHBDMAAUD_STAT0);  in snd_dw_hdmi_irq()
280 	writeb_relaxed(stat, dw->data.base + HDMI_IH_AHBDMAAUD_STAT0);  in snd_dw_hdmi_irq()
282 	substream = dw->substream;  in snd_dw_hdmi_irq()
286 		spin_lock(&dw->lock);  in snd_dw_hdmi_irq()
287 		if (dw->substream)  in snd_dw_hdmi_irq()
288 			dw_hdmi_start_dma(dw);  in snd_dw_hdmi_irq()
289 		spin_unlock(&dw->lock);  in snd_dw_hdmi_irq()
322 	struct snd_dw_hdmi *dw = substream->private_data;  in dw_hdmi_open()  local
323 	void __iomem *base = dw->data.base;  in dw_hdmi_open()
329 	eld = dw->data.get_eld(dw->data.hdmi);  in dw_hdmi_open()
364 	ret = request_irq(dw->data.irq, snd_dw_hdmi_irq, IRQF_SHARED,  in dw_hdmi_open()
365 			  "dw-hdmi-audio", dw);  in dw_hdmi_open()
379 	struct snd_dw_hdmi *dw = substream->private_data;  in dw_hdmi_close()  local
383 		       dw->data.base + HDMI_IH_MUTE_AHBDMAAUD_STAT0);  in dw_hdmi_close()
385 	free_irq(dw->data.irq, dw);  in dw_hdmi_close()
427 	struct snd_dw_hdmi *dw = substream->private_data;  in dw_hdmi_prepare()  local
431 	switch (dw->revision) {  in dw_hdmi_prepare()
450 	dw_hdmi_set_sample_rate(dw->data.hdmi, runtime->rate);  in dw_hdmi_prepare()
459 	writeb_relaxed(threshold, dw->data.base + HDMI_AHB_DMA_THRSLD);  in dw_hdmi_prepare()
460 	writeb_relaxed(conf0, dw->data.base + HDMI_AHB_DMA_CONF0);  in dw_hdmi_prepare()
461 	writeb_relaxed(conf1, dw->data.base + HDMI_AHB_DMA_CONF1);  in dw_hdmi_prepare()
463 	dw_hdmi_set_channel_count(dw->data.hdmi, runtime->channels);  in dw_hdmi_prepare()
464 	dw_hdmi_set_channel_allocation(dw->data.hdmi, ca);  in dw_hdmi_prepare()
468 		dw->reformat = dw_hdmi_reformat_iec958;  in dw_hdmi_prepare()
471 		dw_hdmi_create_cs(dw, runtime);  in dw_hdmi_prepare()
472 		dw->reformat = dw_hdmi_reformat_s24;  in dw_hdmi_prepare()
475 	dw->iec_offset = 0;  in dw_hdmi_prepare()
476 	dw->channels = runtime->channels;  in dw_hdmi_prepare()
477 	dw->buf_src  = runtime->dma_area;  in dw_hdmi_prepare()
478 	dw->buf_dst  = substream->dma_buffer.area;  in dw_hdmi_prepare()
479 	dw->buf_addr = substream->dma_buffer.addr;  in dw_hdmi_prepare()
480 	dw->buf_period = snd_pcm_lib_period_bytes(substream);  in dw_hdmi_prepare()
481 	dw->buf_size = snd_pcm_lib_buffer_bytes(substream);  in dw_hdmi_prepare()
488 	struct snd_dw_hdmi *dw = substream->private_data;  in dw_hdmi_trigger()  local
494 		spin_lock_irqsave(&dw->lock, flags);  in dw_hdmi_trigger()
495 		dw->buf_offset = 0;  in dw_hdmi_trigger()
496 		dw->substream = substream;  in dw_hdmi_trigger()
497 		dw_hdmi_start_dma(dw);  in dw_hdmi_trigger()
498 		dw_hdmi_audio_enable(dw->data.hdmi);  in dw_hdmi_trigger()
499 		spin_unlock_irqrestore(&dw->lock, flags);  in dw_hdmi_trigger()
504 		spin_lock_irqsave(&dw->lock, flags);  in dw_hdmi_trigger()
505 		dw->substream = NULL;  in dw_hdmi_trigger()
506 		dw_hdmi_stop_dma(dw);  in dw_hdmi_trigger()
507 		dw_hdmi_audio_disable(dw->data.hdmi);  in dw_hdmi_trigger()
508 		spin_unlock_irqrestore(&dw->lock, flags);  in dw_hdmi_trigger()
522 	struct snd_dw_hdmi *dw = substream->private_data;  in dw_hdmi_pointer()  local
528 	return bytes_to_frames(runtime, dw->buf_offset);  in dw_hdmi_pointer()
547 	struct snd_dw_hdmi *dw;  in snd_dw_hdmi_probe()  local
557 		dev_err(dev, "dw-hdmi-audio: unknown revision 0x%02x\n",  in snd_dw_hdmi_probe()
568 	strscpy(card->shortname, "DW-HDMI", sizeof(card->shortname));  in snd_dw_hdmi_probe()
573 	dw = card->private_data;  in snd_dw_hdmi_probe()
574 	dw->card = card;  in snd_dw_hdmi_probe()
575 	dw->data = *data;  in snd_dw_hdmi_probe()
576 	dw->revision = revision;  in snd_dw_hdmi_probe()
578 	spin_lock_init(&dw->lock);  in snd_dw_hdmi_probe()
580 	ret = snd_pcm_new(card, "DW HDMI", 0, 1, 0, &pcm);  in snd_dw_hdmi_probe()
584 	dw->pcm = pcm;  in snd_dw_hdmi_probe()
585 	pcm->private_data = dw;  in snd_dw_hdmi_probe()
600 	platform_set_drvdata(pdev, dw);  in snd_dw_hdmi_probe()
611 	struct snd_dw_hdmi *dw = platform_get_drvdata(pdev);  in snd_dw_hdmi_remove()  local
613 	snd_card_free(dw->card);  in snd_dw_hdmi_remove()
623 	struct snd_dw_hdmi *dw = dev_get_drvdata(dev);  in snd_dw_hdmi_suspend()  local
625 	snd_power_change_state(dw->card, SNDRV_CTL_POWER_D3cold);  in snd_dw_hdmi_suspend()
632 	struct snd_dw_hdmi *dw = dev_get_drvdata(dev);  in snd_dw_hdmi_resume()  local
634 	snd_power_change_state(dw->card, SNDRV_CTL_POWER_D0);  in snd_dw_hdmi_resume()