1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 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> 6 */ 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> 18 19 #include <drm/drm_crtc.h> /* This is only to get MAX_ELD_BYTES */ 20 #include <drm/drm_eld.h> 21 22 #define HDMI_CODEC_CHMAP_IDX_UNKNOWN -1 23 24 /* 25 * CEA speaker placement for HDMI 1.4: 26 * 27 * FL FLC FC FRC FR FRW 28 * 29 * LFE 30 * 31 * RL RLC RC RRC RR 32 * 33 * Speaker placement has to be extended to support HDMI 2.0 34 */ 35 enum hdmi_codec_cea_spk_placement { 36 FL = BIT(0), /* Front Left */ 37 FC = BIT(1), /* Front Center */ 38 FR = BIT(2), /* Front Right */ 39 FLC = BIT(3), /* Front Left Center */ 40 FRC = BIT(4), /* Front Right Center */ 41 RL = BIT(5), /* Rear Left */ 42 RC = BIT(6), /* Rear Center */ 43 RR = BIT(7), /* Rear Right */ 44 RLC = BIT(8), /* Rear Left Center */ 45 RRC = BIT(9), /* Rear Right Center */ 46 LFE = BIT(10), /* Low Frequency Effect */ 47 }; 48 49 /* 50 * cea Speaker allocation structure 51 */ 52 struct hdmi_codec_cea_spk_alloc { 53 const int ca_id; 54 unsigned int n_ch; 55 unsigned long mask; 56 }; 57 58 /* Channel maps stereo HDMI */ 59 static const struct snd_pcm_chmap_elem hdmi_codec_stereo_chmaps[] = { 60 { .channels = 2, 61 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR } }, 62 { } 63 }; 64 65 /* Channel maps for multi-channel playbacks, up to 8 n_ch */ 66 static const struct snd_pcm_chmap_elem hdmi_codec_8ch_chmaps[] = { 67 { .channels = 2, /* CA_ID 0x00 */ 68 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR } }, 69 { .channels = 4, /* CA_ID 0x01 */ 70 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_LFE, 71 SNDRV_CHMAP_NA } }, 72 { .channels = 4, /* CA_ID 0x02 */ 73 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_NA, 74 SNDRV_CHMAP_FC } }, 75 { .channels = 4, /* CA_ID 0x03 */ 76 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_LFE, 77 SNDRV_CHMAP_FC } }, 78 { .channels = 6, /* CA_ID 0x04 */ 79 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_NA, 80 SNDRV_CHMAP_NA, SNDRV_CHMAP_RC, SNDRV_CHMAP_NA } }, 81 { .channels = 6, /* CA_ID 0x05 */ 82 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_LFE, 83 SNDRV_CHMAP_NA, SNDRV_CHMAP_RC, SNDRV_CHMAP_NA } }, 84 { .channels = 6, /* CA_ID 0x06 */ 85 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_NA, 86 SNDRV_CHMAP_FC, SNDRV_CHMAP_RC, SNDRV_CHMAP_NA } }, 87 { .channels = 6, /* CA_ID 0x07 */ 88 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_LFE, 89 SNDRV_CHMAP_FC, SNDRV_CHMAP_RC, SNDRV_CHMAP_NA } }, 90 { .channels = 6, /* CA_ID 0x08 */ 91 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_NA, 92 SNDRV_CHMAP_NA, SNDRV_CHMAP_RL, SNDRV_CHMAP_RR } }, 93 { .channels = 6, /* CA_ID 0x09 */ 94 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_LFE, 95 SNDRV_CHMAP_NA, SNDRV_CHMAP_RL, SNDRV_CHMAP_RR } }, 96 { .channels = 6, /* CA_ID 0x0A */ 97 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_NA, 98 SNDRV_CHMAP_FC, SNDRV_CHMAP_RL, SNDRV_CHMAP_RR } }, 99 { .channels = 6, /* CA_ID 0x0B */ 100 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_LFE, 101 SNDRV_CHMAP_FC, SNDRV_CHMAP_RL, SNDRV_CHMAP_RR } }, 102 { .channels = 8, /* CA_ID 0x0C */ 103 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_NA, 104 SNDRV_CHMAP_NA, SNDRV_CHMAP_RL, SNDRV_CHMAP_RR, 105 SNDRV_CHMAP_RC, SNDRV_CHMAP_NA } }, 106 { .channels = 8, /* CA_ID 0x0D */ 107 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_LFE, 108 SNDRV_CHMAP_NA, SNDRV_CHMAP_RL, SNDRV_CHMAP_RR, 109 SNDRV_CHMAP_RC, SNDRV_CHMAP_NA } }, 110 { .channels = 8, /* CA_ID 0x0E */ 111 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_NA, 112 SNDRV_CHMAP_FC, SNDRV_CHMAP_RL, SNDRV_CHMAP_RR, 113 SNDRV_CHMAP_RC, SNDRV_CHMAP_NA } }, 114 { .channels = 8, /* CA_ID 0x0F */ 115 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_LFE, 116 SNDRV_CHMAP_FC, SNDRV_CHMAP_RL, SNDRV_CHMAP_RR, 117 SNDRV_CHMAP_RC, SNDRV_CHMAP_NA } }, 118 { .channels = 8, /* CA_ID 0x10 */ 119 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_NA, 120 SNDRV_CHMAP_NA, SNDRV_CHMAP_RL, SNDRV_CHMAP_RR, 121 SNDRV_CHMAP_RLC, SNDRV_CHMAP_RRC } }, 122 { .channels = 8, /* CA_ID 0x11 */ 123 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_LFE, 124 SNDRV_CHMAP_NA, SNDRV_CHMAP_RL, SNDRV_CHMAP_RR, 125 SNDRV_CHMAP_RLC, SNDRV_CHMAP_RRC } }, 126 { .channels = 8, /* CA_ID 0x12 */ 127 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_NA, 128 SNDRV_CHMAP_FC, SNDRV_CHMAP_RL, SNDRV_CHMAP_RR, 129 SNDRV_CHMAP_RLC, SNDRV_CHMAP_RRC } }, 130 { .channels = 8, /* CA_ID 0x13 */ 131 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_LFE, 132 SNDRV_CHMAP_FC, SNDRV_CHMAP_RL, SNDRV_CHMAP_RR, 133 SNDRV_CHMAP_RLC, SNDRV_CHMAP_RRC } }, 134 { .channels = 8, /* CA_ID 0x14 */ 135 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_NA, 136 SNDRV_CHMAP_NA, SNDRV_CHMAP_NA, SNDRV_CHMAP_NA, 137 SNDRV_CHMAP_FLC, SNDRV_CHMAP_FRC } }, 138 { .channels = 8, /* CA_ID 0x15 */ 139 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_LFE, 140 SNDRV_CHMAP_NA, SNDRV_CHMAP_NA, SNDRV_CHMAP_NA, 141 SNDRV_CHMAP_FLC, SNDRV_CHMAP_FRC } }, 142 { .channels = 8, /* CA_ID 0x16 */ 143 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_NA, 144 SNDRV_CHMAP_FC, SNDRV_CHMAP_NA, SNDRV_CHMAP_NA, 145 SNDRV_CHMAP_FLC, SNDRV_CHMAP_FRC } }, 146 { .channels = 8, /* CA_ID 0x17 */ 147 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_LFE, 148 SNDRV_CHMAP_FC, SNDRV_CHMAP_NA, SNDRV_CHMAP_NA, 149 SNDRV_CHMAP_FLC, SNDRV_CHMAP_FRC } }, 150 { .channels = 8, /* CA_ID 0x18 */ 151 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_NA, 152 SNDRV_CHMAP_NA, SNDRV_CHMAP_NA, SNDRV_CHMAP_NA, 153 SNDRV_CHMAP_FLC, SNDRV_CHMAP_FRC } }, 154 { .channels = 8, /* CA_ID 0x19 */ 155 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_LFE, 156 SNDRV_CHMAP_NA, SNDRV_CHMAP_NA, SNDRV_CHMAP_NA, 157 SNDRV_CHMAP_FLC, SNDRV_CHMAP_FRC } }, 158 { .channels = 8, /* CA_ID 0x1A */ 159 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_NA, 160 SNDRV_CHMAP_FC, SNDRV_CHMAP_NA, SNDRV_CHMAP_NA, 161 SNDRV_CHMAP_FLC, SNDRV_CHMAP_FRC } }, 162 { .channels = 8, /* CA_ID 0x1B */ 163 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_LFE, 164 SNDRV_CHMAP_FC, SNDRV_CHMAP_NA, SNDRV_CHMAP_NA, 165 SNDRV_CHMAP_FLC, SNDRV_CHMAP_FRC } }, 166 { .channels = 8, /* CA_ID 0x1C */ 167 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_NA, 168 SNDRV_CHMAP_NA, SNDRV_CHMAP_NA, SNDRV_CHMAP_NA, 169 SNDRV_CHMAP_FLC, SNDRV_CHMAP_FRC } }, 170 { .channels = 8, /* CA_ID 0x1D */ 171 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_LFE, 172 SNDRV_CHMAP_NA, SNDRV_CHMAP_NA, SNDRV_CHMAP_NA, 173 SNDRV_CHMAP_FLC, SNDRV_CHMAP_FRC } }, 174 { .channels = 8, /* CA_ID 0x1E */ 175 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_NA, 176 SNDRV_CHMAP_FC, SNDRV_CHMAP_NA, SNDRV_CHMAP_NA, 177 SNDRV_CHMAP_FLC, SNDRV_CHMAP_FRC } }, 178 { .channels = 8, /* CA_ID 0x1F */ 179 .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR, SNDRV_CHMAP_LFE, 180 SNDRV_CHMAP_FC, SNDRV_CHMAP_NA, SNDRV_CHMAP_NA, 181 SNDRV_CHMAP_FLC, SNDRV_CHMAP_FRC } }, 182 { } 183 }; 184 185 /* 186 * hdmi_codec_channel_alloc: speaker configuration available for CEA 187 * 188 * This is an ordered list where ca_id must exist in hdmi_codec_8ch_chmaps 189 * The preceding ones have better chances to be selected by 190 * hdmi_codec_get_ch_alloc_table_idx(). 191 */ 192 static const struct hdmi_codec_cea_spk_alloc hdmi_codec_channel_alloc[] = { 193 { .ca_id = 0x00, .n_ch = 2, 194 .mask = FL | FR }, 195 { .ca_id = 0x03, .n_ch = 4, 196 .mask = FL | FR | LFE | FC }, 197 { .ca_id = 0x02, .n_ch = 4, 198 .mask = FL | FR | FC }, 199 { .ca_id = 0x01, .n_ch = 4, 200 .mask = FL | FR | LFE }, 201 { .ca_id = 0x0b, .n_ch = 6, 202 .mask = FL | FR | LFE | FC | RL | RR }, 203 { .ca_id = 0x0a, .n_ch = 6, 204 .mask = FL | FR | FC | RL | RR }, 205 { .ca_id = 0x09, .n_ch = 6, 206 .mask = FL | FR | LFE | RL | RR }, 207 { .ca_id = 0x08, .n_ch = 6, 208 .mask = FL | FR | RL | RR }, 209 { .ca_id = 0x07, .n_ch = 6, 210 .mask = FL | FR | LFE | FC | RC }, 211 { .ca_id = 0x06, .n_ch = 6, 212 .mask = FL | FR | FC | RC }, 213 { .ca_id = 0x05, .n_ch = 6, 214 .mask = FL | FR | LFE | RC }, 215 { .ca_id = 0x04, .n_ch = 6, 216 .mask = FL | FR | RC }, 217 { .ca_id = 0x13, .n_ch = 8, 218 .mask = FL | FR | LFE | FC | RL | RR | RLC | RRC }, 219 { .ca_id = 0x1f, .n_ch = 8, 220 .mask = FL | FR | LFE | FC | RL | RR | FLC | FRC }, 221 { .ca_id = 0x12, .n_ch = 8, 222 .mask = FL | FR | FC | RL | RR | RLC | RRC }, 223 { .ca_id = 0x1e, .n_ch = 8, 224 .mask = FL | FR | FC | RL | RR | FLC | FRC }, 225 { .ca_id = 0x11, .n_ch = 8, 226 .mask = FL | FR | LFE | RL | RR | RLC | RRC }, 227 { .ca_id = 0x1d, .n_ch = 8, 228 .mask = FL | FR | LFE | RL | RR | FLC | FRC }, 229 { .ca_id = 0x10, .n_ch = 8, 230 .mask = FL | FR | RL | RR | RLC | RRC }, 231 { .ca_id = 0x1c, .n_ch = 8, 232 .mask = FL | FR | RL | RR | FLC | FRC }, 233 { .ca_id = 0x0f, .n_ch = 8, 234 .mask = FL | FR | LFE | FC | RL | RR | RC }, 235 { .ca_id = 0x1b, .n_ch = 8, 236 .mask = FL | FR | LFE | RC | FC | FLC | FRC }, 237 { .ca_id = 0x0e, .n_ch = 8, 238 .mask = FL | FR | FC | RL | RR | RC }, 239 { .ca_id = 0x1a, .n_ch = 8, 240 .mask = FL | FR | RC | FC | FLC | FRC }, 241 { .ca_id = 0x0d, .n_ch = 8, 242 .mask = FL | FR | LFE | RL | RR | RC }, 243 { .ca_id = 0x19, .n_ch = 8, 244 .mask = FL | FR | LFE | RC | FLC | FRC }, 245 { .ca_id = 0x0c, .n_ch = 8, 246 .mask = FL | FR | RC | RL | RR }, 247 { .ca_id = 0x18, .n_ch = 8, 248 .mask = FL | FR | RC | FLC | FRC }, 249 { .ca_id = 0x17, .n_ch = 8, 250 .mask = FL | FR | LFE | FC | FLC | FRC }, 251 { .ca_id = 0x16, .n_ch = 8, 252 .mask = FL | FR | FC | FLC | FRC }, 253 { .ca_id = 0x15, .n_ch = 8, 254 .mask = FL | FR | LFE | FLC | FRC }, 255 { .ca_id = 0x14, .n_ch = 8, 256 .mask = FL | FR | FLC | FRC }, 257 { .ca_id = 0x0b, .n_ch = 8, 258 .mask = FL | FR | LFE | FC | RL | RR }, 259 { .ca_id = 0x0a, .n_ch = 8, 260 .mask = FL | FR | FC | RL | RR }, 261 { .ca_id = 0x09, .n_ch = 8, 262 .mask = FL | FR | LFE | RL | RR }, 263 { .ca_id = 0x08, .n_ch = 8, 264 .mask = FL | FR | RL | RR }, 265 { .ca_id = 0x07, .n_ch = 8, 266 .mask = FL | FR | LFE | FC | RC }, 267 { .ca_id = 0x06, .n_ch = 8, 268 .mask = FL | FR | FC | RC }, 269 { .ca_id = 0x05, .n_ch = 8, 270 .mask = FL | FR | LFE | RC }, 271 { .ca_id = 0x04, .n_ch = 8, 272 .mask = FL | FR | RC }, 273 { .ca_id = 0x03, .n_ch = 8, 274 .mask = FL | FR | LFE | FC }, 275 { .ca_id = 0x02, .n_ch = 8, 276 .mask = FL | FR | FC }, 277 { .ca_id = 0x01, .n_ch = 8, 278 .mask = FL | FR | LFE }, 279 }; 280 281 struct hdmi_codec_priv { 282 struct hdmi_codec_pdata hcd; 283 uint8_t eld[MAX_ELD_BYTES]; 284 struct snd_pcm_chmap *chmap_info; 285 unsigned int chmap_idx; 286 struct mutex lock; 287 bool busy; 288 struct snd_soc_jack *jack; 289 unsigned int jack_status; 290 u8 iec_status[AES_IEC958_STATUS_SIZE]; 291 }; 292 293 static const struct snd_soc_dapm_widget hdmi_widgets[] = { 294 SND_SOC_DAPM_OUTPUT("TX"), 295 SND_SOC_DAPM_OUTPUT("RX"), 296 }; 297 298 enum { 299 DAI_ID_I2S = 0, 300 DAI_ID_SPDIF, 301 }; 302 303 static int hdmi_eld_ctl_info(struct snd_kcontrol *kcontrol, 304 struct snd_ctl_elem_info *uinfo) 305 { 306 uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES; 307 uinfo->count = sizeof_field(struct hdmi_codec_priv, eld); 308 309 return 0; 310 } 311 312 static int hdmi_eld_ctl_get(struct snd_kcontrol *kcontrol, 313 struct snd_ctl_elem_value *ucontrol) 314 { 315 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); 316 struct hdmi_codec_priv *hcp = snd_soc_component_get_drvdata(component); 317 318 memcpy(ucontrol->value.bytes.data, hcp->eld, sizeof(hcp->eld)); 319 320 return 0; 321 } 322 323 static unsigned long hdmi_codec_spk_mask_from_alloc(int spk_alloc) 324 { 325 int i; 326 static const unsigned long hdmi_codec_eld_spk_alloc_bits[] = { 327 [0] = FL | FR, [1] = LFE, [2] = FC, [3] = RL | RR, 328 [4] = RC, [5] = FLC | FRC, [6] = RLC | RRC, 329 }; 330 unsigned long spk_mask = 0; 331 332 for (i = 0; i < ARRAY_SIZE(hdmi_codec_eld_spk_alloc_bits); i++) { 333 if (spk_alloc & (1 << i)) 334 spk_mask |= hdmi_codec_eld_spk_alloc_bits[i]; 335 } 336 337 return spk_mask; 338 } 339 340 static void hdmi_codec_eld_chmap(struct hdmi_codec_priv *hcp) 341 { 342 u8 spk_alloc; 343 unsigned long spk_mask; 344 345 spk_alloc = drm_eld_get_spk_alloc(hcp->eld); 346 spk_mask = hdmi_codec_spk_mask_from_alloc(spk_alloc); 347 348 /* Detect if only stereo supported, else return 8 channels mappings */ 349 if ((spk_mask & ~(FL | FR)) && hcp->chmap_info->max_channels > 2) 350 hcp->chmap_info->chmap = hdmi_codec_8ch_chmaps; 351 else 352 hcp->chmap_info->chmap = hdmi_codec_stereo_chmaps; 353 } 354 355 static int hdmi_codec_get_ch_alloc_table_idx(struct hdmi_codec_priv *hcp, 356 unsigned char channels) 357 { 358 int i; 359 u8 spk_alloc; 360 unsigned long spk_mask; 361 const struct hdmi_codec_cea_spk_alloc *cap = hdmi_codec_channel_alloc; 362 363 spk_alloc = drm_eld_get_spk_alloc(hcp->eld); 364 spk_mask = hdmi_codec_spk_mask_from_alloc(spk_alloc); 365 366 for (i = 0; i < ARRAY_SIZE(hdmi_codec_channel_alloc); i++, cap++) { 367 /* If spk_alloc == 0, HDMI is unplugged return stereo config*/ 368 if (!spk_alloc && cap->ca_id == 0) 369 return i; 370 if (cap->n_ch != channels) 371 continue; 372 if (!(cap->mask == (spk_mask & cap->mask))) 373 continue; 374 return i; 375 } 376 377 return -EINVAL; 378 } 379 static int hdmi_codec_chmap_ctl_get(struct snd_kcontrol *kcontrol, 380 struct snd_ctl_elem_value *ucontrol) 381 { 382 unsigned const char *map; 383 unsigned int i; 384 struct snd_pcm_chmap *info = snd_kcontrol_chip(kcontrol); 385 struct hdmi_codec_priv *hcp = info->private_data; 386 387 if (hcp->chmap_idx != HDMI_CODEC_CHMAP_IDX_UNKNOWN) 388 map = info->chmap[hcp->chmap_idx].map; 389 390 for (i = 0; i < info->max_channels; i++) { 391 if (hcp->chmap_idx == HDMI_CODEC_CHMAP_IDX_UNKNOWN) 392 ucontrol->value.integer.value[i] = 0; 393 else 394 ucontrol->value.integer.value[i] = map[i]; 395 } 396 397 return 0; 398 } 399 400 static int hdmi_codec_iec958_info(struct snd_kcontrol *kcontrol, 401 struct snd_ctl_elem_info *uinfo) 402 { 403 uinfo->type = SNDRV_CTL_ELEM_TYPE_IEC958; 404 uinfo->count = 1; 405 return 0; 406 } 407 408 static int hdmi_codec_iec958_default_get(struct snd_kcontrol *kcontrol, 409 struct snd_ctl_elem_value *ucontrol) 410 { 411 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); 412 struct hdmi_codec_priv *hcp = snd_soc_component_get_drvdata(component); 413 414 memcpy(ucontrol->value.iec958.status, hcp->iec_status, 415 sizeof(hcp->iec_status)); 416 417 return 0; 418 } 419 420 static int hdmi_codec_iec958_default_put(struct snd_kcontrol *kcontrol, 421 struct snd_ctl_elem_value *ucontrol) 422 { 423 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); 424 struct hdmi_codec_priv *hcp = snd_soc_component_get_drvdata(component); 425 426 memcpy(hcp->iec_status, ucontrol->value.iec958.status, 427 sizeof(hcp->iec_status)); 428 429 return 0; 430 } 431 432 static int hdmi_codec_iec958_mask_get(struct snd_kcontrol *kcontrol, 433 struct snd_ctl_elem_value *ucontrol) 434 { 435 memset(ucontrol->value.iec958.status, 0xff, 436 sizeof_field(struct hdmi_codec_priv, iec_status)); 437 438 return 0; 439 } 440 441 static int hdmi_codec_startup(struct snd_pcm_substream *substream, 442 struct snd_soc_dai *dai) 443 { 444 struct hdmi_codec_priv *hcp = snd_soc_dai_get_drvdata(dai); 445 bool tx = substream->stream == SNDRV_PCM_STREAM_PLAYBACK; 446 bool has_capture = !hcp->hcd.no_i2s_capture; 447 bool has_playback = !hcp->hcd.no_i2s_playback; 448 int ret = 0; 449 450 if (!((has_playback && tx) || (has_capture && !tx))) 451 return 0; 452 453 mutex_lock(&hcp->lock); 454 if (hcp->busy) { 455 dev_err(dai->dev, "Only one simultaneous stream supported!\n"); 456 mutex_unlock(&hcp->lock); 457 return -EINVAL; 458 } 459 460 if (hcp->hcd.ops->audio_startup) { 461 ret = hcp->hcd.ops->audio_startup(dai->dev->parent, hcp->hcd.data); 462 if (ret) 463 goto err; 464 } 465 466 if (tx && hcp->hcd.ops->get_eld) { 467 ret = hcp->hcd.ops->get_eld(dai->dev->parent, hcp->hcd.data, 468 hcp->eld, sizeof(hcp->eld)); 469 if (ret) 470 goto err; 471 472 ret = snd_pcm_hw_constraint_eld(substream->runtime, hcp->eld); 473 if (ret) 474 goto err; 475 476 /* Select chmap supported */ 477 hdmi_codec_eld_chmap(hcp); 478 } 479 480 hcp->busy = true; 481 482 err: 483 mutex_unlock(&hcp->lock); 484 return ret; 485 } 486 487 static void hdmi_codec_shutdown(struct snd_pcm_substream *substream, 488 struct snd_soc_dai *dai) 489 { 490 struct hdmi_codec_priv *hcp = snd_soc_dai_get_drvdata(dai); 491 bool tx = substream->stream == SNDRV_PCM_STREAM_PLAYBACK; 492 bool has_capture = !hcp->hcd.no_i2s_capture; 493 bool has_playback = !hcp->hcd.no_i2s_playback; 494 495 if (!((has_playback && tx) || (has_capture && !tx))) 496 return; 497 498 hcp->chmap_idx = HDMI_CODEC_CHMAP_IDX_UNKNOWN; 499 hcp->hcd.ops->audio_shutdown(dai->dev->parent, hcp->hcd.data); 500 501 mutex_lock(&hcp->lock); 502 hcp->busy = false; 503 mutex_unlock(&hcp->lock); 504 } 505 506 static int hdmi_codec_fill_codec_params(struct snd_soc_dai *dai, 507 unsigned int sample_width, 508 unsigned int sample_rate, 509 unsigned int channels, 510 struct hdmi_codec_params *hp) 511 { 512 struct hdmi_codec_priv *hcp = snd_soc_dai_get_drvdata(dai); 513 int idx = HDMI_CODEC_CHMAP_IDX_UNKNOWN; 514 u8 ca_id = 0; 515 bool pcm_audio = !(hcp->iec_status[0] & IEC958_AES0_NONAUDIO); 516 517 if (pcm_audio) { 518 /* Select a channel allocation that matches with ELD and pcm channels */ 519 idx = hdmi_codec_get_ch_alloc_table_idx(hcp, channels); 520 521 if (idx < 0) { 522 dev_err(dai->dev, "Not able to map channels to speakers (%d)\n", 523 idx); 524 hcp->chmap_idx = HDMI_CODEC_CHMAP_IDX_UNKNOWN; 525 return idx; 526 } 527 528 ca_id = hdmi_codec_channel_alloc[idx].ca_id; 529 } 530 531 memset(hp, 0, sizeof(*hp)); 532 533 hdmi_audio_infoframe_init(&hp->cea); 534 535 if (pcm_audio) 536 hp->cea.channels = channels; 537 else 538 hp->cea.channels = 0; 539 540 hp->cea.coding_type = HDMI_AUDIO_CODING_TYPE_STREAM; 541 hp->cea.sample_size = HDMI_AUDIO_SAMPLE_SIZE_STREAM; 542 hp->cea.sample_frequency = HDMI_AUDIO_SAMPLE_FREQUENCY_STREAM; 543 hp->cea.channel_allocation = ca_id; 544 545 hp->sample_width = sample_width; 546 hp->sample_rate = sample_rate; 547 hp->channels = channels; 548 549 if (pcm_audio) 550 hcp->chmap_idx = ca_id; 551 else 552 hcp->chmap_idx = HDMI_CODEC_CHMAP_IDX_UNKNOWN; 553 554 return 0; 555 } 556 557 static int hdmi_codec_hw_params(struct snd_pcm_substream *substream, 558 struct snd_pcm_hw_params *params, 559 struct snd_soc_dai *dai) 560 { 561 struct hdmi_codec_priv *hcp = snd_soc_dai_get_drvdata(dai); 562 struct hdmi_codec_daifmt *cf = snd_soc_dai_dma_data_get_playback(dai); 563 struct hdmi_codec_params hp = { 564 .iec = { 565 .status = { 0 }, 566 .subcode = { 0 }, 567 .pad = 0, 568 .dig_subframe = { 0 }, 569 } 570 }; 571 int ret; 572 573 if (!hcp->hcd.ops->hw_params) 574 return 0; 575 576 dev_dbg(dai->dev, "%s() width %d rate %d channels %d\n", __func__, 577 params_width(params), params_rate(params), 578 params_channels(params)); 579 580 ret = hdmi_codec_fill_codec_params(dai, 581 params_width(params), 582 params_rate(params), 583 params_channels(params), 584 &hp); 585 if (ret < 0) 586 return ret; 587 588 memcpy(hp.iec.status, hcp->iec_status, sizeof(hp.iec.status)); 589 ret = snd_pcm_fill_iec958_consumer_hw_params(params, hp.iec.status, 590 sizeof(hp.iec.status)); 591 if (ret < 0) { 592 dev_err(dai->dev, "Creating IEC958 channel status failed %d\n", 593 ret); 594 return ret; 595 } 596 597 cf->bit_fmt = params_format(params); 598 return hcp->hcd.ops->hw_params(dai->dev->parent, hcp->hcd.data, 599 cf, &hp); 600 } 601 602 static int hdmi_codec_prepare(struct snd_pcm_substream *substream, 603 struct snd_soc_dai *dai) 604 { 605 struct hdmi_codec_priv *hcp = snd_soc_dai_get_drvdata(dai); 606 struct hdmi_codec_daifmt *cf = snd_soc_dai_dma_data_get_playback(dai); 607 struct snd_pcm_runtime *runtime = substream->runtime; 608 unsigned int channels = runtime->channels; 609 unsigned int width = snd_pcm_format_width(runtime->format); 610 unsigned int rate = runtime->rate; 611 struct hdmi_codec_params hp; 612 int ret; 613 614 if (!hcp->hcd.ops->prepare) 615 return 0; 616 617 dev_dbg(dai->dev, "%s() width %d rate %d channels %d\n", __func__, 618 width, rate, channels); 619 620 ret = hdmi_codec_fill_codec_params(dai, width, rate, channels, &hp); 621 if (ret < 0) 622 return ret; 623 624 memcpy(hp.iec.status, hcp->iec_status, sizeof(hp.iec.status)); 625 ret = snd_pcm_fill_iec958_consumer(runtime, hp.iec.status, 626 sizeof(hp.iec.status)); 627 if (ret < 0) { 628 dev_err(dai->dev, "Creating IEC958 channel status failed %d\n", 629 ret); 630 return ret; 631 } 632 633 cf->bit_fmt = runtime->format; 634 return hcp->hcd.ops->prepare(dai->dev->parent, hcp->hcd.data, 635 cf, &hp); 636 } 637 638 static int hdmi_codec_i2s_set_fmt(struct snd_soc_dai *dai, 639 unsigned int fmt) 640 { 641 struct hdmi_codec_daifmt *cf = snd_soc_dai_dma_data_get_playback(dai); 642 643 /* Reset daifmt */ 644 memset(cf, 0, sizeof(*cf)); 645 646 switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) { 647 case SND_SOC_DAIFMT_CBP_CFP: 648 cf->bit_clk_provider = 1; 649 cf->frame_clk_provider = 1; 650 break; 651 case SND_SOC_DAIFMT_CBC_CFP: 652 cf->frame_clk_provider = 1; 653 break; 654 case SND_SOC_DAIFMT_CBP_CFC: 655 cf->bit_clk_provider = 1; 656 break; 657 case SND_SOC_DAIFMT_CBC_CFC: 658 break; 659 default: 660 return -EINVAL; 661 } 662 663 switch (fmt & SND_SOC_DAIFMT_INV_MASK) { 664 case SND_SOC_DAIFMT_NB_NF: 665 break; 666 case SND_SOC_DAIFMT_NB_IF: 667 cf->frame_clk_inv = 1; 668 break; 669 case SND_SOC_DAIFMT_IB_NF: 670 cf->bit_clk_inv = 1; 671 break; 672 case SND_SOC_DAIFMT_IB_IF: 673 cf->frame_clk_inv = 1; 674 cf->bit_clk_inv = 1; 675 break; 676 } 677 678 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { 679 case SND_SOC_DAIFMT_I2S: 680 cf->fmt = HDMI_I2S; 681 break; 682 case SND_SOC_DAIFMT_DSP_A: 683 cf->fmt = HDMI_DSP_A; 684 break; 685 case SND_SOC_DAIFMT_DSP_B: 686 cf->fmt = HDMI_DSP_B; 687 break; 688 case SND_SOC_DAIFMT_RIGHT_J: 689 cf->fmt = HDMI_RIGHT_J; 690 break; 691 case SND_SOC_DAIFMT_LEFT_J: 692 cf->fmt = HDMI_LEFT_J; 693 break; 694 case SND_SOC_DAIFMT_AC97: 695 cf->fmt = HDMI_AC97; 696 break; 697 default: 698 dev_err(dai->dev, "Invalid DAI interface format\n"); 699 return -EINVAL; 700 } 701 702 return 0; 703 } 704 705 static int hdmi_codec_mute(struct snd_soc_dai *dai, int mute, int direction) 706 { 707 struct hdmi_codec_priv *hcp = snd_soc_dai_get_drvdata(dai); 708 709 /* 710 * ignore if direction was CAPTURE 711 * and it had .no_capture_mute flag 712 * see 713 * snd_soc_dai_digital_mute() 714 */ 715 if (hcp->hcd.ops->mute_stream && 716 (direction == SNDRV_PCM_STREAM_PLAYBACK || 717 !hcp->hcd.ops->no_capture_mute)) 718 return hcp->hcd.ops->mute_stream(dai->dev->parent, 719 hcp->hcd.data, 720 mute, direction); 721 722 return -ENOTSUPP; 723 } 724 725 /* 726 * This driver can select all SND_SOC_DAIFMT_CBx_CFx, 727 * but need to be selected from Sound Card, not be auto selected. 728 * Because it might be used from other driver. 729 * For example, 730 * ${LINUX}/drivers/gpu/drm/bridge/synopsys/dw-hdmi-i2s-audio.c 731 */ 732 static const u64 hdmi_codec_formats = 733 SND_SOC_POSSIBLE_DAIFMT_NB_NF | 734 SND_SOC_POSSIBLE_DAIFMT_NB_IF | 735 SND_SOC_POSSIBLE_DAIFMT_IB_NF | 736 SND_SOC_POSSIBLE_DAIFMT_IB_IF | 737 SND_SOC_POSSIBLE_DAIFMT_I2S | 738 SND_SOC_POSSIBLE_DAIFMT_DSP_A | 739 SND_SOC_POSSIBLE_DAIFMT_DSP_B | 740 SND_SOC_POSSIBLE_DAIFMT_RIGHT_J | 741 SND_SOC_POSSIBLE_DAIFMT_LEFT_J | 742 SND_SOC_POSSIBLE_DAIFMT_AC97; 743 744 #define HDMI_RATES (SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |\ 745 SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |\ 746 SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |\ 747 SNDRV_PCM_RATE_192000) 748 749 #define SPDIF_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\ 750 SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S24_LE) 751 752 /* 753 * This list is only for formats allowed on the I2S bus. So there is 754 * some formats listed that are not supported by HDMI interface. For 755 * instance allowing the 32-bit formats enables 24-precision with CPU 756 * DAIs that do not support 24-bit formats. If the extra formats cause 757 * problems, we should add the video side driver an option to disable 758 * them. 759 */ 760 #define I2S_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\ 761 SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S24_LE |\ 762 SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE) 763 764 static struct snd_kcontrol_new hdmi_codec_controls[] = { 765 { 766 .access = SNDRV_CTL_ELEM_ACCESS_READ, 767 .iface = SNDRV_CTL_ELEM_IFACE_PCM, 768 .name = SNDRV_CTL_NAME_IEC958("", PLAYBACK, MASK), 769 .info = hdmi_codec_iec958_info, 770 .get = hdmi_codec_iec958_mask_get, 771 }, 772 { 773 .iface = SNDRV_CTL_ELEM_IFACE_PCM, 774 .name = SNDRV_CTL_NAME_IEC958("", PLAYBACK, DEFAULT), 775 .info = hdmi_codec_iec958_info, 776 .get = hdmi_codec_iec958_default_get, 777 .put = hdmi_codec_iec958_default_put, 778 }, 779 { 780 .access = (SNDRV_CTL_ELEM_ACCESS_READ | 781 SNDRV_CTL_ELEM_ACCESS_VOLATILE), 782 .iface = SNDRV_CTL_ELEM_IFACE_PCM, 783 .name = "ELD", 784 .info = hdmi_eld_ctl_info, 785 .get = hdmi_eld_ctl_get, 786 }, 787 }; 788 789 static int hdmi_codec_pcm_new(struct snd_soc_pcm_runtime *rtd, 790 struct snd_soc_dai *dai) 791 { 792 struct snd_soc_dai_driver *drv = dai->driver; 793 struct hdmi_codec_priv *hcp = snd_soc_dai_get_drvdata(dai); 794 unsigned int i; 795 int ret; 796 797 ret = snd_pcm_add_chmap_ctls(rtd->pcm, SNDRV_PCM_STREAM_PLAYBACK, 798 NULL, drv->playback.channels_max, 0, 799 &hcp->chmap_info); 800 if (ret < 0) 801 return ret; 802 803 /* override handlers */ 804 hcp->chmap_info->private_data = hcp; 805 hcp->chmap_info->kctl->get = hdmi_codec_chmap_ctl_get; 806 807 /* default chmap supported is stereo */ 808 hcp->chmap_info->chmap = hdmi_codec_stereo_chmaps; 809 hcp->chmap_idx = HDMI_CODEC_CHMAP_IDX_UNKNOWN; 810 811 for (i = 0; i < ARRAY_SIZE(hdmi_codec_controls); i++) { 812 struct snd_kcontrol *kctl; 813 814 /* add ELD ctl with the device number corresponding to the PCM stream */ 815 kctl = snd_ctl_new1(&hdmi_codec_controls[i], dai->component); 816 if (!kctl) 817 return -ENOMEM; 818 819 kctl->id.device = rtd->pcm->device; 820 ret = snd_ctl_add(rtd->card->snd_card, kctl); 821 if (ret < 0) 822 return ret; 823 } 824 825 return 0; 826 } 827 828 static int hdmi_dai_probe(struct snd_soc_dai *dai) 829 { 830 struct snd_soc_dapm_context *dapm; 831 struct hdmi_codec_daifmt *daifmt; 832 struct snd_soc_dapm_route route[] = { 833 { 834 .sink = "TX", 835 .source = dai->driver->playback.stream_name, 836 }, 837 { 838 .sink = dai->driver->capture.stream_name, 839 .source = "RX", 840 }, 841 }; 842 int ret, i; 843 844 dapm = snd_soc_component_get_dapm(dai->component); 845 846 /* One of the directions might be omitted for unidirectional DAIs */ 847 for (i = 0; i < ARRAY_SIZE(route); i++) { 848 if (!route[i].source || !route[i].sink) 849 continue; 850 851 ret = snd_soc_dapm_add_routes(dapm, &route[i], 1); 852 if (ret) 853 return ret; 854 } 855 856 daifmt = devm_kzalloc(dai->dev, sizeof(*daifmt), GFP_KERNEL); 857 if (!daifmt) 858 return -ENOMEM; 859 860 snd_soc_dai_dma_data_set_playback(dai, daifmt); 861 862 return 0; 863 } 864 865 static void hdmi_codec_jack_report(struct hdmi_codec_priv *hcp, 866 unsigned int jack_status) 867 { 868 if (jack_status != hcp->jack_status) { 869 if (hcp->jack) 870 snd_soc_jack_report(hcp->jack, jack_status, SND_JACK_LINEOUT); 871 hcp->jack_status = jack_status; 872 } 873 } 874 875 static void plugged_cb(struct device *dev, bool plugged) 876 { 877 struct hdmi_codec_priv *hcp = dev_get_drvdata(dev); 878 879 if (plugged) { 880 if (hcp->hcd.ops->get_eld) { 881 hcp->hcd.ops->get_eld(dev->parent, hcp->hcd.data, 882 hcp->eld, sizeof(hcp->eld)); 883 } 884 hdmi_codec_jack_report(hcp, SND_JACK_LINEOUT); 885 } else { 886 hdmi_codec_jack_report(hcp, 0); 887 memset(hcp->eld, 0, sizeof(hcp->eld)); 888 } 889 } 890 891 static int hdmi_codec_set_jack(struct snd_soc_component *component, 892 struct snd_soc_jack *jack, 893 void *data) 894 { 895 struct hdmi_codec_priv *hcp = snd_soc_component_get_drvdata(component); 896 897 if (hcp->hcd.ops->hook_plugged_cb) { 898 hcp->jack = jack; 899 900 /* 901 * Report the initial jack status which may have been provided 902 * by the parent hdmi driver while the hpd hook was registered. 903 */ 904 snd_soc_jack_report(jack, hcp->jack_status, SND_JACK_LINEOUT); 905 906 return 0; 907 } 908 909 return -ENOTSUPP; 910 } 911 912 static int hdmi_dai_spdif_probe(struct snd_soc_dai *dai) 913 { 914 struct hdmi_codec_daifmt *cf; 915 int ret; 916 917 ret = hdmi_dai_probe(dai); 918 if (ret) 919 return ret; 920 921 cf = snd_soc_dai_dma_data_get_playback(dai); 922 cf->fmt = HDMI_SPDIF; 923 924 return 0; 925 } 926 927 static const struct snd_soc_dai_ops hdmi_codec_i2s_dai_ops = { 928 .probe = hdmi_dai_probe, 929 .startup = hdmi_codec_startup, 930 .shutdown = hdmi_codec_shutdown, 931 .hw_params = hdmi_codec_hw_params, 932 .prepare = hdmi_codec_prepare, 933 .set_fmt = hdmi_codec_i2s_set_fmt, 934 .mute_stream = hdmi_codec_mute, 935 .pcm_new = hdmi_codec_pcm_new, 936 .auto_selectable_formats = &hdmi_codec_formats, 937 .num_auto_selectable_formats = 1, 938 }; 939 940 static const struct snd_soc_dai_ops hdmi_codec_spdif_dai_ops = { 941 .probe = hdmi_dai_spdif_probe, 942 .startup = hdmi_codec_startup, 943 .shutdown = hdmi_codec_shutdown, 944 .hw_params = hdmi_codec_hw_params, 945 .mute_stream = hdmi_codec_mute, 946 .pcm_new = hdmi_codec_pcm_new, 947 }; 948 949 static const struct snd_soc_dai_driver hdmi_i2s_dai = { 950 .name = "i2s-hifi", 951 .id = DAI_ID_I2S, 952 .playback = { 953 .stream_name = "I2S Playback", 954 .channels_min = 2, 955 .channels_max = 8, 956 .rates = HDMI_RATES, 957 .formats = I2S_FORMATS, 958 .sig_bits = 24, 959 }, 960 .capture = { 961 .stream_name = "Capture", 962 .channels_min = 2, 963 .channels_max = 8, 964 .rates = HDMI_RATES, 965 .formats = I2S_FORMATS, 966 .sig_bits = 24, 967 }, 968 .ops = &hdmi_codec_i2s_dai_ops, 969 }; 970 971 static const struct snd_soc_dai_driver hdmi_spdif_dai = { 972 .name = "spdif-hifi", 973 .id = DAI_ID_SPDIF, 974 .playback = { 975 .stream_name = "SPDIF Playback", 976 .channels_min = 2, 977 .channels_max = 2, 978 .rates = HDMI_RATES, 979 .formats = SPDIF_FORMATS, 980 }, 981 .capture = { 982 .stream_name = "Capture", 983 .channels_min = 2, 984 .channels_max = 2, 985 .rates = HDMI_RATES, 986 .formats = SPDIF_FORMATS, 987 }, 988 .ops = &hdmi_codec_spdif_dai_ops, 989 }; 990 991 static int hdmi_of_xlate_dai_id(struct snd_soc_component *component, 992 struct device_node *endpoint) 993 { 994 struct hdmi_codec_priv *hcp = snd_soc_component_get_drvdata(component); 995 int ret = -ENOTSUPP; /* see snd_soc_get_dai_id() */ 996 997 if (hcp->hcd.ops->get_dai_id) 998 ret = hcp->hcd.ops->get_dai_id(component, endpoint); 999 1000 return ret; 1001 } 1002 1003 static int hdmi_probe(struct snd_soc_component *component) 1004 { 1005 struct hdmi_codec_priv *hcp = snd_soc_component_get_drvdata(component); 1006 int ret = 0; 1007 1008 if (hcp->hcd.ops->hook_plugged_cb) { 1009 ret = hcp->hcd.ops->hook_plugged_cb(component->dev->parent, 1010 hcp->hcd.data, 1011 plugged_cb, 1012 component->dev); 1013 } 1014 1015 return ret; 1016 } 1017 1018 static void hdmi_remove(struct snd_soc_component *component) 1019 { 1020 struct hdmi_codec_priv *hcp = snd_soc_component_get_drvdata(component); 1021 1022 if (hcp->hcd.ops->hook_plugged_cb) 1023 hcp->hcd.ops->hook_plugged_cb(component->dev->parent, 1024 hcp->hcd.data, NULL, NULL); 1025 } 1026 1027 static const struct snd_soc_component_driver hdmi_driver = { 1028 .probe = hdmi_probe, 1029 .remove = hdmi_remove, 1030 .dapm_widgets = hdmi_widgets, 1031 .num_dapm_widgets = ARRAY_SIZE(hdmi_widgets), 1032 .of_xlate_dai_id = hdmi_of_xlate_dai_id, 1033 .idle_bias_on = 1, 1034 .use_pmdown_time = 1, 1035 .endianness = 1, 1036 .set_jack = hdmi_codec_set_jack, 1037 }; 1038 1039 static int hdmi_codec_probe(struct platform_device *pdev) 1040 { 1041 struct hdmi_codec_pdata *hcd = pdev->dev.platform_data; 1042 struct snd_soc_dai_driver *daidrv; 1043 struct device *dev = &pdev->dev; 1044 struct hdmi_codec_priv *hcp; 1045 int dai_count, i = 0; 1046 int ret; 1047 1048 if (!hcd) { 1049 dev_err(dev, "%s: No platform data\n", __func__); 1050 return -EINVAL; 1051 } 1052 1053 dai_count = hcd->i2s + hcd->spdif; 1054 if (dai_count < 1 || !hcd->ops || 1055 (!hcd->ops->hw_params && !hcd->ops->prepare) || 1056 !hcd->ops->audio_shutdown) { 1057 dev_err(dev, "%s: Invalid parameters\n", __func__); 1058 return -EINVAL; 1059 } 1060 1061 hcp = devm_kzalloc(dev, sizeof(*hcp), GFP_KERNEL); 1062 if (!hcp) 1063 return -ENOMEM; 1064 1065 hcp->hcd = *hcd; 1066 mutex_init(&hcp->lock); 1067 1068 ret = snd_pcm_create_iec958_consumer_default(hcp->iec_status, 1069 sizeof(hcp->iec_status)); 1070 if (ret < 0) 1071 return ret; 1072 1073 daidrv = devm_kcalloc(dev, dai_count, sizeof(*daidrv), GFP_KERNEL); 1074 if (!daidrv) 1075 return -ENOMEM; 1076 1077 if (hcd->i2s) { 1078 daidrv[i] = hdmi_i2s_dai; 1079 daidrv[i].playback.channels_max = hcd->max_i2s_channels; 1080 if (hcd->no_i2s_playback) 1081 memset(&daidrv[i].playback, 0, 1082 sizeof(daidrv[i].playback)); 1083 if (hcd->no_i2s_capture) 1084 memset(&daidrv[i].capture, 0, 1085 sizeof(daidrv[i].capture)); 1086 i++; 1087 } 1088 1089 if (hcd->spdif) { 1090 daidrv[i] = hdmi_spdif_dai; 1091 if (hcd->no_spdif_playback) 1092 memset(&daidrv[i].playback, 0, 1093 sizeof(daidrv[i].playback)); 1094 if (hcd->no_spdif_capture) 1095 memset(&daidrv[i].capture, 0, 1096 sizeof(daidrv[i].capture)); 1097 } 1098 1099 dev_set_drvdata(dev, hcp); 1100 1101 ret = devm_snd_soc_register_component(dev, &hdmi_driver, daidrv, 1102 dai_count); 1103 if (ret) { 1104 dev_err(dev, "%s: snd_soc_register_component() failed (%d)\n", 1105 __func__, ret); 1106 return ret; 1107 } 1108 return 0; 1109 } 1110 1111 static struct platform_driver hdmi_codec_driver = { 1112 .driver = { 1113 .name = HDMI_CODEC_DRV_NAME, 1114 }, 1115 .probe = hdmi_codec_probe, 1116 }; 1117 1118 module_platform_driver(hdmi_codec_driver); 1119 1120 MODULE_AUTHOR("Jyri Sarha <jsarha@ti.com>"); 1121 MODULE_DESCRIPTION("HDMI Audio Codec Driver"); 1122 MODULE_LICENSE("GPL"); 1123 MODULE_ALIAS("platform:" HDMI_CODEC_DRV_NAME); 1124