1 /*
2  * dw-hdmi-i2s-audio.c
3  *
4  * Copyright (c) 2017 Renesas Solutions Corp.
5  * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License version 2 as
9  * published by the Free Software Foundation.
10  */
11 #include <drm/bridge/dw_hdmi.h>
12 
13 #include <sound/hdmi-codec.h>
14 
15 #include "dw-hdmi.h"
16 #include "dw-hdmi-audio.h"
17 
18 #define DRIVER_NAME "dw-hdmi-i2s-audio"
19 
20 static inline void hdmi_write(struct dw_hdmi_i2s_audio_data *audio,
21 			      u8 val, int offset)
22 {
23 	struct dw_hdmi *hdmi = audio->hdmi;
24 
25 	audio->write(hdmi, val, offset);
26 }
27 
28 static inline u8 hdmi_read(struct dw_hdmi_i2s_audio_data *audio, int offset)
29 {
30 	struct dw_hdmi *hdmi = audio->hdmi;
31 
32 	return audio->read(hdmi, offset);
33 }
34 
35 static int dw_hdmi_i2s_hw_params(struct device *dev, void *data,
36 				 struct hdmi_codec_daifmt *fmt,
37 				 struct hdmi_codec_params *hparms)
38 {
39 	struct dw_hdmi_i2s_audio_data *audio = data;
40 	struct dw_hdmi *hdmi = audio->hdmi;
41 	u8 conf0 = 0;
42 	u8 conf1 = 0;
43 	u8 inputclkfs = 0;
44 
45 	/* it cares I2S only */
46 	if ((fmt->fmt != HDMI_I2S) ||
47 	    (fmt->bit_clk_master | fmt->frame_clk_master)) {
48 		dev_err(dev, "unsupported format/settings\n");
49 		return -EINVAL;
50 	}
51 
52 	inputclkfs	= HDMI_AUD_INPUTCLKFS_64FS;
53 	conf0		= HDMI_AUD_CONF0_I2S_ALL_ENABLE;
54 
55 	switch (hparms->sample_width) {
56 	case 16:
57 		conf1 = HDMI_AUD_CONF1_WIDTH_16;
58 		break;
59 	case 24:
60 	case 32:
61 		conf1 = HDMI_AUD_CONF1_WIDTH_24;
62 		break;
63 	}
64 
65 	dw_hdmi_set_sample_rate(hdmi, hparms->sample_rate);
66 
67 	hdmi_write(audio, inputclkfs, HDMI_AUD_INPUTCLKFS);
68 	hdmi_write(audio, conf0, HDMI_AUD_CONF0);
69 	hdmi_write(audio, conf1, HDMI_AUD_CONF1);
70 
71 	dw_hdmi_audio_enable(hdmi);
72 
73 	return 0;
74 }
75 
76 static void dw_hdmi_i2s_audio_shutdown(struct device *dev, void *data)
77 {
78 	struct dw_hdmi_i2s_audio_data *audio = data;
79 	struct dw_hdmi *hdmi = audio->hdmi;
80 
81 	dw_hdmi_audio_disable(hdmi);
82 
83 	hdmi_write(audio, HDMI_AUD_CONF0_SW_RESET, HDMI_AUD_CONF0);
84 }
85 
86 static int dw_hdmi_i2s_get_dai_id(struct snd_soc_component *component,
87 				  struct device_node *endpoint)
88 {
89 	struct of_endpoint of_ep;
90 	int ret;
91 
92 	ret = of_graph_parse_endpoint(endpoint, &of_ep);
93 	if (ret < 0)
94 		return ret;
95 
96 	/*
97 	 * HDMI sound should be located as reg = <2>
98 	 * Then, it is sound port 0
99 	 */
100 	if (of_ep.port == 2)
101 		return 0;
102 
103 	return -EINVAL;
104 }
105 
106 static struct hdmi_codec_ops dw_hdmi_i2s_ops = {
107 	.hw_params	= dw_hdmi_i2s_hw_params,
108 	.audio_shutdown	= dw_hdmi_i2s_audio_shutdown,
109 	.get_dai_id	= dw_hdmi_i2s_get_dai_id,
110 };
111 
112 static int snd_dw_hdmi_probe(struct platform_device *pdev)
113 {
114 	struct dw_hdmi_i2s_audio_data *audio = pdev->dev.platform_data;
115 	struct platform_device_info pdevinfo;
116 	struct hdmi_codec_pdata pdata;
117 	struct platform_device *platform;
118 
119 	pdata.ops		= &dw_hdmi_i2s_ops;
120 	pdata.i2s		= 1;
121 	pdata.max_i2s_channels	= 6;
122 	pdata.data		= audio;
123 
124 	memset(&pdevinfo, 0, sizeof(pdevinfo));
125 	pdevinfo.parent		= pdev->dev.parent;
126 	pdevinfo.id		= PLATFORM_DEVID_AUTO;
127 	pdevinfo.name		= HDMI_CODEC_DRV_NAME;
128 	pdevinfo.data		= &pdata;
129 	pdevinfo.size_data	= sizeof(pdata);
130 	pdevinfo.dma_mask	= DMA_BIT_MASK(32);
131 
132 	platform = platform_device_register_full(&pdevinfo);
133 	if (IS_ERR(platform))
134 		return PTR_ERR(platform);
135 
136 	dev_set_drvdata(&pdev->dev, platform);
137 
138 	return 0;
139 }
140 
141 static int snd_dw_hdmi_remove(struct platform_device *pdev)
142 {
143 	struct platform_device *platform = dev_get_drvdata(&pdev->dev);
144 
145 	platform_device_unregister(platform);
146 
147 	return 0;
148 }
149 
150 static struct platform_driver snd_dw_hdmi_driver = {
151 	.probe	= snd_dw_hdmi_probe,
152 	.remove	= snd_dw_hdmi_remove,
153 	.driver	= {
154 		.name = DRIVER_NAME,
155 	},
156 };
157 module_platform_driver(snd_dw_hdmi_driver);
158 
159 MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>");
160 MODULE_DESCRIPTION("Synopsis Designware HDMI I2S ALSA SoC interface");
161 MODULE_LICENSE("GPL v2");
162 MODULE_ALIAS("platform:" DRIVER_NAME);
163