1 /*
2 * Analog Devices ADV7511 HDMI transmitter driver
3 *
4 * Copyright 2012 Analog Devices Inc.
5 * Copyright (c) 2016, Linaro Limited
6 *
7 * Licensed under the GPL-2.
8 */
9
10 #include <sound/core.h>
11 #include <sound/hdmi-codec.h>
12 #include <sound/pcm.h>
13 #include <sound/soc.h>
14 #include <linux/of_graph.h>
15
16 #include "adv7511.h"
17
adv7511_calc_cts_n(unsigned int f_tmds,unsigned int fs,unsigned int * cts,unsigned int * n)18 static void adv7511_calc_cts_n(unsigned int f_tmds, unsigned int fs,
19 unsigned int *cts, unsigned int *n)
20 {
21 switch (fs) {
22 case 32000:
23 case 48000:
24 case 96000:
25 case 192000:
26 *n = fs * 128 / 1000;
27 break;
28 case 44100:
29 case 88200:
30 case 176400:
31 *n = fs * 128 / 900;
32 break;
33 }
34
35 *cts = ((f_tmds * *n) / (128 * fs)) * 1000;
36 }
37
adv7511_update_cts_n(struct adv7511 * adv7511)38 static int adv7511_update_cts_n(struct adv7511 *adv7511)
39 {
40 unsigned int cts = 0;
41 unsigned int n = 0;
42
43 adv7511_calc_cts_n(adv7511->f_tmds, adv7511->f_audio, &cts, &n);
44
45 regmap_write(adv7511->regmap, ADV7511_REG_N0, (n >> 16) & 0xf);
46 regmap_write(adv7511->regmap, ADV7511_REG_N1, (n >> 8) & 0xff);
47 regmap_write(adv7511->regmap, ADV7511_REG_N2, n & 0xff);
48
49 regmap_write(adv7511->regmap, ADV7511_REG_CTS_MANUAL0,
50 (cts >> 16) & 0xf);
51 regmap_write(adv7511->regmap, ADV7511_REG_CTS_MANUAL1,
52 (cts >> 8) & 0xff);
53 regmap_write(adv7511->regmap, ADV7511_REG_CTS_MANUAL2,
54 cts & 0xff);
55
56 return 0;
57 }
58
adv7511_hdmi_hw_params(struct device * dev,void * data,struct hdmi_codec_daifmt * fmt,struct hdmi_codec_params * hparms)59 int adv7511_hdmi_hw_params(struct device *dev, void *data,
60 struct hdmi_codec_daifmt *fmt,
61 struct hdmi_codec_params *hparms)
62 {
63 struct adv7511 *adv7511 = dev_get_drvdata(dev);
64 unsigned int audio_source, i2s_format = 0;
65 unsigned int invert_clock;
66 unsigned int rate;
67 unsigned int len;
68
69 switch (hparms->sample_rate) {
70 case 32000:
71 rate = ADV7511_SAMPLE_FREQ_32000;
72 break;
73 case 44100:
74 rate = ADV7511_SAMPLE_FREQ_44100;
75 break;
76 case 48000:
77 rate = ADV7511_SAMPLE_FREQ_48000;
78 break;
79 case 88200:
80 rate = ADV7511_SAMPLE_FREQ_88200;
81 break;
82 case 96000:
83 rate = ADV7511_SAMPLE_FREQ_96000;
84 break;
85 case 176400:
86 rate = ADV7511_SAMPLE_FREQ_176400;
87 break;
88 case 192000:
89 rate = ADV7511_SAMPLE_FREQ_192000;
90 break;
91 default:
92 return -EINVAL;
93 }
94
95 switch (hparms->sample_width) {
96 case 16:
97 len = ADV7511_I2S_SAMPLE_LEN_16;
98 break;
99 case 18:
100 len = ADV7511_I2S_SAMPLE_LEN_18;
101 break;
102 case 20:
103 len = ADV7511_I2S_SAMPLE_LEN_20;
104 break;
105 case 24:
106 len = ADV7511_I2S_SAMPLE_LEN_24;
107 break;
108 default:
109 return -EINVAL;
110 }
111
112 switch (fmt->fmt) {
113 case HDMI_I2S:
114 audio_source = ADV7511_AUDIO_SOURCE_I2S;
115 i2s_format = ADV7511_I2S_FORMAT_I2S;
116 break;
117 case HDMI_RIGHT_J:
118 audio_source = ADV7511_AUDIO_SOURCE_I2S;
119 i2s_format = ADV7511_I2S_FORMAT_RIGHT_J;
120 break;
121 case HDMI_LEFT_J:
122 audio_source = ADV7511_AUDIO_SOURCE_I2S;
123 i2s_format = ADV7511_I2S_FORMAT_LEFT_J;
124 break;
125 default:
126 return -EINVAL;
127 }
128
129 invert_clock = fmt->bit_clk_inv;
130
131 regmap_update_bits(adv7511->regmap, ADV7511_REG_AUDIO_SOURCE, 0x70,
132 audio_source << 4);
133 regmap_update_bits(adv7511->regmap, ADV7511_REG_AUDIO_CONFIG, BIT(6),
134 invert_clock << 6);
135 regmap_update_bits(adv7511->regmap, ADV7511_REG_I2S_CONFIG, 0x03,
136 i2s_format);
137
138 adv7511->audio_source = audio_source;
139
140 adv7511->f_audio = hparms->sample_rate;
141
142 adv7511_update_cts_n(adv7511);
143
144 regmap_update_bits(adv7511->regmap, ADV7511_REG_AUDIO_CFG3,
145 ADV7511_AUDIO_CFG3_LEN_MASK, len);
146 regmap_update_bits(adv7511->regmap, ADV7511_REG_I2C_FREQ_ID_CFG,
147 ADV7511_I2C_FREQ_ID_CFG_RATE_MASK, rate << 4);
148 regmap_write(adv7511->regmap, 0x73, 0x1);
149
150 return 0;
151 }
152
audio_startup(struct device * dev,void * data)153 static int audio_startup(struct device *dev, void *data)
154 {
155 struct adv7511 *adv7511 = dev_get_drvdata(dev);
156
157 regmap_update_bits(adv7511->regmap, ADV7511_REG_AUDIO_CONFIG,
158 BIT(7), 0);
159
160 /* hide Audio infoframe updates */
161 regmap_update_bits(adv7511->regmap, ADV7511_REG_INFOFRAME_UPDATE,
162 BIT(5), BIT(5));
163 /* enable N/CTS, enable Audio sample packets */
164 regmap_update_bits(adv7511->regmap, ADV7511_REG_PACKET_ENABLE1,
165 BIT(5), BIT(5));
166 /* enable N/CTS */
167 regmap_update_bits(adv7511->regmap, ADV7511_REG_PACKET_ENABLE1,
168 BIT(6), BIT(6));
169 /* not copyrighted */
170 regmap_update_bits(adv7511->regmap, ADV7511_REG_AUDIO_CFG1,
171 BIT(5), BIT(5));
172 /* enable audio infoframes */
173 regmap_update_bits(adv7511->regmap, ADV7511_REG_PACKET_ENABLE1,
174 BIT(3), BIT(3));
175 /* AV mute disable */
176 regmap_update_bits(adv7511->regmap, ADV7511_REG_GC(0),
177 BIT(7) | BIT(6), BIT(7));
178 /* use Audio infoframe updated info */
179 regmap_update_bits(adv7511->regmap, ADV7511_REG_GC(1),
180 BIT(5), 0);
181 return 0;
182 }
183
audio_shutdown(struct device * dev,void * data)184 static void audio_shutdown(struct device *dev, void *data)
185 {
186 }
187
adv7511_hdmi_i2s_get_dai_id(struct snd_soc_component * component,struct device_node * endpoint)188 static int adv7511_hdmi_i2s_get_dai_id(struct snd_soc_component *component,
189 struct device_node *endpoint)
190 {
191 struct of_endpoint of_ep;
192 int ret;
193
194 ret = of_graph_parse_endpoint(endpoint, &of_ep);
195 if (ret < 0)
196 return ret;
197
198 /*
199 * HDMI sound should be located as reg = <2>
200 * Then, it is sound port 0
201 */
202 if (of_ep.port == 2)
203 return 0;
204
205 return -EINVAL;
206 }
207
208 static const struct hdmi_codec_ops adv7511_codec_ops = {
209 .hw_params = adv7511_hdmi_hw_params,
210 .audio_shutdown = audio_shutdown,
211 .audio_startup = audio_startup,
212 .get_dai_id = adv7511_hdmi_i2s_get_dai_id,
213 };
214
215 static const struct hdmi_codec_pdata codec_data = {
216 .ops = &adv7511_codec_ops,
217 .max_i2s_channels = 2,
218 .i2s = 1,
219 };
220
adv7511_audio_init(struct device * dev,struct adv7511 * adv7511)221 int adv7511_audio_init(struct device *dev, struct adv7511 *adv7511)
222 {
223 adv7511->audio_pdev = platform_device_register_data(dev,
224 HDMI_CODEC_DRV_NAME,
225 PLATFORM_DEVID_AUTO,
226 &codec_data,
227 sizeof(codec_data));
228 return PTR_ERR_OR_ZERO(adv7511->audio_pdev);
229 }
230
adv7511_audio_exit(struct adv7511 * adv7511)231 void adv7511_audio_exit(struct adv7511 *adv7511)
232 {
233 if (adv7511->audio_pdev) {
234 platform_device_unregister(adv7511->audio_pdev);
235 adv7511->audio_pdev = NULL;
236 }
237 }
238