1 // SPDX-License-Identifier: GPL-2.0-only
3 * ALSA SoC codec for HDMI encoder drivers
4 * Copyright (C) 2015 Texas Instruments Incorporated - https://www.ti.com/
5 * Author: Jyri Sarha <jsarha@ti.com>
7 #include <linux/module.h>
8 #include <linux/string.h>
9 #include <sound/core.h>
10 #include <sound/jack.h>
11 #include <sound/pcm.h>
12 #include <sound/pcm_params.h>
13 #include <sound/soc.h>
14 #include <sound/tlv.h>
15 #include <sound/pcm_drm_eld.h>
16 #include <sound/hdmi-codec.h>
17 #include <sound/pcm_iec958.h>
19 #include <drm/drm_crtc.h> /* This is only to get MAX_ELD_BYTES */
21 #define HDMI_CODEC_CHMAP_IDX_UNKNOWN -1
24 * CEA speaker placement for HDMI 1.4:
26 * FL FLC FC FRC FR FRW
32 * Speaker placement has to be extended to support HDMI 2.0
34 enum hdmi_codec_cea_spk_placement
{
35 FL
= BIT(0), /* Front Left */
36 FC
= BIT(1), /* Front Center */
37 FR
= BIT(2), /* Front Right */
38 FLC
= BIT(3), /* Front Left Center */
39 FRC
= BIT(4), /* Front Right Center */
40 RL
= BIT(5), /* Rear Left */
41 RC
= BIT(6), /* Rear Center */
42 RR
= BIT(7), /* Rear Right */
43 RLC
= BIT(8), /* Rear Left Center */
44 RRC
= BIT(9), /* Rear Right Center */
45 LFE
= BIT(10), /* Low Frequency Effect */
49 * cea Speaker allocation structure
51 struct hdmi_codec_cea_spk_alloc
{
57 /* Channel maps stereo HDMI */
58 static const struct snd_pcm_chmap_elem hdmi_codec_stereo_chmaps
[] = {
60 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
} },
64 /* Channel maps for multi-channel playbacks, up to 8 n_ch */
65 static const struct snd_pcm_chmap_elem hdmi_codec_8ch_chmaps
[] = {
66 { .channels
= 2, /* CA_ID 0x00 */
67 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
} },
68 { .channels
= 4, /* CA_ID 0x01 */
69 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_LFE
,
71 { .channels
= 4, /* CA_ID 0x02 */
72 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_NA
,
74 { .channels
= 4, /* CA_ID 0x03 */
75 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_LFE
,
77 { .channels
= 6, /* CA_ID 0x04 */
78 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_NA
,
79 SNDRV_CHMAP_NA
, SNDRV_CHMAP_RC
, SNDRV_CHMAP_NA
} },
80 { .channels
= 6, /* CA_ID 0x05 */
81 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_LFE
,
82 SNDRV_CHMAP_NA
, SNDRV_CHMAP_RC
, SNDRV_CHMAP_NA
} },
83 { .channels
= 6, /* CA_ID 0x06 */
84 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_NA
,
85 SNDRV_CHMAP_FC
, SNDRV_CHMAP_RC
, SNDRV_CHMAP_NA
} },
86 { .channels
= 6, /* CA_ID 0x07 */
87 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_LFE
,
88 SNDRV_CHMAP_FC
, SNDRV_CHMAP_RC
, SNDRV_CHMAP_NA
} },
89 { .channels
= 6, /* CA_ID 0x08 */
90 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_NA
,
91 SNDRV_CHMAP_NA
, SNDRV_CHMAP_RL
, SNDRV_CHMAP_RR
} },
92 { .channels
= 6, /* CA_ID 0x09 */
93 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_LFE
,
94 SNDRV_CHMAP_NA
, SNDRV_CHMAP_RL
, SNDRV_CHMAP_RR
} },
95 { .channels
= 6, /* CA_ID 0x0A */
96 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_NA
,
97 SNDRV_CHMAP_FC
, SNDRV_CHMAP_RL
, SNDRV_CHMAP_RR
} },
98 { .channels
= 6, /* CA_ID 0x0B */
99 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_LFE
,
100 SNDRV_CHMAP_FC
, SNDRV_CHMAP_RL
, SNDRV_CHMAP_RR
} },
101 { .channels
= 8, /* CA_ID 0x0C */
102 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_NA
,
103 SNDRV_CHMAP_NA
, SNDRV_CHMAP_RL
, SNDRV_CHMAP_RR
,
104 SNDRV_CHMAP_RC
, SNDRV_CHMAP_NA
} },
105 { .channels
= 8, /* CA_ID 0x0D */
106 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_LFE
,
107 SNDRV_CHMAP_NA
, SNDRV_CHMAP_RL
, SNDRV_CHMAP_RR
,
108 SNDRV_CHMAP_RC
, SNDRV_CHMAP_NA
} },
109 { .channels
= 8, /* CA_ID 0x0E */
110 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_NA
,
111 SNDRV_CHMAP_FC
, SNDRV_CHMAP_RL
, SNDRV_CHMAP_RR
,
112 SNDRV_CHMAP_RC
, SNDRV_CHMAP_NA
} },
113 { .channels
= 8, /* CA_ID 0x0F */
114 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_LFE
,
115 SNDRV_CHMAP_FC
, SNDRV_CHMAP_RL
, SNDRV_CHMAP_RR
,
116 SNDRV_CHMAP_RC
, SNDRV_CHMAP_NA
} },
117 { .channels
= 8, /* CA_ID 0x10 */
118 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_NA
,
119 SNDRV_CHMAP_NA
, SNDRV_CHMAP_RL
, SNDRV_CHMAP_RR
,
120 SNDRV_CHMAP_RLC
, SNDRV_CHMAP_RRC
} },
121 { .channels
= 8, /* CA_ID 0x11 */
122 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_LFE
,
123 SNDRV_CHMAP_NA
, SNDRV_CHMAP_RL
, SNDRV_CHMAP_RR
,
124 SNDRV_CHMAP_RLC
, SNDRV_CHMAP_RRC
} },
125 { .channels
= 8, /* CA_ID 0x12 */
126 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_NA
,
127 SNDRV_CHMAP_FC
, SNDRV_CHMAP_RL
, SNDRV_CHMAP_RR
,
128 SNDRV_CHMAP_RLC
, SNDRV_CHMAP_RRC
} },
129 { .channels
= 8, /* CA_ID 0x13 */
130 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_LFE
,
131 SNDRV_CHMAP_FC
, SNDRV_CHMAP_RL
, SNDRV_CHMAP_RR
,
132 SNDRV_CHMAP_RLC
, SNDRV_CHMAP_RRC
} },
133 { .channels
= 8, /* CA_ID 0x14 */
134 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_NA
,
135 SNDRV_CHMAP_NA
, SNDRV_CHMAP_NA
, SNDRV_CHMAP_NA
,
136 SNDRV_CHMAP_FLC
, SNDRV_CHMAP_FRC
} },
137 { .channels
= 8, /* CA_ID 0x15 */
138 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_LFE
,
139 SNDRV_CHMAP_NA
, SNDRV_CHMAP_NA
, SNDRV_CHMAP_NA
,
140 SNDRV_CHMAP_FLC
, SNDRV_CHMAP_FRC
} },
141 { .channels
= 8, /* CA_ID 0x16 */
142 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_NA
,
143 SNDRV_CHMAP_FC
, SNDRV_CHMAP_NA
, SNDRV_CHMAP_NA
,
144 SNDRV_CHMAP_FLC
, SNDRV_CHMAP_FRC
} },
145 { .channels
= 8, /* CA_ID 0x17 */
146 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_LFE
,
147 SNDRV_CHMAP_FC
, SNDRV_CHMAP_NA
, SNDRV_CHMAP_NA
,
148 SNDRV_CHMAP_FLC
, SNDRV_CHMAP_FRC
} },
149 { .channels
= 8, /* CA_ID 0x18 */
150 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_NA
,
151 SNDRV_CHMAP_NA
, SNDRV_CHMAP_NA
, SNDRV_CHMAP_NA
,
152 SNDRV_CHMAP_FLC
, SNDRV_CHMAP_FRC
} },
153 { .channels
= 8, /* CA_ID 0x19 */
154 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_LFE
,
155 SNDRV_CHMAP_NA
, SNDRV_CHMAP_NA
, SNDRV_CHMAP_NA
,
156 SNDRV_CHMAP_FLC
, SNDRV_CHMAP_FRC
} },
157 { .channels
= 8, /* CA_ID 0x1A */
158 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_NA
,
159 SNDRV_CHMAP_FC
, SNDRV_CHMAP_NA
, SNDRV_CHMAP_NA
,
160 SNDRV_CHMAP_FLC
, SNDRV_CHMAP_FRC
} },
161 { .channels
= 8, /* CA_ID 0x1B */
162 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_LFE
,
163 SNDRV_CHMAP_FC
, SNDRV_CHMAP_NA
, SNDRV_CHMAP_NA
,
164 SNDRV_CHMAP_FLC
, SNDRV_CHMAP_FRC
} },
165 { .channels
= 8, /* CA_ID 0x1C */
166 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_NA
,
167 SNDRV_CHMAP_NA
, SNDRV_CHMAP_NA
, SNDRV_CHMAP_NA
,
168 SNDRV_CHMAP_FLC
, SNDRV_CHMAP_FRC
} },
169 { .channels
= 8, /* CA_ID 0x1D */
170 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_LFE
,
171 SNDRV_CHMAP_NA
, SNDRV_CHMAP_NA
, SNDRV_CHMAP_NA
,
172 SNDRV_CHMAP_FLC
, SNDRV_CHMAP_FRC
} },
173 { .channels
= 8, /* CA_ID 0x1E */
174 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_NA
,
175 SNDRV_CHMAP_FC
, SNDRV_CHMAP_NA
, SNDRV_CHMAP_NA
,
176 SNDRV_CHMAP_FLC
, SNDRV_CHMAP_FRC
} },
177 { .channels
= 8, /* CA_ID 0x1F */
178 .map
= { SNDRV_CHMAP_FL
, SNDRV_CHMAP_FR
, SNDRV_CHMAP_LFE
,
179 SNDRV_CHMAP_FC
, SNDRV_CHMAP_NA
, SNDRV_CHMAP_NA
,
180 SNDRV_CHMAP_FLC
, SNDRV_CHMAP_FRC
} },
185 * hdmi_codec_channel_alloc: speaker configuration available for CEA
187 * This is an ordered list that must match with hdmi_codec_8ch_chmaps struct
188 * The preceding ones have better chances to be selected by
189 * hdmi_codec_get_ch_alloc_table_idx().
191 static const struct hdmi_codec_cea_spk_alloc hdmi_codec_channel_alloc
[] = {
192 { .ca_id
= 0x00, .n_ch
= 2,
195 { .ca_id
= 0x01, .n_ch
= 4,
196 .mask
= FL
| FR
| LFE
},
198 { .ca_id
= 0x02, .n_ch
= 4,
199 .mask
= FL
| FR
| FC
},
201 { .ca_id
= 0x0b, .n_ch
= 6,
202 .mask
= FL
| FR
| LFE
| FC
| RL
| RR
},
204 { .ca_id
= 0x08, .n_ch
= 6,
205 .mask
= FL
| FR
| RL
| RR
},
207 { .ca_id
= 0x09, .n_ch
= 6,
208 .mask
= FL
| FR
| LFE
| RL
| RR
},
210 { .ca_id
= 0x0a, .n_ch
= 6,
211 .mask
= FL
| FR
| FC
| RL
| RR
},
213 { .ca_id
= 0x0f, .n_ch
= 8,
214 .mask
= FL
| FR
| LFE
| FC
| RL
| RR
| RC
},
216 { .ca_id
= 0x13, .n_ch
= 8,
217 .mask
= FL
| FR
| LFE
| FC
| RL
| RR
| RLC
| RRC
},
219 { .ca_id
= 0x03, .n_ch
= 8,
220 .mask
= FL
| FR
| LFE
| FC
},
221 { .ca_id
= 0x04, .n_ch
= 8,
222 .mask
= FL
| FR
| RC
},
223 { .ca_id
= 0x05, .n_ch
= 8,
224 .mask
= FL
| FR
| LFE
| RC
},
225 { .ca_id
= 0x06, .n_ch
= 8,
226 .mask
= FL
| FR
| FC
| RC
},
227 { .ca_id
= 0x07, .n_ch
= 8,
228 .mask
= FL
| FR
| LFE
| FC
| RC
},
229 { .ca_id
= 0x0c, .n_ch
= 8,
230 .mask
= FL
| FR
| RC
| RL
| RR
},
231 { .ca_id
= 0x0d, .n_ch
= 8,
232 .mask
= FL
| FR
| LFE
| RL
| RR
| RC
},
233 { .ca_id
= 0x0e, .n_ch
= 8,
234 .mask
= FL
| FR
| FC
| RL
| RR
| RC
},
235 { .ca_id
= 0x10, .n_ch
= 8,
236 .mask
= FL
| FR
| RL
| RR
| RLC
| RRC
},
237 { .ca_id
= 0x11, .n_ch
= 8,
238 .mask
= FL
| FR
| LFE
| RL
| RR
| RLC
| RRC
},
239 { .ca_id
= 0x12, .n_ch
= 8,
240 .mask
= FL
| FR
| FC
| RL
| RR
| RLC
| RRC
},
241 { .ca_id
= 0x14, .n_ch
= 8,
242 .mask
= FL
| FR
| FLC
| FRC
},
243 { .ca_id
= 0x15, .n_ch
= 8,
244 .mask
= FL
| FR
| LFE
| FLC
| FRC
},
245 { .ca_id
= 0x16, .n_ch
= 8,
246 .mask
= FL
| FR
| FC
| FLC
| FRC
},
247 { .ca_id
= 0x17, .n_ch
= 8,
248 .mask
= FL
| FR
| LFE
| FC
| FLC
| FRC
},
249 { .ca_id
= 0x18, .n_ch
= 8,
250 .mask
= FL
| FR
| RC
| FLC
| FRC
},
251 { .ca_id
= 0x19, .n_ch
= 8,
252 .mask
= FL
| FR
| LFE
| RC
| FLC
| FRC
},
253 { .ca_id
= 0x1a, .n_ch
= 8,
254 .mask
= FL
| FR
| RC
| FC
| FLC
| FRC
},
255 { .ca_id
= 0x1b, .n_ch
= 8,
256 .mask
= FL
| FR
| LFE
| RC
| FC
| FLC
| FRC
},
257 { .ca_id
= 0x1c, .n_ch
= 8,
258 .mask
= FL
| FR
| RL
| RR
| FLC
| FRC
},
259 { .ca_id
= 0x1d, .n_ch
= 8,
260 .mask
= FL
| FR
| LFE
| RL
| RR
| FLC
| FRC
},
261 { .ca_id
= 0x1e, .n_ch
= 8,
262 .mask
= FL
| FR
| FC
| RL
| RR
| FLC
| FRC
},
263 { .ca_id
= 0x1f, .n_ch
= 8,
264 .mask
= FL
| FR
| LFE
| FC
| RL
| RR
| FLC
| FRC
},
267 struct hdmi_codec_priv
{
268 struct hdmi_codec_pdata hcd
;
269 uint8_t eld
[MAX_ELD_BYTES
];
270 struct snd_pcm_chmap
*chmap_info
;
271 unsigned int chmap_idx
;
274 struct snd_soc_jack
*jack
;
275 unsigned int jack_status
;
276 u8 iec_status
[AES_IEC958_STATUS_SIZE
];
279 static const struct snd_soc_dapm_widget hdmi_widgets
[] = {
280 SND_SOC_DAPM_OUTPUT("TX"),
281 SND_SOC_DAPM_OUTPUT("RX"),
289 static int hdmi_eld_ctl_info(struct snd_kcontrol
*kcontrol
,
290 struct snd_ctl_elem_info
*uinfo
)
292 uinfo
->type
= SNDRV_CTL_ELEM_TYPE_BYTES
;
293 uinfo
->count
= sizeof_field(struct hdmi_codec_priv
, eld
);
298 static int hdmi_eld_ctl_get(struct snd_kcontrol
*kcontrol
,
299 struct snd_ctl_elem_value
*ucontrol
)
301 struct snd_soc_component
*component
= snd_kcontrol_chip(kcontrol
);
302 struct hdmi_codec_priv
*hcp
= snd_soc_component_get_drvdata(component
);
304 memcpy(ucontrol
->value
.bytes
.data
, hcp
->eld
, sizeof(hcp
->eld
));
309 static unsigned long hdmi_codec_spk_mask_from_alloc(int spk_alloc
)
312 static const unsigned long hdmi_codec_eld_spk_alloc_bits
[] = {
313 [0] = FL
| FR
, [1] = LFE
, [2] = FC
, [3] = RL
| RR
,
314 [4] = RC
, [5] = FLC
| FRC
, [6] = RLC
| RRC
,
316 unsigned long spk_mask
= 0;
318 for (i
= 0; i
< ARRAY_SIZE(hdmi_codec_eld_spk_alloc_bits
); i
++) {
319 if (spk_alloc
& (1 << i
))
320 spk_mask
|= hdmi_codec_eld_spk_alloc_bits
[i
];
326 static void hdmi_codec_eld_chmap(struct hdmi_codec_priv
*hcp
)
329 unsigned long spk_mask
;
331 spk_alloc
= drm_eld_get_spk_alloc(hcp
->eld
);
332 spk_mask
= hdmi_codec_spk_mask_from_alloc(spk_alloc
);
334 /* Detect if only stereo supported, else return 8 channels mappings */
335 if ((spk_mask
& ~(FL
| FR
)) && hcp
->chmap_info
->max_channels
> 2)
336 hcp
->chmap_info
->chmap
= hdmi_codec_8ch_chmaps
;
338 hcp
->chmap_info
->chmap
= hdmi_codec_stereo_chmaps
;
341 static int hdmi_codec_get_ch_alloc_table_idx(struct hdmi_codec_priv
*hcp
,
342 unsigned char channels
)
346 unsigned long spk_mask
;
347 const struct hdmi_codec_cea_spk_alloc
*cap
= hdmi_codec_channel_alloc
;
349 spk_alloc
= drm_eld_get_spk_alloc(hcp
->eld
);
350 spk_mask
= hdmi_codec_spk_mask_from_alloc(spk_alloc
);
352 for (i
= 0; i
< ARRAY_SIZE(hdmi_codec_channel_alloc
); i
++, cap
++) {
353 /* If spk_alloc == 0, HDMI is unplugged return stereo config*/
354 if (!spk_alloc
&& cap
->ca_id
== 0)
356 if (cap
->n_ch
!= channels
)
358 if (!(cap
->mask
== (spk_mask
& cap
->mask
)))
365 static int hdmi_codec_chmap_ctl_get(struct snd_kcontrol
*kcontrol
,
366 struct snd_ctl_elem_value
*ucontrol
)
368 unsigned const char *map
;
370 struct snd_pcm_chmap
*info
= snd_kcontrol_chip(kcontrol
);
371 struct hdmi_codec_priv
*hcp
= info
->private_data
;
373 map
= info
->chmap
[hcp
->chmap_idx
].map
;
375 for (i
= 0; i
< info
->max_channels
; i
++) {
376 if (hcp
->chmap_idx
== HDMI_CODEC_CHMAP_IDX_UNKNOWN
)
377 ucontrol
->value
.integer
.value
[i
] = 0;
379 ucontrol
->value
.integer
.value
[i
] = map
[i
];
385 static int hdmi_codec_iec958_info(struct snd_kcontrol
*kcontrol
,
386 struct snd_ctl_elem_info
*uinfo
)
388 uinfo
->type
= SNDRV_CTL_ELEM_TYPE_IEC958
;
393 static int hdmi_codec_iec958_default_get(struct snd_kcontrol
*kcontrol
,
394 struct snd_ctl_elem_value
*ucontrol
)
396 struct snd_soc_component
*component
= snd_kcontrol_chip(kcontrol
);
397 struct hdmi_codec_priv
*hcp
= snd_soc_component_get_drvdata(component
);
399 memcpy(ucontrol
->value
.iec958
.status
, hcp
->iec_status
,
400 sizeof(hcp
->iec_status
));
405 static int hdmi_codec_iec958_default_put(struct snd_kcontrol
*kcontrol
,
406 struct snd_ctl_elem_value
*ucontrol
)
408 struct snd_soc_component
*component
= snd_kcontrol_chip(kcontrol
);
409 struct hdmi_codec_priv
*hcp
= snd_soc_component_get_drvdata(component
);
411 memcpy(hcp
->iec_status
, ucontrol
->value
.iec958
.status
,
412 sizeof(hcp
->iec_status
));
417 static int hdmi_codec_iec958_mask_get(struct snd_kcontrol
*kcontrol
,
418 struct snd_ctl_elem_value
*ucontrol
)
420 memset(ucontrol
->value
.iec958
.status
, 0xff,
421 sizeof_field(struct hdmi_codec_priv
, iec_status
));
426 static int hdmi_codec_startup(struct snd_pcm_substream
*substream
,
427 struct snd_soc_dai
*dai
)
429 struct hdmi_codec_priv
*hcp
= snd_soc_dai_get_drvdata(dai
);
430 bool tx
= substream
->stream
== SNDRV_PCM_STREAM_PLAYBACK
;
431 bool has_capture
= !hcp
->hcd
.no_i2s_capture
;
432 bool has_playback
= !hcp
->hcd
.no_i2s_playback
;
435 if (!((has_playback
&& tx
) || (has_capture
&& !tx
)))
438 mutex_lock(&hcp
->lock
);
440 dev_err(dai
->dev
, "Only one simultaneous stream supported!\n");
441 mutex_unlock(&hcp
->lock
);
445 if (hcp
->hcd
.ops
->audio_startup
) {
446 ret
= hcp
->hcd
.ops
->audio_startup(dai
->dev
->parent
, hcp
->hcd
.data
);
451 if (tx
&& hcp
->hcd
.ops
->get_eld
) {
452 ret
= hcp
->hcd
.ops
->get_eld(dai
->dev
->parent
, hcp
->hcd
.data
,
453 hcp
->eld
, sizeof(hcp
->eld
));
457 ret
= snd_pcm_hw_constraint_eld(substream
->runtime
, hcp
->eld
);
461 /* Select chmap supported */
462 hdmi_codec_eld_chmap(hcp
);
468 mutex_unlock(&hcp
->lock
);
472 static void hdmi_codec_shutdown(struct snd_pcm_substream
*substream
,
473 struct snd_soc_dai
*dai
)
475 struct hdmi_codec_priv
*hcp
= snd_soc_dai_get_drvdata(dai
);
476 bool tx
= substream
->stream
== SNDRV_PCM_STREAM_PLAYBACK
;
477 bool has_capture
= !hcp
->hcd
.no_i2s_capture
;
478 bool has_playback
= !hcp
->hcd
.no_i2s_playback
;
480 if (!((has_playback
&& tx
) || (has_capture
&& !tx
)))
483 hcp
->chmap_idx
= HDMI_CODEC_CHMAP_IDX_UNKNOWN
;
484 hcp
->hcd
.ops
->audio_shutdown(dai
->dev
->parent
, hcp
->hcd
.data
);
486 mutex_lock(&hcp
->lock
);
488 mutex_unlock(&hcp
->lock
);
491 static int hdmi_codec_fill_codec_params(struct snd_soc_dai
*dai
,
492 unsigned int sample_width
,
493 unsigned int sample_rate
,
494 unsigned int channels
,
495 struct hdmi_codec_params
*hp
)
497 struct hdmi_codec_priv
*hcp
= snd_soc_dai_get_drvdata(dai
);
498 int idx
= HDMI_CODEC_CHMAP_IDX_UNKNOWN
;
500 bool pcm_audio
= !(hcp
->iec_status
[0] & IEC958_AES0_NONAUDIO
);
503 /* Select a channel allocation that matches with ELD and pcm channels */
504 idx
= hdmi_codec_get_ch_alloc_table_idx(hcp
, channels
);
507 dev_err(dai
->dev
, "Not able to map channels to speakers (%d)\n",
509 hcp
->chmap_idx
= HDMI_CODEC_CHMAP_IDX_UNKNOWN
;
513 ca_id
= hdmi_codec_channel_alloc
[idx
].ca_id
;
516 memset(hp
, 0, sizeof(*hp
));
518 hdmi_audio_infoframe_init(&hp
->cea
);
521 hp
->cea
.channels
= channels
;
523 hp
->cea
.channels
= 0;
525 hp
->cea
.coding_type
= HDMI_AUDIO_CODING_TYPE_STREAM
;
526 hp
->cea
.sample_size
= HDMI_AUDIO_SAMPLE_SIZE_STREAM
;
527 hp
->cea
.sample_frequency
= HDMI_AUDIO_SAMPLE_FREQUENCY_STREAM
;
528 hp
->cea
.channel_allocation
= ca_id
;
530 hp
->sample_width
= sample_width
;
531 hp
->sample_rate
= sample_rate
;
532 hp
->channels
= channels
;
534 hcp
->chmap_idx
= idx
;
539 static int hdmi_codec_hw_params(struct snd_pcm_substream
*substream
,
540 struct snd_pcm_hw_params
*params
,
541 struct snd_soc_dai
*dai
)
543 struct hdmi_codec_priv
*hcp
= snd_soc_dai_get_drvdata(dai
);
544 struct hdmi_codec_daifmt
*cf
= snd_soc_dai_dma_data_get_playback(dai
);
545 struct hdmi_codec_params hp
= {
550 .dig_subframe
= { 0 },
555 if (!hcp
->hcd
.ops
->hw_params
)
558 dev_dbg(dai
->dev
, "%s() width %d rate %d channels %d\n", __func__
,
559 params_width(params
), params_rate(params
),
560 params_channels(params
));
562 ret
= hdmi_codec_fill_codec_params(dai
,
563 params_width(params
),
565 params_channels(params
),
570 memcpy(hp
.iec
.status
, hcp
->iec_status
, sizeof(hp
.iec
.status
));
571 ret
= snd_pcm_fill_iec958_consumer_hw_params(params
, hp
.iec
.status
,
572 sizeof(hp
.iec
.status
));
574 dev_err(dai
->dev
, "Creating IEC958 channel status failed %d\n",
579 cf
->bit_fmt
= params_format(params
);
580 return hcp
->hcd
.ops
->hw_params(dai
->dev
->parent
, hcp
->hcd
.data
,
584 static int hdmi_codec_prepare(struct snd_pcm_substream
*substream
,
585 struct snd_soc_dai
*dai
)
587 struct hdmi_codec_priv
*hcp
= snd_soc_dai_get_drvdata(dai
);
588 struct hdmi_codec_daifmt
*cf
= snd_soc_dai_dma_data_get_playback(dai
);
589 struct snd_pcm_runtime
*runtime
= substream
->runtime
;
590 unsigned int channels
= runtime
->channels
;
591 unsigned int width
= snd_pcm_format_width(runtime
->format
);
592 unsigned int rate
= runtime
->rate
;
593 struct hdmi_codec_params hp
;
596 if (!hcp
->hcd
.ops
->prepare
)
599 dev_dbg(dai
->dev
, "%s() width %d rate %d channels %d\n", __func__
,
600 width
, rate
, channels
);
602 ret
= hdmi_codec_fill_codec_params(dai
, width
, rate
, channels
, &hp
);
606 memcpy(hp
.iec
.status
, hcp
->iec_status
, sizeof(hp
.iec
.status
));
607 ret
= snd_pcm_fill_iec958_consumer(runtime
, hp
.iec
.status
,
608 sizeof(hp
.iec
.status
));
610 dev_err(dai
->dev
, "Creating IEC958 channel status failed %d\n",
615 cf
->bit_fmt
= runtime
->format
;
616 return hcp
->hcd
.ops
->prepare(dai
->dev
->parent
, hcp
->hcd
.data
,
620 static int hdmi_codec_i2s_set_fmt(struct snd_soc_dai
*dai
,
623 struct hdmi_codec_daifmt
*cf
= snd_soc_dai_dma_data_get_playback(dai
);
626 memset(cf
, 0, sizeof(*cf
));
628 switch (fmt
& SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK
) {
629 case SND_SOC_DAIFMT_CBP_CFP
:
630 cf
->bit_clk_provider
= 1;
631 cf
->frame_clk_provider
= 1;
633 case SND_SOC_DAIFMT_CBC_CFP
:
634 cf
->frame_clk_provider
= 1;
636 case SND_SOC_DAIFMT_CBP_CFC
:
637 cf
->bit_clk_provider
= 1;
639 case SND_SOC_DAIFMT_CBC_CFC
:
645 switch (fmt
& SND_SOC_DAIFMT_INV_MASK
) {
646 case SND_SOC_DAIFMT_NB_NF
:
648 case SND_SOC_DAIFMT_NB_IF
:
649 cf
->frame_clk_inv
= 1;
651 case SND_SOC_DAIFMT_IB_NF
:
654 case SND_SOC_DAIFMT_IB_IF
:
655 cf
->frame_clk_inv
= 1;
660 switch (fmt
& SND_SOC_DAIFMT_FORMAT_MASK
) {
661 case SND_SOC_DAIFMT_I2S
:
664 case SND_SOC_DAIFMT_DSP_A
:
665 cf
->fmt
= HDMI_DSP_A
;
667 case SND_SOC_DAIFMT_DSP_B
:
668 cf
->fmt
= HDMI_DSP_B
;
670 case SND_SOC_DAIFMT_RIGHT_J
:
671 cf
->fmt
= HDMI_RIGHT_J
;
673 case SND_SOC_DAIFMT_LEFT_J
:
674 cf
->fmt
= HDMI_LEFT_J
;
676 case SND_SOC_DAIFMT_AC97
:
680 dev_err(dai
->dev
, "Invalid DAI interface format\n");
687 static int hdmi_codec_mute(struct snd_soc_dai
*dai
, int mute
, int direction
)
689 struct hdmi_codec_priv
*hcp
= snd_soc_dai_get_drvdata(dai
);
692 * ignore if direction was CAPTURE
693 * and it had .no_capture_mute flag
695 * snd_soc_dai_digital_mute()
697 if (hcp
->hcd
.ops
->mute_stream
&&
698 (direction
== SNDRV_PCM_STREAM_PLAYBACK
||
699 !hcp
->hcd
.ops
->no_capture_mute
))
700 return hcp
->hcd
.ops
->mute_stream(dai
->dev
->parent
,
708 * This driver can select all SND_SOC_DAIFMT_CBx_CFx,
709 * but need to be selected from Sound Card, not be auto selected.
710 * Because it might be used from other driver.
712 * ${LINUX}/drivers/gpu/drm/bridge/synopsys/dw-hdmi-i2s-audio.c
714 static u64 hdmi_codec_formats
=
715 SND_SOC_POSSIBLE_DAIFMT_NB_NF
|
716 SND_SOC_POSSIBLE_DAIFMT_NB_IF
|
717 SND_SOC_POSSIBLE_DAIFMT_IB_NF
|
718 SND_SOC_POSSIBLE_DAIFMT_IB_IF
|
719 SND_SOC_POSSIBLE_DAIFMT_I2S
|
720 SND_SOC_POSSIBLE_DAIFMT_DSP_A
|
721 SND_SOC_POSSIBLE_DAIFMT_DSP_B
|
722 SND_SOC_POSSIBLE_DAIFMT_RIGHT_J
|
723 SND_SOC_POSSIBLE_DAIFMT_LEFT_J
|
724 SND_SOC_POSSIBLE_DAIFMT_AC97
;
726 #define HDMI_RATES (SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |\
727 SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |\
728 SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |\
729 SNDRV_PCM_RATE_192000)
731 #define SPDIF_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
732 SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S24_LE)
735 * This list is only for formats allowed on the I2S bus. So there is
736 * some formats listed that are not supported by HDMI interface. For
737 * instance allowing the 32-bit formats enables 24-precision with CPU
738 * DAIs that do not support 24-bit formats. If the extra formats cause
739 * problems, we should add the video side driver an option to disable
742 #define I2S_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
743 SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S24_LE |\
744 SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE)
746 static struct snd_kcontrol_new hdmi_codec_controls
[] = {
748 .access
= SNDRV_CTL_ELEM_ACCESS_READ
,
749 .iface
= SNDRV_CTL_ELEM_IFACE_PCM
,
750 .name
= SNDRV_CTL_NAME_IEC958("", PLAYBACK
, MASK
),
751 .info
= hdmi_codec_iec958_info
,
752 .get
= hdmi_codec_iec958_mask_get
,
755 .iface
= SNDRV_CTL_ELEM_IFACE_PCM
,
756 .name
= SNDRV_CTL_NAME_IEC958("", PLAYBACK
, DEFAULT
),
757 .info
= hdmi_codec_iec958_info
,
758 .get
= hdmi_codec_iec958_default_get
,
759 .put
= hdmi_codec_iec958_default_put
,
762 .access
= (SNDRV_CTL_ELEM_ACCESS_READ
|
763 SNDRV_CTL_ELEM_ACCESS_VOLATILE
),
764 .iface
= SNDRV_CTL_ELEM_IFACE_PCM
,
766 .info
= hdmi_eld_ctl_info
,
767 .get
= hdmi_eld_ctl_get
,
771 static int hdmi_codec_pcm_new(struct snd_soc_pcm_runtime
*rtd
,
772 struct snd_soc_dai
*dai
)
774 struct snd_soc_dai_driver
*drv
= dai
->driver
;
775 struct hdmi_codec_priv
*hcp
= snd_soc_dai_get_drvdata(dai
);
779 ret
= snd_pcm_add_chmap_ctls(rtd
->pcm
, SNDRV_PCM_STREAM_PLAYBACK
,
780 NULL
, drv
->playback
.channels_max
, 0,
785 /* override handlers */
786 hcp
->chmap_info
->private_data
= hcp
;
787 hcp
->chmap_info
->kctl
->get
= hdmi_codec_chmap_ctl_get
;
789 /* default chmap supported is stereo */
790 hcp
->chmap_info
->chmap
= hdmi_codec_stereo_chmaps
;
791 hcp
->chmap_idx
= HDMI_CODEC_CHMAP_IDX_UNKNOWN
;
793 for (i
= 0; i
< ARRAY_SIZE(hdmi_codec_controls
); i
++) {
794 struct snd_kcontrol
*kctl
;
796 /* add ELD ctl with the device number corresponding to the PCM stream */
797 kctl
= snd_ctl_new1(&hdmi_codec_controls
[i
], dai
->component
);
801 kctl
->id
.device
= rtd
->pcm
->device
;
802 ret
= snd_ctl_add(rtd
->card
->snd_card
, kctl
);
810 static int hdmi_dai_probe(struct snd_soc_dai
*dai
)
812 struct snd_soc_dapm_context
*dapm
;
813 struct hdmi_codec_daifmt
*daifmt
;
814 struct snd_soc_dapm_route route
[] = {
817 .source
= dai
->driver
->playback
.stream_name
,
820 .sink
= dai
->driver
->capture
.stream_name
,
826 dapm
= snd_soc_component_get_dapm(dai
->component
);
828 /* One of the directions might be omitted for unidirectional DAIs */
829 for (i
= 0; i
< ARRAY_SIZE(route
); i
++) {
830 if (!route
[i
].source
|| !route
[i
].sink
)
833 ret
= snd_soc_dapm_add_routes(dapm
, &route
[i
], 1);
838 daifmt
= devm_kzalloc(dai
->dev
, sizeof(*daifmt
), GFP_KERNEL
);
842 snd_soc_dai_dma_data_set_playback(dai
, daifmt
);
847 static void hdmi_codec_jack_report(struct hdmi_codec_priv
*hcp
,
848 unsigned int jack_status
)
850 if (hcp
->jack
&& jack_status
!= hcp
->jack_status
) {
851 snd_soc_jack_report(hcp
->jack
, jack_status
, SND_JACK_LINEOUT
);
852 hcp
->jack_status
= jack_status
;
856 static void plugged_cb(struct device
*dev
, bool plugged
)
858 struct hdmi_codec_priv
*hcp
= dev_get_drvdata(dev
);
861 if (hcp
->hcd
.ops
->get_eld
) {
862 hcp
->hcd
.ops
->get_eld(dev
->parent
, hcp
->hcd
.data
,
863 hcp
->eld
, sizeof(hcp
->eld
));
865 hdmi_codec_jack_report(hcp
, SND_JACK_LINEOUT
);
867 hdmi_codec_jack_report(hcp
, 0);
868 memset(hcp
->eld
, 0, sizeof(hcp
->eld
));
872 static int hdmi_codec_set_jack(struct snd_soc_component
*component
,
873 struct snd_soc_jack
*jack
,
876 struct hdmi_codec_priv
*hcp
= snd_soc_component_get_drvdata(component
);
879 if (hcp
->hcd
.ops
->hook_plugged_cb
) {
881 ret
= hcp
->hcd
.ops
->hook_plugged_cb(component
->dev
->parent
,
891 static int hdmi_dai_spdif_probe(struct snd_soc_dai
*dai
)
893 struct hdmi_codec_daifmt
*cf
;
896 ret
= hdmi_dai_probe(dai
);
900 cf
= snd_soc_dai_dma_data_get_playback(dai
);
901 cf
->fmt
= HDMI_SPDIF
;
906 static const struct snd_soc_dai_ops hdmi_codec_i2s_dai_ops
= {
907 .probe
= hdmi_dai_probe
,
908 .startup
= hdmi_codec_startup
,
909 .shutdown
= hdmi_codec_shutdown
,
910 .hw_params
= hdmi_codec_hw_params
,
911 .prepare
= hdmi_codec_prepare
,
912 .set_fmt
= hdmi_codec_i2s_set_fmt
,
913 .mute_stream
= hdmi_codec_mute
,
914 .pcm_new
= hdmi_codec_pcm_new
,
915 .auto_selectable_formats
= &hdmi_codec_formats
,
916 .num_auto_selectable_formats
= 1,
919 static const struct snd_soc_dai_ops hdmi_codec_spdif_dai_ops
= {
920 .probe
= hdmi_dai_spdif_probe
,
921 .startup
= hdmi_codec_startup
,
922 .shutdown
= hdmi_codec_shutdown
,
923 .hw_params
= hdmi_codec_hw_params
,
924 .mute_stream
= hdmi_codec_mute
,
925 .pcm_new
= hdmi_codec_pcm_new
,
928 static const struct snd_soc_dai_driver hdmi_i2s_dai
= {
932 .stream_name
= "I2S Playback",
936 .formats
= I2S_FORMATS
,
940 .stream_name
= "Capture",
944 .formats
= I2S_FORMATS
,
947 .ops
= &hdmi_codec_i2s_dai_ops
,
950 static const struct snd_soc_dai_driver hdmi_spdif_dai
= {
951 .name
= "spdif-hifi",
954 .stream_name
= "SPDIF Playback",
958 .formats
= SPDIF_FORMATS
,
961 .stream_name
= "Capture",
965 .formats
= SPDIF_FORMATS
,
967 .ops
= &hdmi_codec_spdif_dai_ops
,
970 static int hdmi_of_xlate_dai_id(struct snd_soc_component
*component
,
971 struct device_node
*endpoint
)
973 struct hdmi_codec_priv
*hcp
= snd_soc_component_get_drvdata(component
);
974 int ret
= -ENOTSUPP
; /* see snd_soc_get_dai_id() */
976 if (hcp
->hcd
.ops
->get_dai_id
)
977 ret
= hcp
->hcd
.ops
->get_dai_id(component
, endpoint
);
982 static void hdmi_remove(struct snd_soc_component
*component
)
984 struct hdmi_codec_priv
*hcp
= snd_soc_component_get_drvdata(component
);
986 if (hcp
->hcd
.ops
->hook_plugged_cb
)
987 hcp
->hcd
.ops
->hook_plugged_cb(component
->dev
->parent
,
988 hcp
->hcd
.data
, NULL
, NULL
);
991 static const struct snd_soc_component_driver hdmi_driver
= {
992 .remove
= hdmi_remove
,
993 .dapm_widgets
= hdmi_widgets
,
994 .num_dapm_widgets
= ARRAY_SIZE(hdmi_widgets
),
995 .of_xlate_dai_id
= hdmi_of_xlate_dai_id
,
997 .use_pmdown_time
= 1,
999 .set_jack
= hdmi_codec_set_jack
,
1002 static int hdmi_codec_probe(struct platform_device
*pdev
)
1004 struct hdmi_codec_pdata
*hcd
= pdev
->dev
.platform_data
;
1005 struct snd_soc_dai_driver
*daidrv
;
1006 struct device
*dev
= &pdev
->dev
;
1007 struct hdmi_codec_priv
*hcp
;
1008 int dai_count
, i
= 0;
1012 dev_err(dev
, "%s: No platform data\n", __func__
);
1016 dai_count
= hcd
->i2s
+ hcd
->spdif
;
1017 if (dai_count
< 1 || !hcd
->ops
||
1018 (!hcd
->ops
->hw_params
&& !hcd
->ops
->prepare
) ||
1019 !hcd
->ops
->audio_shutdown
) {
1020 dev_err(dev
, "%s: Invalid parameters\n", __func__
);
1024 hcp
= devm_kzalloc(dev
, sizeof(*hcp
), GFP_KERNEL
);
1029 mutex_init(&hcp
->lock
);
1031 ret
= snd_pcm_create_iec958_consumer_default(hcp
->iec_status
,
1032 sizeof(hcp
->iec_status
));
1036 daidrv
= devm_kcalloc(dev
, dai_count
, sizeof(*daidrv
), GFP_KERNEL
);
1041 daidrv
[i
] = hdmi_i2s_dai
;
1042 daidrv
[i
].playback
.channels_max
= hcd
->max_i2s_channels
;
1043 if (hcd
->no_i2s_playback
)
1044 memset(&daidrv
[i
].playback
, 0,
1045 sizeof(daidrv
[i
].playback
));
1046 if (hcd
->no_i2s_capture
)
1047 memset(&daidrv
[i
].capture
, 0,
1048 sizeof(daidrv
[i
].capture
));
1053 daidrv
[i
] = hdmi_spdif_dai
;
1054 if (hcd
->no_spdif_playback
)
1055 memset(&daidrv
[i
].playback
, 0,
1056 sizeof(daidrv
[i
].playback
));
1057 if (hcd
->no_spdif_capture
)
1058 memset(&daidrv
[i
].capture
, 0,
1059 sizeof(daidrv
[i
].capture
));
1062 dev_set_drvdata(dev
, hcp
);
1064 ret
= devm_snd_soc_register_component(dev
, &hdmi_driver
, daidrv
,
1067 dev_err(dev
, "%s: snd_soc_register_component() failed (%d)\n",
1074 static struct platform_driver hdmi_codec_driver
= {
1076 .name
= HDMI_CODEC_DRV_NAME
,
1078 .probe
= hdmi_codec_probe
,
1081 module_platform_driver(hdmi_codec_driver
);
1083 MODULE_AUTHOR("Jyri Sarha <jsarha@ti.com>");
1084 MODULE_DESCRIPTION("HDMI Audio Codec Driver");
1085 MODULE_LICENSE("GPL");
1086 MODULE_ALIAS("platform:" HDMI_CODEC_DRV_NAME
);