HID: hiddev: Fix slab-out-of-bounds write in hiddev_ioctl_usage()
[linux/fpc-iii.git] / sound / pci / hda / patch_hdmi.c
blobb249b1b857464de3e428f54261ffba5798bf69ea
1 /*
3 * patch_hdmi.c - routines for HDMI/DisplayPort codecs
5 * Copyright(c) 2008-2010 Intel Corporation. All rights reserved.
6 * Copyright (c) 2006 ATI Technologies Inc.
7 * Copyright (c) 2008 NVIDIA Corp. All rights reserved.
8 * Copyright (c) 2008 Wei Ni <wni@nvidia.com>
9 * Copyright (c) 2013 Anssi Hannula <anssi.hannula@iki.fi>
11 * Authors:
12 * Wu Fengguang <wfg@linux.intel.com>
14 * Maintained by:
15 * Wu Fengguang <wfg@linux.intel.com>
17 * This program is free software; you can redistribute it and/or modify it
18 * under the terms of the GNU General Public License as published by the Free
19 * Software Foundation; either version 2 of the License, or (at your option)
20 * any later version.
22 * This program is distributed in the hope that it will be useful, but
23 * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
24 * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
25 * for more details.
27 * You should have received a copy of the GNU General Public License
28 * along with this program; if not, write to the Free Software Foundation,
29 * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
32 #include <linux/init.h>
33 #include <linux/delay.h>
34 #include <linux/slab.h>
35 #include <linux/module.h>
36 #include <sound/core.h>
37 #include <sound/jack.h>
38 #include <sound/asoundef.h>
39 #include <sound/tlv.h>
40 #include <sound/hdaudio.h>
41 #include <sound/hda_i915.h>
42 #include "hda_codec.h"
43 #include "hda_local.h"
44 #include "hda_jack.h"
46 static bool static_hdmi_pcm;
47 module_param(static_hdmi_pcm, bool, 0644);
48 MODULE_PARM_DESC(static_hdmi_pcm, "Don't restrict PCM parameters per ELD info");
50 #define is_haswell(codec) ((codec)->core.vendor_id == 0x80862807)
51 #define is_broadwell(codec) ((codec)->core.vendor_id == 0x80862808)
52 #define is_skylake(codec) ((codec)->core.vendor_id == 0x80862809)
53 #define is_broxton(codec) ((codec)->core.vendor_id == 0x8086280a)
54 #define is_kabylake(codec) ((codec)->core.vendor_id == 0x8086280b)
55 #define is_haswell_plus(codec) (is_haswell(codec) || is_broadwell(codec) \
56 || is_skylake(codec) || is_broxton(codec) \
57 || is_kabylake(codec))
59 #define is_valleyview(codec) ((codec)->core.vendor_id == 0x80862882)
60 #define is_cherryview(codec) ((codec)->core.vendor_id == 0x80862883)
61 #define is_valleyview_plus(codec) (is_valleyview(codec) || is_cherryview(codec))
63 struct hdmi_spec_per_cvt {
64 hda_nid_t cvt_nid;
65 int assigned;
66 unsigned int channels_min;
67 unsigned int channels_max;
68 u32 rates;
69 u64 formats;
70 unsigned int maxbps;
73 /* max. connections to a widget */
74 #define HDA_MAX_CONNECTIONS 32
76 struct hdmi_spec_per_pin {
77 hda_nid_t pin_nid;
78 int num_mux_nids;
79 hda_nid_t mux_nids[HDA_MAX_CONNECTIONS];
80 int mux_idx;
81 hda_nid_t cvt_nid;
83 struct hda_codec *codec;
84 struct hdmi_eld sink_eld;
85 struct mutex lock;
86 struct delayed_work work;
87 struct snd_kcontrol *eld_ctl;
88 int repoll_count;
89 bool setup; /* the stream has been set up by prepare callback */
90 int channels; /* current number of channels */
91 bool non_pcm;
92 bool chmap_set; /* channel-map override by ALSA API? */
93 unsigned char chmap[8]; /* ALSA API channel-map */
94 #ifdef CONFIG_SND_PROC_FS
95 struct snd_info_entry *proc_entry;
96 #endif
99 struct cea_channel_speaker_allocation;
101 /* operations used by generic code that can be overridden by patches */
102 struct hdmi_ops {
103 int (*pin_get_eld)(struct hda_codec *codec, hda_nid_t pin_nid,
104 unsigned char *buf, int *eld_size);
106 /* get and set channel assigned to each HDMI ASP (audio sample packet) slot */
107 int (*pin_get_slot_channel)(struct hda_codec *codec, hda_nid_t pin_nid,
108 int asp_slot);
109 int (*pin_set_slot_channel)(struct hda_codec *codec, hda_nid_t pin_nid,
110 int asp_slot, int channel);
112 void (*pin_setup_infoframe)(struct hda_codec *codec, hda_nid_t pin_nid,
113 int ca, int active_channels, int conn_type);
115 /* enable/disable HBR (HD passthrough) */
116 int (*pin_hbr_setup)(struct hda_codec *codec, hda_nid_t pin_nid, bool hbr);
118 int (*setup_stream)(struct hda_codec *codec, hda_nid_t cvt_nid,
119 hda_nid_t pin_nid, u32 stream_tag, int format);
121 /* Helpers for producing the channel map TLVs. These can be overridden
122 * for devices that have non-standard mapping requirements. */
123 int (*chmap_cea_alloc_validate_get_type)(struct cea_channel_speaker_allocation *cap,
124 int channels);
125 void (*cea_alloc_to_tlv_chmap)(struct cea_channel_speaker_allocation *cap,
126 unsigned int *chmap, int channels);
128 /* check that the user-given chmap is supported */
129 int (*chmap_validate)(int ca, int channels, unsigned char *chmap);
132 struct hdmi_spec {
133 int num_cvts;
134 struct snd_array cvts; /* struct hdmi_spec_per_cvt */
135 hda_nid_t cvt_nids[4]; /* only for haswell fix */
137 int num_pins;
138 struct snd_array pins; /* struct hdmi_spec_per_pin */
139 struct hda_pcm *pcm_rec[16];
140 unsigned int channels_max; /* max over all cvts */
142 struct hdmi_eld temp_eld;
143 struct hdmi_ops ops;
145 bool dyn_pin_out;
148 * Non-generic VIA/NVIDIA specific
150 struct hda_multi_out multiout;
151 struct hda_pcm_stream pcm_playback;
153 /* i915/powerwell (Haswell+/Valleyview+) specific */
154 struct i915_audio_component_audio_ops i915_audio_ops;
158 struct hdmi_audio_infoframe {
159 u8 type; /* 0x84 */
160 u8 ver; /* 0x01 */
161 u8 len; /* 0x0a */
163 u8 checksum;
165 u8 CC02_CT47; /* CC in bits 0:2, CT in 4:7 */
166 u8 SS01_SF24;
167 u8 CXT04;
168 u8 CA;
169 u8 LFEPBL01_LSV36_DM_INH7;
172 struct dp_audio_infoframe {
173 u8 type; /* 0x84 */
174 u8 len; /* 0x1b */
175 u8 ver; /* 0x11 << 2 */
177 u8 CC02_CT47; /* match with HDMI infoframe from this on */
178 u8 SS01_SF24;
179 u8 CXT04;
180 u8 CA;
181 u8 LFEPBL01_LSV36_DM_INH7;
184 union audio_infoframe {
185 struct hdmi_audio_infoframe hdmi;
186 struct dp_audio_infoframe dp;
187 u8 bytes[0];
191 * CEA speaker placement:
193 * FLH FCH FRH
194 * FLW FL FLC FC FRC FR FRW
196 * LFE
197 * TC
199 * RL RLC RC RRC RR
201 * The Left/Right Surround channel _notions_ LS/RS in SMPTE 320M corresponds to
202 * CEA RL/RR; The SMPTE channel _assignment_ C/LFE is swapped to CEA LFE/FC.
204 enum cea_speaker_placement {
205 FL = (1 << 0), /* Front Left */
206 FC = (1 << 1), /* Front Center */
207 FR = (1 << 2), /* Front Right */
208 FLC = (1 << 3), /* Front Left Center */
209 FRC = (1 << 4), /* Front Right Center */
210 RL = (1 << 5), /* Rear Left */
211 RC = (1 << 6), /* Rear Center */
212 RR = (1 << 7), /* Rear Right */
213 RLC = (1 << 8), /* Rear Left Center */
214 RRC = (1 << 9), /* Rear Right Center */
215 LFE = (1 << 10), /* Low Frequency Effect */
216 FLW = (1 << 11), /* Front Left Wide */
217 FRW = (1 << 12), /* Front Right Wide */
218 FLH = (1 << 13), /* Front Left High */
219 FCH = (1 << 14), /* Front Center High */
220 FRH = (1 << 15), /* Front Right High */
221 TC = (1 << 16), /* Top Center */
225 * ELD SA bits in the CEA Speaker Allocation data block
227 static int eld_speaker_allocation_bits[] = {
228 [0] = FL | FR,
229 [1] = LFE,
230 [2] = FC,
231 [3] = RL | RR,
232 [4] = RC,
233 [5] = FLC | FRC,
234 [6] = RLC | RRC,
235 /* the following are not defined in ELD yet */
236 [7] = FLW | FRW,
237 [8] = FLH | FRH,
238 [9] = TC,
239 [10] = FCH,
242 struct cea_channel_speaker_allocation {
243 int ca_index;
244 int speakers[8];
246 /* derived values, just for convenience */
247 int channels;
248 int spk_mask;
252 * ALSA sequence is:
254 * surround40 surround41 surround50 surround51 surround71
255 * ch0 front left = = = =
256 * ch1 front right = = = =
257 * ch2 rear left = = = =
258 * ch3 rear right = = = =
259 * ch4 LFE center center center
260 * ch5 LFE LFE
261 * ch6 side left
262 * ch7 side right
264 * surround71 = {FL, FR, RLC, RRC, FC, LFE, RL, RR}
266 static int hdmi_channel_mapping[0x32][8] = {
267 /* stereo */
268 [0x00] = { 0x00, 0x11, 0xf2, 0xf3, 0xf4, 0xf5, 0xf6, 0xf7 },
269 /* 2.1 */
270 [0x01] = { 0x00, 0x11, 0x22, 0xf3, 0xf4, 0xf5, 0xf6, 0xf7 },
271 /* Dolby Surround */
272 [0x02] = { 0x00, 0x11, 0x23, 0xf2, 0xf4, 0xf5, 0xf6, 0xf7 },
273 /* surround40 */
274 [0x08] = { 0x00, 0x11, 0x24, 0x35, 0xf3, 0xf2, 0xf6, 0xf7 },
275 /* 4ch */
276 [0x03] = { 0x00, 0x11, 0x23, 0x32, 0x44, 0xf5, 0xf6, 0xf7 },
277 /* surround41 */
278 [0x09] = { 0x00, 0x11, 0x24, 0x35, 0x42, 0xf3, 0xf6, 0xf7 },
279 /* surround50 */
280 [0x0a] = { 0x00, 0x11, 0x24, 0x35, 0x43, 0xf2, 0xf6, 0xf7 },
281 /* surround51 */
282 [0x0b] = { 0x00, 0x11, 0x24, 0x35, 0x43, 0x52, 0xf6, 0xf7 },
283 /* 7.1 */
284 [0x13] = { 0x00, 0x11, 0x26, 0x37, 0x43, 0x52, 0x64, 0x75 },
288 * This is an ordered list!
290 * The preceding ones have better chances to be selected by
291 * hdmi_channel_allocation().
293 static struct cea_channel_speaker_allocation channel_allocations[] = {
294 /* channel: 7 6 5 4 3 2 1 0 */
295 { .ca_index = 0x00, .speakers = { 0, 0, 0, 0, 0, 0, FR, FL } },
296 /* 2.1 */
297 { .ca_index = 0x01, .speakers = { 0, 0, 0, 0, 0, LFE, FR, FL } },
298 /* Dolby Surround */
299 { .ca_index = 0x02, .speakers = { 0, 0, 0, 0, FC, 0, FR, FL } },
300 /* surround40 */
301 { .ca_index = 0x08, .speakers = { 0, 0, RR, RL, 0, 0, FR, FL } },
302 /* surround41 */
303 { .ca_index = 0x09, .speakers = { 0, 0, RR, RL, 0, LFE, FR, FL } },
304 /* surround50 */
305 { .ca_index = 0x0a, .speakers = { 0, 0, RR, RL, FC, 0, FR, FL } },
306 /* surround51 */
307 { .ca_index = 0x0b, .speakers = { 0, 0, RR, RL, FC, LFE, FR, FL } },
308 /* 6.1 */
309 { .ca_index = 0x0f, .speakers = { 0, RC, RR, RL, FC, LFE, FR, FL } },
310 /* surround71 */
311 { .ca_index = 0x13, .speakers = { RRC, RLC, RR, RL, FC, LFE, FR, FL } },
313 { .ca_index = 0x03, .speakers = { 0, 0, 0, 0, FC, LFE, FR, FL } },
314 { .ca_index = 0x04, .speakers = { 0, 0, 0, RC, 0, 0, FR, FL } },
315 { .ca_index = 0x05, .speakers = { 0, 0, 0, RC, 0, LFE, FR, FL } },
316 { .ca_index = 0x06, .speakers = { 0, 0, 0, RC, FC, 0, FR, FL } },
317 { .ca_index = 0x07, .speakers = { 0, 0, 0, RC, FC, LFE, FR, FL } },
318 { .ca_index = 0x0c, .speakers = { 0, RC, RR, RL, 0, 0, FR, FL } },
319 { .ca_index = 0x0d, .speakers = { 0, RC, RR, RL, 0, LFE, FR, FL } },
320 { .ca_index = 0x0e, .speakers = { 0, RC, RR, RL, FC, 0, FR, FL } },
321 { .ca_index = 0x10, .speakers = { RRC, RLC, RR, RL, 0, 0, FR, FL } },
322 { .ca_index = 0x11, .speakers = { RRC, RLC, RR, RL, 0, LFE, FR, FL } },
323 { .ca_index = 0x12, .speakers = { RRC, RLC, RR, RL, FC, 0, FR, FL } },
324 { .ca_index = 0x14, .speakers = { FRC, FLC, 0, 0, 0, 0, FR, FL } },
325 { .ca_index = 0x15, .speakers = { FRC, FLC, 0, 0, 0, LFE, FR, FL } },
326 { .ca_index = 0x16, .speakers = { FRC, FLC, 0, 0, FC, 0, FR, FL } },
327 { .ca_index = 0x17, .speakers = { FRC, FLC, 0, 0, FC, LFE, FR, FL } },
328 { .ca_index = 0x18, .speakers = { FRC, FLC, 0, RC, 0, 0, FR, FL } },
329 { .ca_index = 0x19, .speakers = { FRC, FLC, 0, RC, 0, LFE, FR, FL } },
330 { .ca_index = 0x1a, .speakers = { FRC, FLC, 0, RC, FC, 0, FR, FL } },
331 { .ca_index = 0x1b, .speakers = { FRC, FLC, 0, RC, FC, LFE, FR, FL } },
332 { .ca_index = 0x1c, .speakers = { FRC, FLC, RR, RL, 0, 0, FR, FL } },
333 { .ca_index = 0x1d, .speakers = { FRC, FLC, RR, RL, 0, LFE, FR, FL } },
334 { .ca_index = 0x1e, .speakers = { FRC, FLC, RR, RL, FC, 0, FR, FL } },
335 { .ca_index = 0x1f, .speakers = { FRC, FLC, RR, RL, FC, LFE, FR, FL } },
336 { .ca_index = 0x20, .speakers = { 0, FCH, RR, RL, FC, 0, FR, FL } },
337 { .ca_index = 0x21, .speakers = { 0, FCH, RR, RL, FC, LFE, FR, FL } },
338 { .ca_index = 0x22, .speakers = { TC, 0, RR, RL, FC, 0, FR, FL } },
339 { .ca_index = 0x23, .speakers = { TC, 0, RR, RL, FC, LFE, FR, FL } },
340 { .ca_index = 0x24, .speakers = { FRH, FLH, RR, RL, 0, 0, FR, FL } },
341 { .ca_index = 0x25, .speakers = { FRH, FLH, RR, RL, 0, LFE, FR, FL } },
342 { .ca_index = 0x26, .speakers = { FRW, FLW, RR, RL, 0, 0, FR, FL } },
343 { .ca_index = 0x27, .speakers = { FRW, FLW, RR, RL, 0, LFE, FR, FL } },
344 { .ca_index = 0x28, .speakers = { TC, RC, RR, RL, FC, 0, FR, FL } },
345 { .ca_index = 0x29, .speakers = { TC, RC, RR, RL, FC, LFE, FR, FL } },
346 { .ca_index = 0x2a, .speakers = { FCH, RC, RR, RL, FC, 0, FR, FL } },
347 { .ca_index = 0x2b, .speakers = { FCH, RC, RR, RL, FC, LFE, FR, FL } },
348 { .ca_index = 0x2c, .speakers = { TC, FCH, RR, RL, FC, 0, FR, FL } },
349 { .ca_index = 0x2d, .speakers = { TC, FCH, RR, RL, FC, LFE, FR, FL } },
350 { .ca_index = 0x2e, .speakers = { FRH, FLH, RR, RL, FC, 0, FR, FL } },
351 { .ca_index = 0x2f, .speakers = { FRH, FLH, RR, RL, FC, LFE, FR, FL } },
352 { .ca_index = 0x30, .speakers = { FRW, FLW, RR, RL, FC, 0, FR, FL } },
353 { .ca_index = 0x31, .speakers = { FRW, FLW, RR, RL, FC, LFE, FR, FL } },
358 * HDMI routines
361 #define get_pin(spec, idx) \
362 ((struct hdmi_spec_per_pin *)snd_array_elem(&spec->pins, idx))
363 #define get_cvt(spec, idx) \
364 ((struct hdmi_spec_per_cvt *)snd_array_elem(&spec->cvts, idx))
365 #define get_pcm_rec(spec, idx) ((spec)->pcm_rec[idx])
367 static int pin_nid_to_pin_index(struct hda_codec *codec, hda_nid_t pin_nid)
369 struct hdmi_spec *spec = codec->spec;
370 int pin_idx;
372 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++)
373 if (get_pin(spec, pin_idx)->pin_nid == pin_nid)
374 return pin_idx;
376 codec_warn(codec, "HDMI: pin nid %d not registered\n", pin_nid);
377 return -EINVAL;
380 static int hinfo_to_pin_index(struct hda_codec *codec,
381 struct hda_pcm_stream *hinfo)
383 struct hdmi_spec *spec = codec->spec;
384 int pin_idx;
386 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++)
387 if (get_pcm_rec(spec, pin_idx)->stream == hinfo)
388 return pin_idx;
390 codec_warn(codec, "HDMI: hinfo %p not registered\n", hinfo);
391 return -EINVAL;
394 static int cvt_nid_to_cvt_index(struct hda_codec *codec, hda_nid_t cvt_nid)
396 struct hdmi_spec *spec = codec->spec;
397 int cvt_idx;
399 for (cvt_idx = 0; cvt_idx < spec->num_cvts; cvt_idx++)
400 if (get_cvt(spec, cvt_idx)->cvt_nid == cvt_nid)
401 return cvt_idx;
403 codec_warn(codec, "HDMI: cvt nid %d not registered\n", cvt_nid);
404 return -EINVAL;
407 static int hdmi_eld_ctl_info(struct snd_kcontrol *kcontrol,
408 struct snd_ctl_elem_info *uinfo)
410 struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
411 struct hdmi_spec *spec = codec->spec;
412 struct hdmi_spec_per_pin *per_pin;
413 struct hdmi_eld *eld;
414 int pin_idx;
416 uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES;
418 pin_idx = kcontrol->private_value;
419 per_pin = get_pin(spec, pin_idx);
420 eld = &per_pin->sink_eld;
422 mutex_lock(&per_pin->lock);
423 uinfo->count = eld->eld_valid ? eld->eld_size : 0;
424 mutex_unlock(&per_pin->lock);
426 return 0;
429 static int hdmi_eld_ctl_get(struct snd_kcontrol *kcontrol,
430 struct snd_ctl_elem_value *ucontrol)
432 struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
433 struct hdmi_spec *spec = codec->spec;
434 struct hdmi_spec_per_pin *per_pin;
435 struct hdmi_eld *eld;
436 int pin_idx;
438 pin_idx = kcontrol->private_value;
439 per_pin = get_pin(spec, pin_idx);
440 eld = &per_pin->sink_eld;
442 mutex_lock(&per_pin->lock);
443 if (eld->eld_size > ARRAY_SIZE(ucontrol->value.bytes.data) ||
444 eld->eld_size > ELD_MAX_SIZE) {
445 mutex_unlock(&per_pin->lock);
446 snd_BUG();
447 return -EINVAL;
450 memset(ucontrol->value.bytes.data, 0,
451 ARRAY_SIZE(ucontrol->value.bytes.data));
452 if (eld->eld_valid)
453 memcpy(ucontrol->value.bytes.data, eld->eld_buffer,
454 eld->eld_size);
455 mutex_unlock(&per_pin->lock);
457 return 0;
460 static struct snd_kcontrol_new eld_bytes_ctl = {
461 .access = SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE,
462 .iface = SNDRV_CTL_ELEM_IFACE_PCM,
463 .name = "ELD",
464 .info = hdmi_eld_ctl_info,
465 .get = hdmi_eld_ctl_get,
468 static int hdmi_create_eld_ctl(struct hda_codec *codec, int pin_idx,
469 int device)
471 struct snd_kcontrol *kctl;
472 struct hdmi_spec *spec = codec->spec;
473 int err;
475 kctl = snd_ctl_new1(&eld_bytes_ctl, codec);
476 if (!kctl)
477 return -ENOMEM;
478 kctl->private_value = pin_idx;
479 kctl->id.device = device;
481 err = snd_hda_ctl_add(codec, get_pin(spec, pin_idx)->pin_nid, kctl);
482 if (err < 0)
483 return err;
485 get_pin(spec, pin_idx)->eld_ctl = kctl;
486 return 0;
489 #ifdef BE_PARANOID
490 static void hdmi_get_dip_index(struct hda_codec *codec, hda_nid_t pin_nid,
491 int *packet_index, int *byte_index)
493 int val;
495 val = snd_hda_codec_read(codec, pin_nid, 0,
496 AC_VERB_GET_HDMI_DIP_INDEX, 0);
498 *packet_index = val >> 5;
499 *byte_index = val & 0x1f;
501 #endif
503 static void hdmi_set_dip_index(struct hda_codec *codec, hda_nid_t pin_nid,
504 int packet_index, int byte_index)
506 int val;
508 val = (packet_index << 5) | (byte_index & 0x1f);
510 snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_INDEX, val);
513 static void hdmi_write_dip_byte(struct hda_codec *codec, hda_nid_t pin_nid,
514 unsigned char val)
516 snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_DATA, val);
519 static void hdmi_init_pin(struct hda_codec *codec, hda_nid_t pin_nid)
521 struct hdmi_spec *spec = codec->spec;
522 int pin_out;
524 /* Unmute */
525 if (get_wcaps(codec, pin_nid) & AC_WCAP_OUT_AMP)
526 snd_hda_codec_write(codec, pin_nid, 0,
527 AC_VERB_SET_AMP_GAIN_MUTE, AMP_OUT_UNMUTE);
529 if (spec->dyn_pin_out)
530 /* Disable pin out until stream is active */
531 pin_out = 0;
532 else
533 /* Enable pin out: some machines with GM965 gets broken output
534 * when the pin is disabled or changed while using with HDMI
536 pin_out = PIN_OUT;
538 snd_hda_codec_write(codec, pin_nid, 0,
539 AC_VERB_SET_PIN_WIDGET_CONTROL, pin_out);
542 static int hdmi_get_channel_count(struct hda_codec *codec, hda_nid_t cvt_nid)
544 return 1 + snd_hda_codec_read(codec, cvt_nid, 0,
545 AC_VERB_GET_CVT_CHAN_COUNT, 0);
548 static void hdmi_set_channel_count(struct hda_codec *codec,
549 hda_nid_t cvt_nid, int chs)
551 if (chs != hdmi_get_channel_count(codec, cvt_nid))
552 snd_hda_codec_write(codec, cvt_nid, 0,
553 AC_VERB_SET_CVT_CHAN_COUNT, chs - 1);
557 * ELD proc files
560 #ifdef CONFIG_SND_PROC_FS
561 static void print_eld_info(struct snd_info_entry *entry,
562 struct snd_info_buffer *buffer)
564 struct hdmi_spec_per_pin *per_pin = entry->private_data;
566 mutex_lock(&per_pin->lock);
567 snd_hdmi_print_eld_info(&per_pin->sink_eld, buffer);
568 mutex_unlock(&per_pin->lock);
571 static void write_eld_info(struct snd_info_entry *entry,
572 struct snd_info_buffer *buffer)
574 struct hdmi_spec_per_pin *per_pin = entry->private_data;
576 mutex_lock(&per_pin->lock);
577 snd_hdmi_write_eld_info(&per_pin->sink_eld, buffer);
578 mutex_unlock(&per_pin->lock);
581 static int eld_proc_new(struct hdmi_spec_per_pin *per_pin, int index)
583 char name[32];
584 struct hda_codec *codec = per_pin->codec;
585 struct snd_info_entry *entry;
586 int err;
588 snprintf(name, sizeof(name), "eld#%d.%d", codec->addr, index);
589 err = snd_card_proc_new(codec->card, name, &entry);
590 if (err < 0)
591 return err;
593 snd_info_set_text_ops(entry, per_pin, print_eld_info);
594 entry->c.text.write = write_eld_info;
595 entry->mode |= S_IWUSR;
596 per_pin->proc_entry = entry;
598 return 0;
601 static void eld_proc_free(struct hdmi_spec_per_pin *per_pin)
603 if (!per_pin->codec->bus->shutdown) {
604 snd_info_free_entry(per_pin->proc_entry);
605 per_pin->proc_entry = NULL;
608 #else
609 static inline int eld_proc_new(struct hdmi_spec_per_pin *per_pin,
610 int index)
612 return 0;
614 static inline void eld_proc_free(struct hdmi_spec_per_pin *per_pin)
617 #endif
620 * Channel mapping routines
624 * Compute derived values in channel_allocations[].
626 static void init_channel_allocations(void)
628 int i, j;
629 struct cea_channel_speaker_allocation *p;
631 for (i = 0; i < ARRAY_SIZE(channel_allocations); i++) {
632 p = channel_allocations + i;
633 p->channels = 0;
634 p->spk_mask = 0;
635 for (j = 0; j < ARRAY_SIZE(p->speakers); j++)
636 if (p->speakers[j]) {
637 p->channels++;
638 p->spk_mask |= p->speakers[j];
643 static int get_channel_allocation_order(int ca)
645 int i;
647 for (i = 0; i < ARRAY_SIZE(channel_allocations); i++) {
648 if (channel_allocations[i].ca_index == ca)
649 break;
651 return i;
655 * The transformation takes two steps:
657 * eld->spk_alloc => (eld_speaker_allocation_bits[]) => spk_mask
658 * spk_mask => (channel_allocations[]) => ai->CA
660 * TODO: it could select the wrong CA from multiple candidates.
662 static int hdmi_channel_allocation(struct hda_codec *codec,
663 struct hdmi_eld *eld, int channels)
665 int i;
666 int ca = 0;
667 int spk_mask = 0;
668 char buf[SND_PRINT_CHANNEL_ALLOCATION_ADVISED_BUFSIZE];
671 * CA defaults to 0 for basic stereo audio
673 if (channels <= 2)
674 return 0;
677 * expand ELD's speaker allocation mask
679 * ELD tells the speaker mask in a compact(paired) form,
680 * expand ELD's notions to match the ones used by Audio InfoFrame.
682 for (i = 0; i < ARRAY_SIZE(eld_speaker_allocation_bits); i++) {
683 if (eld->info.spk_alloc & (1 << i))
684 spk_mask |= eld_speaker_allocation_bits[i];
687 /* search for the first working match in the CA table */
688 for (i = 0; i < ARRAY_SIZE(channel_allocations); i++) {
689 if (channels == channel_allocations[i].channels &&
690 (spk_mask & channel_allocations[i].spk_mask) ==
691 channel_allocations[i].spk_mask) {
692 ca = channel_allocations[i].ca_index;
693 break;
697 if (!ca) {
698 /* if there was no match, select the regular ALSA channel
699 * allocation with the matching number of channels */
700 for (i = 0; i < ARRAY_SIZE(channel_allocations); i++) {
701 if (channels == channel_allocations[i].channels) {
702 ca = channel_allocations[i].ca_index;
703 break;
708 snd_print_channel_allocation(eld->info.spk_alloc, buf, sizeof(buf));
709 codec_dbg(codec, "HDMI: select CA 0x%x for %d-channel allocation: %s\n",
710 ca, channels, buf);
712 return ca;
715 static void hdmi_debug_channel_mapping(struct hda_codec *codec,
716 hda_nid_t pin_nid)
718 #ifdef CONFIG_SND_DEBUG_VERBOSE
719 struct hdmi_spec *spec = codec->spec;
720 int i;
721 int channel;
723 for (i = 0; i < 8; i++) {
724 channel = spec->ops.pin_get_slot_channel(codec, pin_nid, i);
725 codec_dbg(codec, "HDMI: ASP channel %d => slot %d\n",
726 channel, i);
728 #endif
731 static void hdmi_std_setup_channel_mapping(struct hda_codec *codec,
732 hda_nid_t pin_nid,
733 bool non_pcm,
734 int ca)
736 struct hdmi_spec *spec = codec->spec;
737 struct cea_channel_speaker_allocation *ch_alloc;
738 int i;
739 int err;
740 int order;
741 int non_pcm_mapping[8];
743 order = get_channel_allocation_order(ca);
744 ch_alloc = &channel_allocations[order];
746 if (hdmi_channel_mapping[ca][1] == 0) {
747 int hdmi_slot = 0;
748 /* fill actual channel mappings in ALSA channel (i) order */
749 for (i = 0; i < ch_alloc->channels; i++) {
750 while (!ch_alloc->speakers[7 - hdmi_slot] && !WARN_ON(hdmi_slot >= 8))
751 hdmi_slot++; /* skip zero slots */
753 hdmi_channel_mapping[ca][i] = (i << 4) | hdmi_slot++;
755 /* fill the rest of the slots with ALSA channel 0xf */
756 for (hdmi_slot = 0; hdmi_slot < 8; hdmi_slot++)
757 if (!ch_alloc->speakers[7 - hdmi_slot])
758 hdmi_channel_mapping[ca][i++] = (0xf << 4) | hdmi_slot;
761 if (non_pcm) {
762 for (i = 0; i < ch_alloc->channels; i++)
763 non_pcm_mapping[i] = (i << 4) | i;
764 for (; i < 8; i++)
765 non_pcm_mapping[i] = (0xf << 4) | i;
768 for (i = 0; i < 8; i++) {
769 int slotsetup = non_pcm ? non_pcm_mapping[i] : hdmi_channel_mapping[ca][i];
770 int hdmi_slot = slotsetup & 0x0f;
771 int channel = (slotsetup & 0xf0) >> 4;
772 err = spec->ops.pin_set_slot_channel(codec, pin_nid, hdmi_slot, channel);
773 if (err) {
774 codec_dbg(codec, "HDMI: channel mapping failed\n");
775 break;
780 struct channel_map_table {
781 unsigned char map; /* ALSA API channel map position */
782 int spk_mask; /* speaker position bit mask */
785 static struct channel_map_table map_tables[] = {
786 { SNDRV_CHMAP_FL, FL },
787 { SNDRV_CHMAP_FR, FR },
788 { SNDRV_CHMAP_RL, RL },
789 { SNDRV_CHMAP_RR, RR },
790 { SNDRV_CHMAP_LFE, LFE },
791 { SNDRV_CHMAP_FC, FC },
792 { SNDRV_CHMAP_RLC, RLC },
793 { SNDRV_CHMAP_RRC, RRC },
794 { SNDRV_CHMAP_RC, RC },
795 { SNDRV_CHMAP_FLC, FLC },
796 { SNDRV_CHMAP_FRC, FRC },
797 { SNDRV_CHMAP_TFL, FLH },
798 { SNDRV_CHMAP_TFR, FRH },
799 { SNDRV_CHMAP_FLW, FLW },
800 { SNDRV_CHMAP_FRW, FRW },
801 { SNDRV_CHMAP_TC, TC },
802 { SNDRV_CHMAP_TFC, FCH },
803 {} /* terminator */
806 /* from ALSA API channel position to speaker bit mask */
807 static int to_spk_mask(unsigned char c)
809 struct channel_map_table *t = map_tables;
810 for (; t->map; t++) {
811 if (t->map == c)
812 return t->spk_mask;
814 return 0;
817 /* from ALSA API channel position to CEA slot */
818 static int to_cea_slot(int ordered_ca, unsigned char pos)
820 int mask = to_spk_mask(pos);
821 int i;
823 if (mask) {
824 for (i = 0; i < 8; i++) {
825 if (channel_allocations[ordered_ca].speakers[7 - i] == mask)
826 return i;
830 return -1;
833 /* from speaker bit mask to ALSA API channel position */
834 static int spk_to_chmap(int spk)
836 struct channel_map_table *t = map_tables;
837 for (; t->map; t++) {
838 if (t->spk_mask == spk)
839 return t->map;
841 return 0;
844 /* from CEA slot to ALSA API channel position */
845 static int from_cea_slot(int ordered_ca, unsigned char slot)
847 int mask = channel_allocations[ordered_ca].speakers[7 - slot];
849 return spk_to_chmap(mask);
852 /* get the CA index corresponding to the given ALSA API channel map */
853 static int hdmi_manual_channel_allocation(int chs, unsigned char *map)
855 int i, spks = 0, spk_mask = 0;
857 for (i = 0; i < chs; i++) {
858 int mask = to_spk_mask(map[i]);
859 if (mask) {
860 spk_mask |= mask;
861 spks++;
865 for (i = 0; i < ARRAY_SIZE(channel_allocations); i++) {
866 if ((chs == channel_allocations[i].channels ||
867 spks == channel_allocations[i].channels) &&
868 (spk_mask & channel_allocations[i].spk_mask) ==
869 channel_allocations[i].spk_mask)
870 return channel_allocations[i].ca_index;
872 return -1;
875 /* set up the channel slots for the given ALSA API channel map */
876 static int hdmi_manual_setup_channel_mapping(struct hda_codec *codec,
877 hda_nid_t pin_nid,
878 int chs, unsigned char *map,
879 int ca)
881 struct hdmi_spec *spec = codec->spec;
882 int ordered_ca = get_channel_allocation_order(ca);
883 int alsa_pos, hdmi_slot;
884 int assignments[8] = {[0 ... 7] = 0xf};
886 for (alsa_pos = 0; alsa_pos < chs; alsa_pos++) {
888 hdmi_slot = to_cea_slot(ordered_ca, map[alsa_pos]);
890 if (hdmi_slot < 0)
891 continue; /* unassigned channel */
893 assignments[hdmi_slot] = alsa_pos;
896 for (hdmi_slot = 0; hdmi_slot < 8; hdmi_slot++) {
897 int err;
899 err = spec->ops.pin_set_slot_channel(codec, pin_nid, hdmi_slot,
900 assignments[hdmi_slot]);
901 if (err)
902 return -EINVAL;
904 return 0;
907 /* store ALSA API channel map from the current default map */
908 static void hdmi_setup_fake_chmap(unsigned char *map, int ca)
910 int i;
911 int ordered_ca = get_channel_allocation_order(ca);
912 for (i = 0; i < 8; i++) {
913 if (i < channel_allocations[ordered_ca].channels)
914 map[i] = from_cea_slot(ordered_ca, hdmi_channel_mapping[ca][i] & 0x0f);
915 else
916 map[i] = 0;
920 static void hdmi_setup_channel_mapping(struct hda_codec *codec,
921 hda_nid_t pin_nid, bool non_pcm, int ca,
922 int channels, unsigned char *map,
923 bool chmap_set)
925 if (!non_pcm && chmap_set) {
926 hdmi_manual_setup_channel_mapping(codec, pin_nid,
927 channels, map, ca);
928 } else {
929 hdmi_std_setup_channel_mapping(codec, pin_nid, non_pcm, ca);
930 hdmi_setup_fake_chmap(map, ca);
933 hdmi_debug_channel_mapping(codec, pin_nid);
936 static int hdmi_pin_set_slot_channel(struct hda_codec *codec, hda_nid_t pin_nid,
937 int asp_slot, int channel)
939 return snd_hda_codec_write(codec, pin_nid, 0,
940 AC_VERB_SET_HDMI_CHAN_SLOT,
941 (channel << 4) | asp_slot);
944 static int hdmi_pin_get_slot_channel(struct hda_codec *codec, hda_nid_t pin_nid,
945 int asp_slot)
947 return (snd_hda_codec_read(codec, pin_nid, 0,
948 AC_VERB_GET_HDMI_CHAN_SLOT,
949 asp_slot) & 0xf0) >> 4;
953 * Audio InfoFrame routines
957 * Enable Audio InfoFrame Transmission
959 static void hdmi_start_infoframe_trans(struct hda_codec *codec,
960 hda_nid_t pin_nid)
962 hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0);
963 snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_XMIT,
964 AC_DIPXMIT_BEST);
968 * Disable Audio InfoFrame Transmission
970 static void hdmi_stop_infoframe_trans(struct hda_codec *codec,
971 hda_nid_t pin_nid)
973 hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0);
974 snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_XMIT,
975 AC_DIPXMIT_DISABLE);
978 static void hdmi_debug_dip_size(struct hda_codec *codec, hda_nid_t pin_nid)
980 #ifdef CONFIG_SND_DEBUG_VERBOSE
981 int i;
982 int size;
984 size = snd_hdmi_get_eld_size(codec, pin_nid);
985 codec_dbg(codec, "HDMI: ELD buf size is %d\n", size);
987 for (i = 0; i < 8; i++) {
988 size = snd_hda_codec_read(codec, pin_nid, 0,
989 AC_VERB_GET_HDMI_DIP_SIZE, i);
990 codec_dbg(codec, "HDMI: DIP GP[%d] buf size is %d\n", i, size);
992 #endif
995 static void hdmi_clear_dip_buffers(struct hda_codec *codec, hda_nid_t pin_nid)
997 #ifdef BE_PARANOID
998 int i, j;
999 int size;
1000 int pi, bi;
1001 for (i = 0; i < 8; i++) {
1002 size = snd_hda_codec_read(codec, pin_nid, 0,
1003 AC_VERB_GET_HDMI_DIP_SIZE, i);
1004 if (size == 0)
1005 continue;
1007 hdmi_set_dip_index(codec, pin_nid, i, 0x0);
1008 for (j = 1; j < 1000; j++) {
1009 hdmi_write_dip_byte(codec, pin_nid, 0x0);
1010 hdmi_get_dip_index(codec, pin_nid, &pi, &bi);
1011 if (pi != i)
1012 codec_dbg(codec, "dip index %d: %d != %d\n",
1013 bi, pi, i);
1014 if (bi == 0) /* byte index wrapped around */
1015 break;
1017 codec_dbg(codec,
1018 "HDMI: DIP GP[%d] buf reported size=%d, written=%d\n",
1019 i, size, j);
1021 #endif
1024 static void hdmi_checksum_audio_infoframe(struct hdmi_audio_infoframe *hdmi_ai)
1026 u8 *bytes = (u8 *)hdmi_ai;
1027 u8 sum = 0;
1028 int i;
1030 hdmi_ai->checksum = 0;
1032 for (i = 0; i < sizeof(*hdmi_ai); i++)
1033 sum += bytes[i];
1035 hdmi_ai->checksum = -sum;
1038 static void hdmi_fill_audio_infoframe(struct hda_codec *codec,
1039 hda_nid_t pin_nid,
1040 u8 *dip, int size)
1042 int i;
1044 hdmi_debug_dip_size(codec, pin_nid);
1045 hdmi_clear_dip_buffers(codec, pin_nid); /* be paranoid */
1047 hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0);
1048 for (i = 0; i < size; i++)
1049 hdmi_write_dip_byte(codec, pin_nid, dip[i]);
1052 static bool hdmi_infoframe_uptodate(struct hda_codec *codec, hda_nid_t pin_nid,
1053 u8 *dip, int size)
1055 u8 val;
1056 int i;
1058 if (snd_hda_codec_read(codec, pin_nid, 0, AC_VERB_GET_HDMI_DIP_XMIT, 0)
1059 != AC_DIPXMIT_BEST)
1060 return false;
1062 hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0);
1063 for (i = 0; i < size; i++) {
1064 val = snd_hda_codec_read(codec, pin_nid, 0,
1065 AC_VERB_GET_HDMI_DIP_DATA, 0);
1066 if (val != dip[i])
1067 return false;
1070 return true;
1073 static void hdmi_pin_setup_infoframe(struct hda_codec *codec,
1074 hda_nid_t pin_nid,
1075 int ca, int active_channels,
1076 int conn_type)
1078 union audio_infoframe ai;
1080 memset(&ai, 0, sizeof(ai));
1081 if (conn_type == 0) { /* HDMI */
1082 struct hdmi_audio_infoframe *hdmi_ai = &ai.hdmi;
1084 hdmi_ai->type = 0x84;
1085 hdmi_ai->ver = 0x01;
1086 hdmi_ai->len = 0x0a;
1087 hdmi_ai->CC02_CT47 = active_channels - 1;
1088 hdmi_ai->CA = ca;
1089 hdmi_checksum_audio_infoframe(hdmi_ai);
1090 } else if (conn_type == 1) { /* DisplayPort */
1091 struct dp_audio_infoframe *dp_ai = &ai.dp;
1093 dp_ai->type = 0x84;
1094 dp_ai->len = 0x1b;
1095 dp_ai->ver = 0x11 << 2;
1096 dp_ai->CC02_CT47 = active_channels - 1;
1097 dp_ai->CA = ca;
1098 } else {
1099 codec_dbg(codec, "HDMI: unknown connection type at pin %d\n",
1100 pin_nid);
1101 return;
1105 * sizeof(ai) is used instead of sizeof(*hdmi_ai) or
1106 * sizeof(*dp_ai) to avoid partial match/update problems when
1107 * the user switches between HDMI/DP monitors.
1109 if (!hdmi_infoframe_uptodate(codec, pin_nid, ai.bytes,
1110 sizeof(ai))) {
1111 codec_dbg(codec,
1112 "hdmi_pin_setup_infoframe: pin=%d channels=%d ca=0x%02x\n",
1113 pin_nid,
1114 active_channels, ca);
1115 hdmi_stop_infoframe_trans(codec, pin_nid);
1116 hdmi_fill_audio_infoframe(codec, pin_nid,
1117 ai.bytes, sizeof(ai));
1118 hdmi_start_infoframe_trans(codec, pin_nid);
1122 static void hdmi_setup_audio_infoframe(struct hda_codec *codec,
1123 struct hdmi_spec_per_pin *per_pin,
1124 bool non_pcm)
1126 struct hdmi_spec *spec = codec->spec;
1127 hda_nid_t pin_nid = per_pin->pin_nid;
1128 int channels = per_pin->channels;
1129 int active_channels;
1130 struct hdmi_eld *eld;
1131 int ca, ordered_ca;
1133 if (!channels)
1134 return;
1136 if (is_haswell_plus(codec))
1137 snd_hda_codec_write(codec, pin_nid, 0,
1138 AC_VERB_SET_AMP_GAIN_MUTE,
1139 AMP_OUT_UNMUTE);
1141 eld = &per_pin->sink_eld;
1143 if (!non_pcm && per_pin->chmap_set)
1144 ca = hdmi_manual_channel_allocation(channels, per_pin->chmap);
1145 else
1146 ca = hdmi_channel_allocation(codec, eld, channels);
1147 if (ca < 0)
1148 ca = 0;
1150 ordered_ca = get_channel_allocation_order(ca);
1151 active_channels = channel_allocations[ordered_ca].channels;
1153 hdmi_set_channel_count(codec, per_pin->cvt_nid, active_channels);
1156 * always configure channel mapping, it may have been changed by the
1157 * user in the meantime
1159 hdmi_setup_channel_mapping(codec, pin_nid, non_pcm, ca,
1160 channels, per_pin->chmap,
1161 per_pin->chmap_set);
1163 spec->ops.pin_setup_infoframe(codec, pin_nid, ca, active_channels,
1164 eld->info.conn_type);
1166 per_pin->non_pcm = non_pcm;
1170 * Unsolicited events
1173 static bool hdmi_present_sense(struct hdmi_spec_per_pin *per_pin, int repoll);
1175 static void check_presence_and_report(struct hda_codec *codec, hda_nid_t nid)
1177 struct hdmi_spec *spec = codec->spec;
1178 int pin_idx = pin_nid_to_pin_index(codec, nid);
1180 if (pin_idx < 0)
1181 return;
1182 if (hdmi_present_sense(get_pin(spec, pin_idx), 1))
1183 snd_hda_jack_report_sync(codec);
1186 static void jack_callback(struct hda_codec *codec,
1187 struct hda_jack_callback *jack)
1189 check_presence_and_report(codec, jack->nid);
1192 static void hdmi_intrinsic_event(struct hda_codec *codec, unsigned int res)
1194 int tag = res >> AC_UNSOL_RES_TAG_SHIFT;
1195 struct hda_jack_tbl *jack;
1196 int dev_entry = (res & AC_UNSOL_RES_DE) >> AC_UNSOL_RES_DE_SHIFT;
1198 jack = snd_hda_jack_tbl_get_from_tag(codec, tag);
1199 if (!jack)
1200 return;
1201 jack->jack_dirty = 1;
1203 codec_dbg(codec,
1204 "HDMI hot plug event: Codec=%d Pin=%d Device=%d Inactive=%d Presence_Detect=%d ELD_Valid=%d\n",
1205 codec->addr, jack->nid, dev_entry, !!(res & AC_UNSOL_RES_IA),
1206 !!(res & AC_UNSOL_RES_PD), !!(res & AC_UNSOL_RES_ELDV));
1208 check_presence_and_report(codec, jack->nid);
1211 static void hdmi_non_intrinsic_event(struct hda_codec *codec, unsigned int res)
1213 int tag = res >> AC_UNSOL_RES_TAG_SHIFT;
1214 int subtag = (res & AC_UNSOL_RES_SUBTAG) >> AC_UNSOL_RES_SUBTAG_SHIFT;
1215 int cp_state = !!(res & AC_UNSOL_RES_CP_STATE);
1216 int cp_ready = !!(res & AC_UNSOL_RES_CP_READY);
1218 codec_info(codec,
1219 "HDMI CP event: CODEC=%d TAG=%d SUBTAG=0x%x CP_STATE=%d CP_READY=%d\n",
1220 codec->addr,
1221 tag,
1222 subtag,
1223 cp_state,
1224 cp_ready);
1226 /* TODO */
1227 if (cp_state)
1229 if (cp_ready)
1234 static void hdmi_unsol_event(struct hda_codec *codec, unsigned int res)
1236 int tag = res >> AC_UNSOL_RES_TAG_SHIFT;
1237 int subtag = (res & AC_UNSOL_RES_SUBTAG) >> AC_UNSOL_RES_SUBTAG_SHIFT;
1239 if (!snd_hda_jack_tbl_get_from_tag(codec, tag)) {
1240 codec_dbg(codec, "Unexpected HDMI event tag 0x%x\n", tag);
1241 return;
1244 if (subtag == 0)
1245 hdmi_intrinsic_event(codec, res);
1246 else
1247 hdmi_non_intrinsic_event(codec, res);
1250 static void haswell_verify_D0(struct hda_codec *codec,
1251 hda_nid_t cvt_nid, hda_nid_t nid)
1253 int pwr;
1255 /* For Haswell, the converter 1/2 may keep in D3 state after bootup,
1256 * thus pins could only choose converter 0 for use. Make sure the
1257 * converters are in correct power state */
1258 if (!snd_hda_check_power_state(codec, cvt_nid, AC_PWRST_D0))
1259 snd_hda_codec_write(codec, cvt_nid, 0, AC_VERB_SET_POWER_STATE, AC_PWRST_D0);
1261 if (!snd_hda_check_power_state(codec, nid, AC_PWRST_D0)) {
1262 snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_POWER_STATE,
1263 AC_PWRST_D0);
1264 msleep(40);
1265 pwr = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_POWER_STATE, 0);
1266 pwr = (pwr & AC_PWRST_ACTUAL) >> AC_PWRST_ACTUAL_SHIFT;
1267 codec_dbg(codec, "Haswell HDMI audio: Power for pin 0x%x is now D%d\n", nid, pwr);
1272 * Callbacks
1275 /* HBR should be Non-PCM, 8 channels */
1276 #define is_hbr_format(format) \
1277 ((format & AC_FMT_TYPE_NON_PCM) && (format & AC_FMT_CHAN_MASK) == 7)
1279 static int hdmi_pin_hbr_setup(struct hda_codec *codec, hda_nid_t pin_nid,
1280 bool hbr)
1282 int pinctl, new_pinctl;
1284 if (snd_hda_query_pin_caps(codec, pin_nid) & AC_PINCAP_HBR) {
1285 pinctl = snd_hda_codec_read(codec, pin_nid, 0,
1286 AC_VERB_GET_PIN_WIDGET_CONTROL, 0);
1288 if (pinctl < 0)
1289 return hbr ? -EINVAL : 0;
1291 new_pinctl = pinctl & ~AC_PINCTL_EPT;
1292 if (hbr)
1293 new_pinctl |= AC_PINCTL_EPT_HBR;
1294 else
1295 new_pinctl |= AC_PINCTL_EPT_NATIVE;
1297 codec_dbg(codec,
1298 "hdmi_pin_hbr_setup: NID=0x%x, %spinctl=0x%x\n",
1299 pin_nid,
1300 pinctl == new_pinctl ? "" : "new-",
1301 new_pinctl);
1303 if (pinctl != new_pinctl)
1304 snd_hda_codec_write(codec, pin_nid, 0,
1305 AC_VERB_SET_PIN_WIDGET_CONTROL,
1306 new_pinctl);
1307 } else if (hbr)
1308 return -EINVAL;
1310 return 0;
1313 static int hdmi_setup_stream(struct hda_codec *codec, hda_nid_t cvt_nid,
1314 hda_nid_t pin_nid, u32 stream_tag, int format)
1316 struct hdmi_spec *spec = codec->spec;
1317 int err;
1319 if (is_haswell_plus(codec))
1320 haswell_verify_D0(codec, cvt_nid, pin_nid);
1322 err = spec->ops.pin_hbr_setup(codec, pin_nid, is_hbr_format(format));
1324 if (err) {
1325 codec_dbg(codec, "hdmi_setup_stream: HBR is not supported\n");
1326 return err;
1329 snd_hda_codec_setup_stream(codec, cvt_nid, stream_tag, 0, format);
1330 return 0;
1333 static int hdmi_choose_cvt(struct hda_codec *codec,
1334 int pin_idx, int *cvt_id, int *mux_id)
1336 struct hdmi_spec *spec = codec->spec;
1337 struct hdmi_spec_per_pin *per_pin;
1338 struct hdmi_spec_per_cvt *per_cvt = NULL;
1339 int cvt_idx, mux_idx = 0;
1341 per_pin = get_pin(spec, pin_idx);
1343 /* Dynamically assign converter to stream */
1344 for (cvt_idx = 0; cvt_idx < spec->num_cvts; cvt_idx++) {
1345 per_cvt = get_cvt(spec, cvt_idx);
1347 /* Must not already be assigned */
1348 if (per_cvt->assigned)
1349 continue;
1350 /* Must be in pin's mux's list of converters */
1351 for (mux_idx = 0; mux_idx < per_pin->num_mux_nids; mux_idx++)
1352 if (per_pin->mux_nids[mux_idx] == per_cvt->cvt_nid)
1353 break;
1354 /* Not in mux list */
1355 if (mux_idx == per_pin->num_mux_nids)
1356 continue;
1357 break;
1360 /* No free converters */
1361 if (cvt_idx == spec->num_cvts)
1362 return -ENODEV;
1364 per_pin->mux_idx = mux_idx;
1366 if (cvt_id)
1367 *cvt_id = cvt_idx;
1368 if (mux_id)
1369 *mux_id = mux_idx;
1371 return 0;
1374 /* Assure the pin select the right convetor */
1375 static void intel_verify_pin_cvt_connect(struct hda_codec *codec,
1376 struct hdmi_spec_per_pin *per_pin)
1378 hda_nid_t pin_nid = per_pin->pin_nid;
1379 int mux_idx, curr;
1381 mux_idx = per_pin->mux_idx;
1382 curr = snd_hda_codec_read(codec, pin_nid, 0,
1383 AC_VERB_GET_CONNECT_SEL, 0);
1384 if (curr != mux_idx)
1385 snd_hda_codec_write_cache(codec, pin_nid, 0,
1386 AC_VERB_SET_CONNECT_SEL,
1387 mux_idx);
1390 /* Intel HDMI workaround to fix audio routing issue:
1391 * For some Intel display codecs, pins share the same connection list.
1392 * So a conveter can be selected by multiple pins and playback on any of these
1393 * pins will generate sound on the external display, because audio flows from
1394 * the same converter to the display pipeline. Also muting one pin may make
1395 * other pins have no sound output.
1396 * So this function assures that an assigned converter for a pin is not selected
1397 * by any other pins.
1399 static void intel_not_share_assigned_cvt(struct hda_codec *codec,
1400 hda_nid_t pin_nid, int mux_idx)
1402 struct hdmi_spec *spec = codec->spec;
1403 hda_nid_t nid;
1404 int cvt_idx, curr;
1405 struct hdmi_spec_per_cvt *per_cvt;
1407 /* configure all pins, including "no physical connection" ones */
1408 for_each_hda_codec_node(nid, codec) {
1409 unsigned int wid_caps = get_wcaps(codec, nid);
1410 unsigned int wid_type = get_wcaps_type(wid_caps);
1412 if (wid_type != AC_WID_PIN)
1413 continue;
1415 if (nid == pin_nid)
1416 continue;
1418 curr = snd_hda_codec_read(codec, nid, 0,
1419 AC_VERB_GET_CONNECT_SEL, 0);
1420 if (curr != mux_idx)
1421 continue;
1423 /* choose an unassigned converter. The conveters in the
1424 * connection list are in the same order as in the codec.
1426 for (cvt_idx = 0; cvt_idx < spec->num_cvts; cvt_idx++) {
1427 per_cvt = get_cvt(spec, cvt_idx);
1428 if (!per_cvt->assigned) {
1429 codec_dbg(codec,
1430 "choose cvt %d for pin nid %d\n",
1431 cvt_idx, nid);
1432 snd_hda_codec_write_cache(codec, nid, 0,
1433 AC_VERB_SET_CONNECT_SEL,
1434 cvt_idx);
1435 break;
1442 * HDA PCM callbacks
1444 static int hdmi_pcm_open(struct hda_pcm_stream *hinfo,
1445 struct hda_codec *codec,
1446 struct snd_pcm_substream *substream)
1448 struct hdmi_spec *spec = codec->spec;
1449 struct snd_pcm_runtime *runtime = substream->runtime;
1450 int pin_idx, cvt_idx, mux_idx = 0;
1451 struct hdmi_spec_per_pin *per_pin;
1452 struct hdmi_eld *eld;
1453 struct hdmi_spec_per_cvt *per_cvt = NULL;
1454 int err;
1456 /* Validate hinfo */
1457 pin_idx = hinfo_to_pin_index(codec, hinfo);
1458 if (snd_BUG_ON(pin_idx < 0))
1459 return -EINVAL;
1460 per_pin = get_pin(spec, pin_idx);
1461 eld = &per_pin->sink_eld;
1463 err = hdmi_choose_cvt(codec, pin_idx, &cvt_idx, &mux_idx);
1464 if (err < 0)
1465 return err;
1467 per_cvt = get_cvt(spec, cvt_idx);
1468 /* Claim converter */
1469 per_cvt->assigned = 1;
1470 per_pin->cvt_nid = per_cvt->cvt_nid;
1471 hinfo->nid = per_cvt->cvt_nid;
1473 snd_hda_codec_write_cache(codec, per_pin->pin_nid, 0,
1474 AC_VERB_SET_CONNECT_SEL,
1475 mux_idx);
1477 /* configure unused pins to choose other converters */
1478 if (is_haswell_plus(codec) || is_valleyview_plus(codec))
1479 intel_not_share_assigned_cvt(codec, per_pin->pin_nid, mux_idx);
1481 snd_hda_spdif_ctls_assign(codec, pin_idx, per_cvt->cvt_nid);
1483 /* Initially set the converter's capabilities */
1484 hinfo->channels_min = per_cvt->channels_min;
1485 hinfo->channels_max = per_cvt->channels_max;
1486 hinfo->rates = per_cvt->rates;
1487 hinfo->formats = per_cvt->formats;
1488 hinfo->maxbps = per_cvt->maxbps;
1490 /* Restrict capabilities by ELD if this isn't disabled */
1491 if (!static_hdmi_pcm && eld->eld_valid) {
1492 snd_hdmi_eld_update_pcm_info(&eld->info, hinfo);
1493 if (hinfo->channels_min > hinfo->channels_max ||
1494 !hinfo->rates || !hinfo->formats) {
1495 per_cvt->assigned = 0;
1496 hinfo->nid = 0;
1497 snd_hda_spdif_ctls_unassign(codec, pin_idx);
1498 return -ENODEV;
1502 /* Store the updated parameters */
1503 runtime->hw.channels_min = hinfo->channels_min;
1504 runtime->hw.channels_max = hinfo->channels_max;
1505 runtime->hw.formats = hinfo->formats;
1506 runtime->hw.rates = hinfo->rates;
1508 snd_pcm_hw_constraint_step(substream->runtime, 0,
1509 SNDRV_PCM_HW_PARAM_CHANNELS, 2);
1510 return 0;
1514 * HDA/HDMI auto parsing
1516 static int hdmi_read_pin_conn(struct hda_codec *codec, int pin_idx)
1518 struct hdmi_spec *spec = codec->spec;
1519 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
1520 hda_nid_t pin_nid = per_pin->pin_nid;
1522 if (!(get_wcaps(codec, pin_nid) & AC_WCAP_CONN_LIST)) {
1523 codec_warn(codec,
1524 "HDMI: pin %d wcaps %#x does not support connection list\n",
1525 pin_nid, get_wcaps(codec, pin_nid));
1526 return -EINVAL;
1529 per_pin->num_mux_nids = snd_hda_get_connections(codec, pin_nid,
1530 per_pin->mux_nids,
1531 HDA_MAX_CONNECTIONS);
1533 return 0;
1536 static bool hdmi_present_sense(struct hdmi_spec_per_pin *per_pin, int repoll)
1538 struct hda_jack_tbl *jack;
1539 struct hda_codec *codec = per_pin->codec;
1540 struct hdmi_spec *spec = codec->spec;
1541 struct hdmi_eld *eld = &spec->temp_eld;
1542 struct hdmi_eld *pin_eld = &per_pin->sink_eld;
1543 hda_nid_t pin_nid = per_pin->pin_nid;
1545 * Always execute a GetPinSense verb here, even when called from
1546 * hdmi_intrinsic_event; for some NVIDIA HW, the unsolicited
1547 * response's PD bit is not the real PD value, but indicates that
1548 * the real PD value changed. An older version of the HD-audio
1549 * specification worked this way. Hence, we just ignore the data in
1550 * the unsolicited response to avoid custom WARs.
1552 int present;
1553 bool update_eld = false;
1554 bool eld_changed = false;
1555 bool ret;
1557 snd_hda_power_up_pm(codec);
1558 present = snd_hda_pin_sense(codec, pin_nid);
1560 mutex_lock(&per_pin->lock);
1561 pin_eld->monitor_present = !!(present & AC_PINSENSE_PRESENCE);
1562 if (pin_eld->monitor_present)
1563 eld->eld_valid = !!(present & AC_PINSENSE_ELDV);
1564 else
1565 eld->eld_valid = false;
1567 codec_dbg(codec,
1568 "HDMI status: Codec=%d Pin=%d Presence_Detect=%d ELD_Valid=%d\n",
1569 codec->addr, pin_nid, pin_eld->monitor_present, eld->eld_valid);
1571 if (eld->eld_valid) {
1572 if (spec->ops.pin_get_eld(codec, pin_nid, eld->eld_buffer,
1573 &eld->eld_size) < 0)
1574 eld->eld_valid = false;
1575 else {
1576 memset(&eld->info, 0, sizeof(struct parsed_hdmi_eld));
1577 if (snd_hdmi_parse_eld(codec, &eld->info, eld->eld_buffer,
1578 eld->eld_size) < 0)
1579 eld->eld_valid = false;
1582 if (eld->eld_valid) {
1583 snd_hdmi_show_eld(codec, &eld->info);
1584 update_eld = true;
1586 else if (repoll) {
1587 schedule_delayed_work(&per_pin->work,
1588 msecs_to_jiffies(300));
1589 goto unlock;
1593 if (pin_eld->eld_valid != eld->eld_valid)
1594 eld_changed = true;
1596 if (pin_eld->eld_valid && !eld->eld_valid)
1597 update_eld = true;
1599 if (update_eld) {
1600 bool old_eld_valid = pin_eld->eld_valid;
1601 pin_eld->eld_valid = eld->eld_valid;
1602 if (pin_eld->eld_size != eld->eld_size ||
1603 memcmp(pin_eld->eld_buffer, eld->eld_buffer,
1604 eld->eld_size) != 0) {
1605 memcpy(pin_eld->eld_buffer, eld->eld_buffer,
1606 eld->eld_size);
1607 eld_changed = true;
1609 pin_eld->eld_size = eld->eld_size;
1610 pin_eld->info = eld->info;
1613 * Re-setup pin and infoframe. This is needed e.g. when
1614 * - sink is first plugged-in (infoframe is not set up if !monitor_present)
1615 * - transcoder can change during stream playback on Haswell
1616 * and this can make HW reset converter selection on a pin.
1618 if (eld->eld_valid && !old_eld_valid && per_pin->setup) {
1619 if (is_haswell_plus(codec) ||
1620 is_valleyview_plus(codec)) {
1621 intel_verify_pin_cvt_connect(codec, per_pin);
1622 intel_not_share_assigned_cvt(codec, pin_nid,
1623 per_pin->mux_idx);
1626 hdmi_setup_audio_infoframe(codec, per_pin,
1627 per_pin->non_pcm);
1631 if (eld_changed)
1632 snd_ctl_notify(codec->card,
1633 SNDRV_CTL_EVENT_MASK_VALUE | SNDRV_CTL_EVENT_MASK_INFO,
1634 &per_pin->eld_ctl->id);
1635 unlock:
1636 ret = !repoll || !pin_eld->monitor_present || pin_eld->eld_valid;
1638 jack = snd_hda_jack_tbl_get(codec, pin_nid);
1639 if (jack) {
1640 jack->block_report = !ret;
1641 jack->pin_sense = (eld->monitor_present && eld->eld_valid) ?
1642 AC_PINSENSE_PRESENCE : 0;
1644 mutex_unlock(&per_pin->lock);
1645 snd_hda_power_down_pm(codec);
1646 return ret;
1649 static void hdmi_repoll_eld(struct work_struct *work)
1651 struct hdmi_spec_per_pin *per_pin =
1652 container_of(to_delayed_work(work), struct hdmi_spec_per_pin, work);
1654 if (per_pin->repoll_count++ > 6)
1655 per_pin->repoll_count = 0;
1657 if (hdmi_present_sense(per_pin, per_pin->repoll_count))
1658 snd_hda_jack_report_sync(per_pin->codec);
1661 static void intel_haswell_fixup_connect_list(struct hda_codec *codec,
1662 hda_nid_t nid);
1664 static int hdmi_add_pin(struct hda_codec *codec, hda_nid_t pin_nid)
1666 struct hdmi_spec *spec = codec->spec;
1667 unsigned int caps, config;
1668 int pin_idx;
1669 struct hdmi_spec_per_pin *per_pin;
1670 int err;
1672 caps = snd_hda_query_pin_caps(codec, pin_nid);
1673 if (!(caps & (AC_PINCAP_HDMI | AC_PINCAP_DP)))
1674 return 0;
1676 config = snd_hda_codec_get_pincfg(codec, pin_nid);
1677 if (get_defcfg_connect(config) == AC_JACK_PORT_NONE)
1678 return 0;
1680 if (is_haswell_plus(codec))
1681 intel_haswell_fixup_connect_list(codec, pin_nid);
1683 pin_idx = spec->num_pins;
1684 per_pin = snd_array_new(&spec->pins);
1685 if (!per_pin)
1686 return -ENOMEM;
1688 per_pin->pin_nid = pin_nid;
1689 per_pin->non_pcm = false;
1691 err = hdmi_read_pin_conn(codec, pin_idx);
1692 if (err < 0)
1693 return err;
1695 spec->num_pins++;
1697 return 0;
1700 static int hdmi_add_cvt(struct hda_codec *codec, hda_nid_t cvt_nid)
1702 struct hdmi_spec *spec = codec->spec;
1703 struct hdmi_spec_per_cvt *per_cvt;
1704 unsigned int chans;
1705 int err;
1707 chans = get_wcaps(codec, cvt_nid);
1708 chans = get_wcaps_channels(chans);
1710 per_cvt = snd_array_new(&spec->cvts);
1711 if (!per_cvt)
1712 return -ENOMEM;
1714 per_cvt->cvt_nid = cvt_nid;
1715 per_cvt->channels_min = 2;
1716 if (chans <= 16) {
1717 per_cvt->channels_max = chans;
1718 if (chans > spec->channels_max)
1719 spec->channels_max = chans;
1722 err = snd_hda_query_supported_pcm(codec, cvt_nid,
1723 &per_cvt->rates,
1724 &per_cvt->formats,
1725 &per_cvt->maxbps);
1726 if (err < 0)
1727 return err;
1729 if (spec->num_cvts < ARRAY_SIZE(spec->cvt_nids))
1730 spec->cvt_nids[spec->num_cvts] = cvt_nid;
1731 spec->num_cvts++;
1733 return 0;
1736 static int hdmi_parse_codec(struct hda_codec *codec)
1738 hda_nid_t nid;
1739 int i, nodes;
1741 nodes = snd_hda_get_sub_nodes(codec, codec->core.afg, &nid);
1742 if (!nid || nodes < 0) {
1743 codec_warn(codec, "HDMI: failed to get afg sub nodes\n");
1744 return -EINVAL;
1747 for (i = 0; i < nodes; i++, nid++) {
1748 unsigned int caps;
1749 unsigned int type;
1751 caps = get_wcaps(codec, nid);
1752 type = get_wcaps_type(caps);
1754 if (!(caps & AC_WCAP_DIGITAL))
1755 continue;
1757 switch (type) {
1758 case AC_WID_AUD_OUT:
1759 hdmi_add_cvt(codec, nid);
1760 break;
1761 case AC_WID_PIN:
1762 hdmi_add_pin(codec, nid);
1763 break;
1767 return 0;
1772 static bool check_non_pcm_per_cvt(struct hda_codec *codec, hda_nid_t cvt_nid)
1774 struct hda_spdif_out *spdif;
1775 bool non_pcm;
1777 mutex_lock(&codec->spdif_mutex);
1778 spdif = snd_hda_spdif_out_of_nid(codec, cvt_nid);
1779 non_pcm = !!(spdif->status & IEC958_AES0_NONAUDIO);
1780 mutex_unlock(&codec->spdif_mutex);
1781 return non_pcm;
1784 /* There is a fixed mapping between audio pin node and display port
1785 * on current Intel platforms:
1786 * Pin Widget 5 - PORT B (port = 1 in i915 driver)
1787 * Pin Widget 6 - PORT C (port = 2 in i915 driver)
1788 * Pin Widget 7 - PORT D (port = 3 in i915 driver)
1790 static int intel_pin2port(hda_nid_t pin_nid)
1792 return pin_nid - 4;
1796 * HDMI callbacks
1799 static int generic_hdmi_playback_pcm_prepare(struct hda_pcm_stream *hinfo,
1800 struct hda_codec *codec,
1801 unsigned int stream_tag,
1802 unsigned int format,
1803 struct snd_pcm_substream *substream)
1805 hda_nid_t cvt_nid = hinfo->nid;
1806 struct hdmi_spec *spec = codec->spec;
1807 int pin_idx = hinfo_to_pin_index(codec, hinfo);
1808 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
1809 hda_nid_t pin_nid = per_pin->pin_nid;
1810 struct snd_pcm_runtime *runtime = substream->runtime;
1811 struct i915_audio_component *acomp = codec->bus->core.audio_component;
1812 bool non_pcm;
1813 int pinctl;
1815 if (is_haswell_plus(codec) || is_valleyview_plus(codec)) {
1816 /* Verify pin:cvt selections to avoid silent audio after S3.
1817 * After S3, the audio driver restores pin:cvt selections
1818 * but this can happen before gfx is ready and such selection
1819 * is overlooked by HW. Thus multiple pins can share a same
1820 * default convertor and mute control will affect each other,
1821 * which can cause a resumed audio playback become silent
1822 * after S3.
1824 intel_verify_pin_cvt_connect(codec, per_pin);
1825 intel_not_share_assigned_cvt(codec, pin_nid, per_pin->mux_idx);
1828 /* Call sync_audio_rate to set the N/CTS/M manually if necessary */
1829 /* Todo: add DP1.2 MST audio support later */
1830 if (acomp && acomp->ops && acomp->ops->sync_audio_rate)
1831 acomp->ops->sync_audio_rate(acomp->dev,
1832 intel_pin2port(pin_nid),
1833 runtime->rate);
1835 non_pcm = check_non_pcm_per_cvt(codec, cvt_nid);
1836 mutex_lock(&per_pin->lock);
1837 per_pin->channels = substream->runtime->channels;
1838 per_pin->setup = true;
1840 hdmi_setup_audio_infoframe(codec, per_pin, non_pcm);
1841 mutex_unlock(&per_pin->lock);
1843 if (spec->dyn_pin_out) {
1844 pinctl = snd_hda_codec_read(codec, pin_nid, 0,
1845 AC_VERB_GET_PIN_WIDGET_CONTROL, 0);
1846 snd_hda_codec_write(codec, pin_nid, 0,
1847 AC_VERB_SET_PIN_WIDGET_CONTROL,
1848 pinctl | PIN_OUT);
1851 return spec->ops.setup_stream(codec, cvt_nid, pin_nid, stream_tag, format);
1854 static int generic_hdmi_playback_pcm_cleanup(struct hda_pcm_stream *hinfo,
1855 struct hda_codec *codec,
1856 struct snd_pcm_substream *substream)
1858 snd_hda_codec_cleanup_stream(codec, hinfo->nid);
1859 return 0;
1862 static int hdmi_pcm_close(struct hda_pcm_stream *hinfo,
1863 struct hda_codec *codec,
1864 struct snd_pcm_substream *substream)
1866 struct hdmi_spec *spec = codec->spec;
1867 int cvt_idx, pin_idx;
1868 struct hdmi_spec_per_cvt *per_cvt;
1869 struct hdmi_spec_per_pin *per_pin;
1870 int pinctl;
1872 if (hinfo->nid) {
1873 cvt_idx = cvt_nid_to_cvt_index(codec, hinfo->nid);
1874 if (snd_BUG_ON(cvt_idx < 0))
1875 return -EINVAL;
1876 per_cvt = get_cvt(spec, cvt_idx);
1878 snd_BUG_ON(!per_cvt->assigned);
1879 per_cvt->assigned = 0;
1880 hinfo->nid = 0;
1882 pin_idx = hinfo_to_pin_index(codec, hinfo);
1883 if (snd_BUG_ON(pin_idx < 0))
1884 return -EINVAL;
1885 per_pin = get_pin(spec, pin_idx);
1887 if (spec->dyn_pin_out) {
1888 pinctl = snd_hda_codec_read(codec, per_pin->pin_nid, 0,
1889 AC_VERB_GET_PIN_WIDGET_CONTROL, 0);
1890 snd_hda_codec_write(codec, per_pin->pin_nid, 0,
1891 AC_VERB_SET_PIN_WIDGET_CONTROL,
1892 pinctl & ~PIN_OUT);
1895 snd_hda_spdif_ctls_unassign(codec, pin_idx);
1897 mutex_lock(&per_pin->lock);
1898 per_pin->chmap_set = false;
1899 memset(per_pin->chmap, 0, sizeof(per_pin->chmap));
1901 per_pin->setup = false;
1902 per_pin->channels = 0;
1903 mutex_unlock(&per_pin->lock);
1906 return 0;
1909 static const struct hda_pcm_ops generic_ops = {
1910 .open = hdmi_pcm_open,
1911 .close = hdmi_pcm_close,
1912 .prepare = generic_hdmi_playback_pcm_prepare,
1913 .cleanup = generic_hdmi_playback_pcm_cleanup,
1917 * ALSA API channel-map control callbacks
1919 static int hdmi_chmap_ctl_info(struct snd_kcontrol *kcontrol,
1920 struct snd_ctl_elem_info *uinfo)
1922 struct snd_pcm_chmap *info = snd_kcontrol_chip(kcontrol);
1923 struct hda_codec *codec = info->private_data;
1924 struct hdmi_spec *spec = codec->spec;
1925 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
1926 uinfo->count = spec->channels_max;
1927 uinfo->value.integer.min = 0;
1928 uinfo->value.integer.max = SNDRV_CHMAP_LAST;
1929 return 0;
1932 static int hdmi_chmap_cea_alloc_validate_get_type(struct cea_channel_speaker_allocation *cap,
1933 int channels)
1935 /* If the speaker allocation matches the channel count, it is OK.*/
1936 if (cap->channels != channels)
1937 return -1;
1939 /* all channels are remappable freely */
1940 return SNDRV_CTL_TLVT_CHMAP_VAR;
1943 static void hdmi_cea_alloc_to_tlv_chmap(struct cea_channel_speaker_allocation *cap,
1944 unsigned int *chmap, int channels)
1946 int count = 0;
1947 int c;
1949 for (c = 7; c >= 0; c--) {
1950 int spk = cap->speakers[c];
1951 if (!spk)
1952 continue;
1954 chmap[count++] = spk_to_chmap(spk);
1957 WARN_ON(count != channels);
1960 static int hdmi_chmap_ctl_tlv(struct snd_kcontrol *kcontrol, int op_flag,
1961 unsigned int size, unsigned int __user *tlv)
1963 struct snd_pcm_chmap *info = snd_kcontrol_chip(kcontrol);
1964 struct hda_codec *codec = info->private_data;
1965 struct hdmi_spec *spec = codec->spec;
1966 unsigned int __user *dst;
1967 int chs, count = 0;
1969 if (size < 8)
1970 return -ENOMEM;
1971 if (put_user(SNDRV_CTL_TLVT_CONTAINER, tlv))
1972 return -EFAULT;
1973 size -= 8;
1974 dst = tlv + 2;
1975 for (chs = 2; chs <= spec->channels_max; chs++) {
1976 int i;
1977 struct cea_channel_speaker_allocation *cap;
1978 cap = channel_allocations;
1979 for (i = 0; i < ARRAY_SIZE(channel_allocations); i++, cap++) {
1980 int chs_bytes = chs * 4;
1981 int type = spec->ops.chmap_cea_alloc_validate_get_type(cap, chs);
1982 unsigned int tlv_chmap[8];
1984 if (type < 0)
1985 continue;
1986 if (size < 8)
1987 return -ENOMEM;
1988 if (put_user(type, dst) ||
1989 put_user(chs_bytes, dst + 1))
1990 return -EFAULT;
1991 dst += 2;
1992 size -= 8;
1993 count += 8;
1994 if (size < chs_bytes)
1995 return -ENOMEM;
1996 size -= chs_bytes;
1997 count += chs_bytes;
1998 spec->ops.cea_alloc_to_tlv_chmap(cap, tlv_chmap, chs);
1999 if (copy_to_user(dst, tlv_chmap, chs_bytes))
2000 return -EFAULT;
2001 dst += chs;
2004 if (put_user(count, tlv + 1))
2005 return -EFAULT;
2006 return 0;
2009 static int hdmi_chmap_ctl_get(struct snd_kcontrol *kcontrol,
2010 struct snd_ctl_elem_value *ucontrol)
2012 struct snd_pcm_chmap *info = snd_kcontrol_chip(kcontrol);
2013 struct hda_codec *codec = info->private_data;
2014 struct hdmi_spec *spec = codec->spec;
2015 int pin_idx = kcontrol->private_value;
2016 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
2017 int i;
2019 for (i = 0; i < ARRAY_SIZE(per_pin->chmap); i++)
2020 ucontrol->value.integer.value[i] = per_pin->chmap[i];
2021 return 0;
2024 static int hdmi_chmap_ctl_put(struct snd_kcontrol *kcontrol,
2025 struct snd_ctl_elem_value *ucontrol)
2027 struct snd_pcm_chmap *info = snd_kcontrol_chip(kcontrol);
2028 struct hda_codec *codec = info->private_data;
2029 struct hdmi_spec *spec = codec->spec;
2030 int pin_idx = kcontrol->private_value;
2031 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
2032 unsigned int ctl_idx;
2033 struct snd_pcm_substream *substream;
2034 unsigned char chmap[8];
2035 int i, err, ca, prepared = 0;
2037 ctl_idx = snd_ctl_get_ioffidx(kcontrol, &ucontrol->id);
2038 substream = snd_pcm_chmap_substream(info, ctl_idx);
2039 if (!substream || !substream->runtime)
2040 return 0; /* just for avoiding error from alsactl restore */
2041 switch (substream->runtime->status->state) {
2042 case SNDRV_PCM_STATE_OPEN:
2043 case SNDRV_PCM_STATE_SETUP:
2044 break;
2045 case SNDRV_PCM_STATE_PREPARED:
2046 prepared = 1;
2047 break;
2048 default:
2049 return -EBUSY;
2051 memset(chmap, 0, sizeof(chmap));
2052 for (i = 0; i < ARRAY_SIZE(chmap); i++)
2053 chmap[i] = ucontrol->value.integer.value[i];
2054 if (!memcmp(chmap, per_pin->chmap, sizeof(chmap)))
2055 return 0;
2056 ca = hdmi_manual_channel_allocation(ARRAY_SIZE(chmap), chmap);
2057 if (ca < 0)
2058 return -EINVAL;
2059 if (spec->ops.chmap_validate) {
2060 err = spec->ops.chmap_validate(ca, ARRAY_SIZE(chmap), chmap);
2061 if (err)
2062 return err;
2064 mutex_lock(&per_pin->lock);
2065 per_pin->chmap_set = true;
2066 memcpy(per_pin->chmap, chmap, sizeof(chmap));
2067 if (prepared)
2068 hdmi_setup_audio_infoframe(codec, per_pin, per_pin->non_pcm);
2069 mutex_unlock(&per_pin->lock);
2071 return 0;
2074 static int generic_hdmi_build_pcms(struct hda_codec *codec)
2076 struct hdmi_spec *spec = codec->spec;
2077 int pin_idx;
2079 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
2080 struct hda_pcm *info;
2081 struct hda_pcm_stream *pstr;
2083 info = snd_hda_codec_pcm_new(codec, "HDMI %d", pin_idx);
2084 if (!info)
2085 return -ENOMEM;
2086 spec->pcm_rec[pin_idx] = info;
2087 info->pcm_type = HDA_PCM_TYPE_HDMI;
2088 info->own_chmap = true;
2090 pstr = &info->stream[SNDRV_PCM_STREAM_PLAYBACK];
2091 pstr->substreams = 1;
2092 pstr->ops = generic_ops;
2093 /* other pstr fields are set in open */
2096 return 0;
2099 static int generic_hdmi_build_jack(struct hda_codec *codec, int pin_idx)
2101 char hdmi_str[32] = "HDMI/DP";
2102 struct hdmi_spec *spec = codec->spec;
2103 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
2104 int pcmdev = get_pcm_rec(spec, pin_idx)->device;
2105 bool phantom_jack;
2107 if (pcmdev > 0)
2108 sprintf(hdmi_str + strlen(hdmi_str), ",pcm=%d", pcmdev);
2109 phantom_jack = !is_jack_detectable(codec, per_pin->pin_nid);
2110 if (phantom_jack)
2111 strncat(hdmi_str, " Phantom",
2112 sizeof(hdmi_str) - strlen(hdmi_str) - 1);
2114 return snd_hda_jack_add_kctl(codec, per_pin->pin_nid, hdmi_str,
2115 phantom_jack);
2118 static int generic_hdmi_build_controls(struct hda_codec *codec)
2120 struct hdmi_spec *spec = codec->spec;
2121 int err;
2122 int pin_idx;
2124 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
2125 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
2127 err = generic_hdmi_build_jack(codec, pin_idx);
2128 if (err < 0)
2129 return err;
2131 err = snd_hda_create_dig_out_ctls(codec,
2132 per_pin->pin_nid,
2133 per_pin->mux_nids[0],
2134 HDA_PCM_TYPE_HDMI);
2135 if (err < 0)
2136 return err;
2137 snd_hda_spdif_ctls_unassign(codec, pin_idx);
2139 /* add control for ELD Bytes */
2140 err = hdmi_create_eld_ctl(codec, pin_idx,
2141 get_pcm_rec(spec, pin_idx)->device);
2143 if (err < 0)
2144 return err;
2146 hdmi_present_sense(per_pin, 0);
2149 /* add channel maps */
2150 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
2151 struct hda_pcm *pcm;
2152 struct snd_pcm_chmap *chmap;
2153 struct snd_kcontrol *kctl;
2154 int i;
2156 pcm = spec->pcm_rec[pin_idx];
2157 if (!pcm || !pcm->pcm)
2158 break;
2159 err = snd_pcm_add_chmap_ctls(pcm->pcm,
2160 SNDRV_PCM_STREAM_PLAYBACK,
2161 NULL, 0, pin_idx, &chmap);
2162 if (err < 0)
2163 return err;
2164 /* override handlers */
2165 chmap->private_data = codec;
2166 kctl = chmap->kctl;
2167 for (i = 0; i < kctl->count; i++)
2168 kctl->vd[i].access |= SNDRV_CTL_ELEM_ACCESS_WRITE;
2169 kctl->info = hdmi_chmap_ctl_info;
2170 kctl->get = hdmi_chmap_ctl_get;
2171 kctl->put = hdmi_chmap_ctl_put;
2172 kctl->tlv.c = hdmi_chmap_ctl_tlv;
2175 return 0;
2178 static int generic_hdmi_init_per_pins(struct hda_codec *codec)
2180 struct hdmi_spec *spec = codec->spec;
2181 int pin_idx;
2183 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
2184 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
2186 per_pin->codec = codec;
2187 mutex_init(&per_pin->lock);
2188 INIT_DELAYED_WORK(&per_pin->work, hdmi_repoll_eld);
2189 eld_proc_new(per_pin, pin_idx);
2191 return 0;
2194 static int generic_hdmi_init(struct hda_codec *codec)
2196 struct hdmi_spec *spec = codec->spec;
2197 int pin_idx;
2199 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
2200 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
2201 hda_nid_t pin_nid = per_pin->pin_nid;
2203 hdmi_init_pin(codec, pin_nid);
2204 snd_hda_jack_detect_enable_callback(codec, pin_nid,
2205 codec->jackpoll_interval > 0 ? jack_callback : NULL);
2207 return 0;
2210 static void hdmi_array_init(struct hdmi_spec *spec, int nums)
2212 snd_array_init(&spec->pins, sizeof(struct hdmi_spec_per_pin), nums);
2213 snd_array_init(&spec->cvts, sizeof(struct hdmi_spec_per_cvt), nums);
2216 static void hdmi_array_free(struct hdmi_spec *spec)
2218 snd_array_free(&spec->pins);
2219 snd_array_free(&spec->cvts);
2222 static void generic_hdmi_free(struct hda_codec *codec)
2224 struct hdmi_spec *spec = codec->spec;
2225 int pin_idx;
2227 if (is_haswell_plus(codec) || is_valleyview_plus(codec))
2228 snd_hdac_i915_register_notifier(NULL);
2230 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
2231 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
2233 cancel_delayed_work_sync(&per_pin->work);
2234 eld_proc_free(per_pin);
2237 hdmi_array_free(spec);
2238 kfree(spec);
2241 #ifdef CONFIG_PM
2242 static int generic_hdmi_resume(struct hda_codec *codec)
2244 struct hdmi_spec *spec = codec->spec;
2245 int pin_idx;
2247 codec->patch_ops.init(codec);
2248 regcache_sync(codec->core.regmap);
2250 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
2251 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
2252 hdmi_present_sense(per_pin, 1);
2254 return 0;
2256 #endif
2258 static const struct hda_codec_ops generic_hdmi_patch_ops = {
2259 .init = generic_hdmi_init,
2260 .free = generic_hdmi_free,
2261 .build_pcms = generic_hdmi_build_pcms,
2262 .build_controls = generic_hdmi_build_controls,
2263 .unsol_event = hdmi_unsol_event,
2264 #ifdef CONFIG_PM
2265 .resume = generic_hdmi_resume,
2266 #endif
2269 static const struct hdmi_ops generic_standard_hdmi_ops = {
2270 .pin_get_eld = snd_hdmi_get_eld,
2271 .pin_get_slot_channel = hdmi_pin_get_slot_channel,
2272 .pin_set_slot_channel = hdmi_pin_set_slot_channel,
2273 .pin_setup_infoframe = hdmi_pin_setup_infoframe,
2274 .pin_hbr_setup = hdmi_pin_hbr_setup,
2275 .setup_stream = hdmi_setup_stream,
2276 .chmap_cea_alloc_validate_get_type = hdmi_chmap_cea_alloc_validate_get_type,
2277 .cea_alloc_to_tlv_chmap = hdmi_cea_alloc_to_tlv_chmap,
2281 static void intel_haswell_fixup_connect_list(struct hda_codec *codec,
2282 hda_nid_t nid)
2284 struct hdmi_spec *spec = codec->spec;
2285 hda_nid_t conns[4];
2286 int nconns;
2288 nconns = snd_hda_get_connections(codec, nid, conns, ARRAY_SIZE(conns));
2289 if (nconns == spec->num_cvts &&
2290 !memcmp(conns, spec->cvt_nids, spec->num_cvts * sizeof(hda_nid_t)))
2291 return;
2293 /* override pins connection list */
2294 codec_dbg(codec, "hdmi: haswell: override pin connection 0x%x\n", nid);
2295 snd_hda_override_conn_list(codec, nid, spec->num_cvts, spec->cvt_nids);
2298 #define INTEL_VENDOR_NID 0x08
2299 #define INTEL_GET_VENDOR_VERB 0xf81
2300 #define INTEL_SET_VENDOR_VERB 0x781
2301 #define INTEL_EN_DP12 0x02 /* enable DP 1.2 features */
2302 #define INTEL_EN_ALL_PIN_CVTS 0x01 /* enable 2nd & 3rd pins and convertors */
2304 static void intel_haswell_enable_all_pins(struct hda_codec *codec,
2305 bool update_tree)
2307 unsigned int vendor_param;
2309 vendor_param = snd_hda_codec_read(codec, INTEL_VENDOR_NID, 0,
2310 INTEL_GET_VENDOR_VERB, 0);
2311 if (vendor_param == -1 || vendor_param & INTEL_EN_ALL_PIN_CVTS)
2312 return;
2314 vendor_param |= INTEL_EN_ALL_PIN_CVTS;
2315 vendor_param = snd_hda_codec_read(codec, INTEL_VENDOR_NID, 0,
2316 INTEL_SET_VENDOR_VERB, vendor_param);
2317 if (vendor_param == -1)
2318 return;
2320 if (update_tree)
2321 snd_hda_codec_update_widgets(codec);
2324 static void intel_haswell_fixup_enable_dp12(struct hda_codec *codec)
2326 unsigned int vendor_param;
2328 vendor_param = snd_hda_codec_read(codec, INTEL_VENDOR_NID, 0,
2329 INTEL_GET_VENDOR_VERB, 0);
2330 if (vendor_param == -1 || vendor_param & INTEL_EN_DP12)
2331 return;
2333 /* enable DP1.2 mode */
2334 vendor_param |= INTEL_EN_DP12;
2335 snd_hdac_regmap_add_vendor_verb(&codec->core, INTEL_SET_VENDOR_VERB);
2336 snd_hda_codec_write_cache(codec, INTEL_VENDOR_NID, 0,
2337 INTEL_SET_VENDOR_VERB, vendor_param);
2340 /* Haswell needs to re-issue the vendor-specific verbs before turning to D0.
2341 * Otherwise you may get severe h/w communication errors.
2343 static void haswell_set_power_state(struct hda_codec *codec, hda_nid_t fg,
2344 unsigned int power_state)
2346 if (power_state == AC_PWRST_D0) {
2347 intel_haswell_enable_all_pins(codec, false);
2348 intel_haswell_fixup_enable_dp12(codec);
2351 snd_hda_codec_read(codec, fg, 0, AC_VERB_SET_POWER_STATE, power_state);
2352 snd_hda_codec_set_power_to_all(codec, fg, power_state);
2355 static void intel_pin_eld_notify(void *audio_ptr, int port)
2357 struct hda_codec *codec = audio_ptr;
2358 int pin_nid = port + 0x04;
2360 /* we assume only from port-B to port-D */
2361 if (port < 1 || port > 3)
2362 return;
2364 /* skip notification during system suspend (but not in runtime PM);
2365 * the state will be updated at resume
2367 if (snd_power_get_state(codec->card) != SNDRV_CTL_POWER_D0)
2368 return;
2370 check_presence_and_report(codec, pin_nid);
2373 static int patch_generic_hdmi(struct hda_codec *codec)
2375 struct hdmi_spec *spec;
2377 spec = kzalloc(sizeof(*spec), GFP_KERNEL);
2378 if (spec == NULL)
2379 return -ENOMEM;
2381 spec->ops = generic_standard_hdmi_ops;
2382 codec->spec = spec;
2383 hdmi_array_init(spec, 4);
2385 if (is_haswell_plus(codec)) {
2386 intel_haswell_enable_all_pins(codec, true);
2387 intel_haswell_fixup_enable_dp12(codec);
2390 /* For Valleyview/Cherryview, only the display codec is in the display
2391 * power well and can use link_power ops to request/release the power.
2392 * For Haswell/Broadwell, the controller is also in the power well and
2393 * can cover the codec power request, and so need not set this flag.
2394 * For previous platforms, there is no such power well feature.
2396 if (is_valleyview_plus(codec) || is_skylake(codec) ||
2397 is_broxton(codec))
2398 codec->core.link_power_control = 1;
2400 if (is_haswell_plus(codec) || is_valleyview_plus(codec)) {
2401 codec->depop_delay = 0;
2402 spec->i915_audio_ops.audio_ptr = codec;
2403 spec->i915_audio_ops.pin_eld_notify = intel_pin_eld_notify;
2404 snd_hdac_i915_register_notifier(&spec->i915_audio_ops);
2407 if (hdmi_parse_codec(codec) < 0) {
2408 codec->spec = NULL;
2409 kfree(spec);
2410 return -EINVAL;
2412 codec->patch_ops = generic_hdmi_patch_ops;
2413 if (is_haswell_plus(codec)) {
2414 codec->patch_ops.set_power_state = haswell_set_power_state;
2415 codec->dp_mst = true;
2418 /* Enable runtime pm for HDMI audio codec of HSW/BDW/SKL/BYT/BSW */
2419 if (is_haswell_plus(codec) || is_valleyview_plus(codec))
2420 codec->auto_runtime_pm = 1;
2422 generic_hdmi_init_per_pins(codec);
2424 init_channel_allocations();
2426 return 0;
2430 * Shared non-generic implementations
2433 static int simple_playback_build_pcms(struct hda_codec *codec)
2435 struct hdmi_spec *spec = codec->spec;
2436 struct hda_pcm *info;
2437 unsigned int chans;
2438 struct hda_pcm_stream *pstr;
2439 struct hdmi_spec_per_cvt *per_cvt;
2441 per_cvt = get_cvt(spec, 0);
2442 chans = get_wcaps(codec, per_cvt->cvt_nid);
2443 chans = get_wcaps_channels(chans);
2445 info = snd_hda_codec_pcm_new(codec, "HDMI 0");
2446 if (!info)
2447 return -ENOMEM;
2448 spec->pcm_rec[0] = info;
2449 info->pcm_type = HDA_PCM_TYPE_HDMI;
2450 pstr = &info->stream[SNDRV_PCM_STREAM_PLAYBACK];
2451 *pstr = spec->pcm_playback;
2452 pstr->nid = per_cvt->cvt_nid;
2453 if (pstr->channels_max <= 2 && chans && chans <= 16)
2454 pstr->channels_max = chans;
2456 return 0;
2459 /* unsolicited event for jack sensing */
2460 static void simple_hdmi_unsol_event(struct hda_codec *codec,
2461 unsigned int res)
2463 snd_hda_jack_set_dirty_all(codec);
2464 snd_hda_jack_report_sync(codec);
2467 /* generic_hdmi_build_jack can be used for simple_hdmi, too,
2468 * as long as spec->pins[] is set correctly
2470 #define simple_hdmi_build_jack generic_hdmi_build_jack
2472 static int simple_playback_build_controls(struct hda_codec *codec)
2474 struct hdmi_spec *spec = codec->spec;
2475 struct hdmi_spec_per_cvt *per_cvt;
2476 int err;
2478 per_cvt = get_cvt(spec, 0);
2479 err = snd_hda_create_dig_out_ctls(codec, per_cvt->cvt_nid,
2480 per_cvt->cvt_nid,
2481 HDA_PCM_TYPE_HDMI);
2482 if (err < 0)
2483 return err;
2484 return simple_hdmi_build_jack(codec, 0);
2487 static int simple_playback_init(struct hda_codec *codec)
2489 struct hdmi_spec *spec = codec->spec;
2490 struct hdmi_spec_per_pin *per_pin = get_pin(spec, 0);
2491 hda_nid_t pin = per_pin->pin_nid;
2493 snd_hda_codec_write(codec, pin, 0,
2494 AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT);
2495 /* some codecs require to unmute the pin */
2496 if (get_wcaps(codec, pin) & AC_WCAP_OUT_AMP)
2497 snd_hda_codec_write(codec, pin, 0, AC_VERB_SET_AMP_GAIN_MUTE,
2498 AMP_OUT_UNMUTE);
2499 snd_hda_jack_detect_enable(codec, pin);
2500 return 0;
2503 static void simple_playback_free(struct hda_codec *codec)
2505 struct hdmi_spec *spec = codec->spec;
2507 hdmi_array_free(spec);
2508 kfree(spec);
2512 * Nvidia specific implementations
2515 #define Nv_VERB_SET_Channel_Allocation 0xF79
2516 #define Nv_VERB_SET_Info_Frame_Checksum 0xF7A
2517 #define Nv_VERB_SET_Audio_Protection_On 0xF98
2518 #define Nv_VERB_SET_Audio_Protection_Off 0xF99
2520 #define nvhdmi_master_con_nid_7x 0x04
2521 #define nvhdmi_master_pin_nid_7x 0x05
2523 static const hda_nid_t nvhdmi_con_nids_7x[4] = {
2524 /*front, rear, clfe, rear_surr */
2525 0x6, 0x8, 0xa, 0xc,
2528 static const struct hda_verb nvhdmi_basic_init_7x_2ch[] = {
2529 /* set audio protect on */
2530 { 0x1, Nv_VERB_SET_Audio_Protection_On, 0x1},
2531 /* enable digital output on pin widget */
2532 { 0x5, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
2533 {} /* terminator */
2536 static const struct hda_verb nvhdmi_basic_init_7x_8ch[] = {
2537 /* set audio protect on */
2538 { 0x1, Nv_VERB_SET_Audio_Protection_On, 0x1},
2539 /* enable digital output on pin widget */
2540 { 0x5, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
2541 { 0x7, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
2542 { 0x9, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
2543 { 0xb, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
2544 { 0xd, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
2545 {} /* terminator */
2548 #ifdef LIMITED_RATE_FMT_SUPPORT
2549 /* support only the safe format and rate */
2550 #define SUPPORTED_RATES SNDRV_PCM_RATE_48000
2551 #define SUPPORTED_MAXBPS 16
2552 #define SUPPORTED_FORMATS SNDRV_PCM_FMTBIT_S16_LE
2553 #else
2554 /* support all rates and formats */
2555 #define SUPPORTED_RATES \
2556 (SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |\
2557 SNDRV_PCM_RATE_88200 | SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |\
2558 SNDRV_PCM_RATE_192000)
2559 #define SUPPORTED_MAXBPS 24
2560 #define SUPPORTED_FORMATS \
2561 (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S32_LE)
2562 #endif
2564 static int nvhdmi_7x_init_2ch(struct hda_codec *codec)
2566 snd_hda_sequence_write(codec, nvhdmi_basic_init_7x_2ch);
2567 return 0;
2570 static int nvhdmi_7x_init_8ch(struct hda_codec *codec)
2572 snd_hda_sequence_write(codec, nvhdmi_basic_init_7x_8ch);
2573 return 0;
2576 static unsigned int channels_2_6_8[] = {
2577 2, 6, 8
2580 static unsigned int channels_2_8[] = {
2581 2, 8
2584 static struct snd_pcm_hw_constraint_list hw_constraints_2_6_8_channels = {
2585 .count = ARRAY_SIZE(channels_2_6_8),
2586 .list = channels_2_6_8,
2587 .mask = 0,
2590 static struct snd_pcm_hw_constraint_list hw_constraints_2_8_channels = {
2591 .count = ARRAY_SIZE(channels_2_8),
2592 .list = channels_2_8,
2593 .mask = 0,
2596 static int simple_playback_pcm_open(struct hda_pcm_stream *hinfo,
2597 struct hda_codec *codec,
2598 struct snd_pcm_substream *substream)
2600 struct hdmi_spec *spec = codec->spec;
2601 struct snd_pcm_hw_constraint_list *hw_constraints_channels = NULL;
2603 switch (codec->preset->vendor_id) {
2604 case 0x10de0002:
2605 case 0x10de0003:
2606 case 0x10de0005:
2607 case 0x10de0006:
2608 hw_constraints_channels = &hw_constraints_2_8_channels;
2609 break;
2610 case 0x10de0007:
2611 hw_constraints_channels = &hw_constraints_2_6_8_channels;
2612 break;
2613 default:
2614 break;
2617 if (hw_constraints_channels != NULL) {
2618 snd_pcm_hw_constraint_list(substream->runtime, 0,
2619 SNDRV_PCM_HW_PARAM_CHANNELS,
2620 hw_constraints_channels);
2621 } else {
2622 snd_pcm_hw_constraint_step(substream->runtime, 0,
2623 SNDRV_PCM_HW_PARAM_CHANNELS, 2);
2626 return snd_hda_multi_out_dig_open(codec, &spec->multiout);
2629 static int simple_playback_pcm_close(struct hda_pcm_stream *hinfo,
2630 struct hda_codec *codec,
2631 struct snd_pcm_substream *substream)
2633 struct hdmi_spec *spec = codec->spec;
2634 return snd_hda_multi_out_dig_close(codec, &spec->multiout);
2637 static int simple_playback_pcm_prepare(struct hda_pcm_stream *hinfo,
2638 struct hda_codec *codec,
2639 unsigned int stream_tag,
2640 unsigned int format,
2641 struct snd_pcm_substream *substream)
2643 struct hdmi_spec *spec = codec->spec;
2644 return snd_hda_multi_out_dig_prepare(codec, &spec->multiout,
2645 stream_tag, format, substream);
2648 static const struct hda_pcm_stream simple_pcm_playback = {
2649 .substreams = 1,
2650 .channels_min = 2,
2651 .channels_max = 2,
2652 .ops = {
2653 .open = simple_playback_pcm_open,
2654 .close = simple_playback_pcm_close,
2655 .prepare = simple_playback_pcm_prepare
2659 static const struct hda_codec_ops simple_hdmi_patch_ops = {
2660 .build_controls = simple_playback_build_controls,
2661 .build_pcms = simple_playback_build_pcms,
2662 .init = simple_playback_init,
2663 .free = simple_playback_free,
2664 .unsol_event = simple_hdmi_unsol_event,
2667 static int patch_simple_hdmi(struct hda_codec *codec,
2668 hda_nid_t cvt_nid, hda_nid_t pin_nid)
2670 struct hdmi_spec *spec;
2671 struct hdmi_spec_per_cvt *per_cvt;
2672 struct hdmi_spec_per_pin *per_pin;
2674 spec = kzalloc(sizeof(*spec), GFP_KERNEL);
2675 if (!spec)
2676 return -ENOMEM;
2678 codec->spec = spec;
2679 hdmi_array_init(spec, 1);
2681 spec->multiout.num_dacs = 0; /* no analog */
2682 spec->multiout.max_channels = 2;
2683 spec->multiout.dig_out_nid = cvt_nid;
2684 spec->num_cvts = 1;
2685 spec->num_pins = 1;
2686 per_pin = snd_array_new(&spec->pins);
2687 per_cvt = snd_array_new(&spec->cvts);
2688 if (!per_pin || !per_cvt) {
2689 simple_playback_free(codec);
2690 return -ENOMEM;
2692 per_cvt->cvt_nid = cvt_nid;
2693 per_pin->pin_nid = pin_nid;
2694 spec->pcm_playback = simple_pcm_playback;
2696 codec->patch_ops = simple_hdmi_patch_ops;
2698 return 0;
2701 static void nvhdmi_8ch_7x_set_info_frame_parameters(struct hda_codec *codec,
2702 int channels)
2704 unsigned int chanmask;
2705 int chan = channels ? (channels - 1) : 1;
2707 switch (channels) {
2708 default:
2709 case 0:
2710 case 2:
2711 chanmask = 0x00;
2712 break;
2713 case 4:
2714 chanmask = 0x08;
2715 break;
2716 case 6:
2717 chanmask = 0x0b;
2718 break;
2719 case 8:
2720 chanmask = 0x13;
2721 break;
2724 /* Set the audio infoframe channel allocation and checksum fields. The
2725 * channel count is computed implicitly by the hardware. */
2726 snd_hda_codec_write(codec, 0x1, 0,
2727 Nv_VERB_SET_Channel_Allocation, chanmask);
2729 snd_hda_codec_write(codec, 0x1, 0,
2730 Nv_VERB_SET_Info_Frame_Checksum,
2731 (0x71 - chan - chanmask));
2734 static int nvhdmi_8ch_7x_pcm_close(struct hda_pcm_stream *hinfo,
2735 struct hda_codec *codec,
2736 struct snd_pcm_substream *substream)
2738 struct hdmi_spec *spec = codec->spec;
2739 int i;
2741 snd_hda_codec_write(codec, nvhdmi_master_con_nid_7x,
2742 0, AC_VERB_SET_CHANNEL_STREAMID, 0);
2743 for (i = 0; i < 4; i++) {
2744 /* set the stream id */
2745 snd_hda_codec_write(codec, nvhdmi_con_nids_7x[i], 0,
2746 AC_VERB_SET_CHANNEL_STREAMID, 0);
2747 /* set the stream format */
2748 snd_hda_codec_write(codec, nvhdmi_con_nids_7x[i], 0,
2749 AC_VERB_SET_STREAM_FORMAT, 0);
2752 /* The audio hardware sends a channel count of 0x7 (8ch) when all the
2753 * streams are disabled. */
2754 nvhdmi_8ch_7x_set_info_frame_parameters(codec, 8);
2756 return snd_hda_multi_out_dig_close(codec, &spec->multiout);
2759 static int nvhdmi_8ch_7x_pcm_prepare(struct hda_pcm_stream *hinfo,
2760 struct hda_codec *codec,
2761 unsigned int stream_tag,
2762 unsigned int format,
2763 struct snd_pcm_substream *substream)
2765 int chs;
2766 unsigned int dataDCC2, channel_id;
2767 int i;
2768 struct hdmi_spec *spec = codec->spec;
2769 struct hda_spdif_out *spdif;
2770 struct hdmi_spec_per_cvt *per_cvt;
2772 mutex_lock(&codec->spdif_mutex);
2773 per_cvt = get_cvt(spec, 0);
2774 spdif = snd_hda_spdif_out_of_nid(codec, per_cvt->cvt_nid);
2776 chs = substream->runtime->channels;
2778 dataDCC2 = 0x2;
2780 /* turn off SPDIF once; otherwise the IEC958 bits won't be updated */
2781 if (codec->spdif_status_reset && (spdif->ctls & AC_DIG1_ENABLE))
2782 snd_hda_codec_write(codec,
2783 nvhdmi_master_con_nid_7x,
2785 AC_VERB_SET_DIGI_CONVERT_1,
2786 spdif->ctls & ~AC_DIG1_ENABLE & 0xff);
2788 /* set the stream id */
2789 snd_hda_codec_write(codec, nvhdmi_master_con_nid_7x, 0,
2790 AC_VERB_SET_CHANNEL_STREAMID, (stream_tag << 4) | 0x0);
2792 /* set the stream format */
2793 snd_hda_codec_write(codec, nvhdmi_master_con_nid_7x, 0,
2794 AC_VERB_SET_STREAM_FORMAT, format);
2796 /* turn on again (if needed) */
2797 /* enable and set the channel status audio/data flag */
2798 if (codec->spdif_status_reset && (spdif->ctls & AC_DIG1_ENABLE)) {
2799 snd_hda_codec_write(codec,
2800 nvhdmi_master_con_nid_7x,
2802 AC_VERB_SET_DIGI_CONVERT_1,
2803 spdif->ctls & 0xff);
2804 snd_hda_codec_write(codec,
2805 nvhdmi_master_con_nid_7x,
2807 AC_VERB_SET_DIGI_CONVERT_2, dataDCC2);
2810 for (i = 0; i < 4; i++) {
2811 if (chs == 2)
2812 channel_id = 0;
2813 else
2814 channel_id = i * 2;
2816 /* turn off SPDIF once;
2817 *otherwise the IEC958 bits won't be updated
2819 if (codec->spdif_status_reset &&
2820 (spdif->ctls & AC_DIG1_ENABLE))
2821 snd_hda_codec_write(codec,
2822 nvhdmi_con_nids_7x[i],
2824 AC_VERB_SET_DIGI_CONVERT_1,
2825 spdif->ctls & ~AC_DIG1_ENABLE & 0xff);
2826 /* set the stream id */
2827 snd_hda_codec_write(codec,
2828 nvhdmi_con_nids_7x[i],
2830 AC_VERB_SET_CHANNEL_STREAMID,
2831 (stream_tag << 4) | channel_id);
2832 /* set the stream format */
2833 snd_hda_codec_write(codec,
2834 nvhdmi_con_nids_7x[i],
2836 AC_VERB_SET_STREAM_FORMAT,
2837 format);
2838 /* turn on again (if needed) */
2839 /* enable and set the channel status audio/data flag */
2840 if (codec->spdif_status_reset &&
2841 (spdif->ctls & AC_DIG1_ENABLE)) {
2842 snd_hda_codec_write(codec,
2843 nvhdmi_con_nids_7x[i],
2845 AC_VERB_SET_DIGI_CONVERT_1,
2846 spdif->ctls & 0xff);
2847 snd_hda_codec_write(codec,
2848 nvhdmi_con_nids_7x[i],
2850 AC_VERB_SET_DIGI_CONVERT_2, dataDCC2);
2854 nvhdmi_8ch_7x_set_info_frame_parameters(codec, chs);
2856 mutex_unlock(&codec->spdif_mutex);
2857 return 0;
2860 static const struct hda_pcm_stream nvhdmi_pcm_playback_8ch_7x = {
2861 .substreams = 1,
2862 .channels_min = 2,
2863 .channels_max = 8,
2864 .nid = nvhdmi_master_con_nid_7x,
2865 .rates = SUPPORTED_RATES,
2866 .maxbps = SUPPORTED_MAXBPS,
2867 .formats = SUPPORTED_FORMATS,
2868 .ops = {
2869 .open = simple_playback_pcm_open,
2870 .close = nvhdmi_8ch_7x_pcm_close,
2871 .prepare = nvhdmi_8ch_7x_pcm_prepare
2875 static int patch_nvhdmi_2ch(struct hda_codec *codec)
2877 struct hdmi_spec *spec;
2878 int err = patch_simple_hdmi(codec, nvhdmi_master_con_nid_7x,
2879 nvhdmi_master_pin_nid_7x);
2880 if (err < 0)
2881 return err;
2883 codec->patch_ops.init = nvhdmi_7x_init_2ch;
2884 /* override the PCM rates, etc, as the codec doesn't give full list */
2885 spec = codec->spec;
2886 spec->pcm_playback.rates = SUPPORTED_RATES;
2887 spec->pcm_playback.maxbps = SUPPORTED_MAXBPS;
2888 spec->pcm_playback.formats = SUPPORTED_FORMATS;
2889 return 0;
2892 static int nvhdmi_7x_8ch_build_pcms(struct hda_codec *codec)
2894 struct hdmi_spec *spec = codec->spec;
2895 int err = simple_playback_build_pcms(codec);
2896 if (!err) {
2897 struct hda_pcm *info = get_pcm_rec(spec, 0);
2898 info->own_chmap = true;
2900 return err;
2903 static int nvhdmi_7x_8ch_build_controls(struct hda_codec *codec)
2905 struct hdmi_spec *spec = codec->spec;
2906 struct hda_pcm *info;
2907 struct snd_pcm_chmap *chmap;
2908 int err;
2910 err = simple_playback_build_controls(codec);
2911 if (err < 0)
2912 return err;
2914 /* add channel maps */
2915 info = get_pcm_rec(spec, 0);
2916 err = snd_pcm_add_chmap_ctls(info->pcm,
2917 SNDRV_PCM_STREAM_PLAYBACK,
2918 snd_pcm_alt_chmaps, 8, 0, &chmap);
2919 if (err < 0)
2920 return err;
2921 switch (codec->preset->vendor_id) {
2922 case 0x10de0002:
2923 case 0x10de0003:
2924 case 0x10de0005:
2925 case 0x10de0006:
2926 chmap->channel_mask = (1U << 2) | (1U << 8);
2927 break;
2928 case 0x10de0007:
2929 chmap->channel_mask = (1U << 2) | (1U << 6) | (1U << 8);
2931 return 0;
2934 static int patch_nvhdmi_8ch_7x(struct hda_codec *codec)
2936 struct hdmi_spec *spec;
2937 int err = patch_nvhdmi_2ch(codec);
2938 if (err < 0)
2939 return err;
2940 spec = codec->spec;
2941 spec->multiout.max_channels = 8;
2942 spec->pcm_playback = nvhdmi_pcm_playback_8ch_7x;
2943 codec->patch_ops.init = nvhdmi_7x_init_8ch;
2944 codec->patch_ops.build_pcms = nvhdmi_7x_8ch_build_pcms;
2945 codec->patch_ops.build_controls = nvhdmi_7x_8ch_build_controls;
2947 /* Initialize the audio infoframe channel mask and checksum to something
2948 * valid */
2949 nvhdmi_8ch_7x_set_info_frame_parameters(codec, 8);
2951 return 0;
2955 * NVIDIA codecs ignore ASP mapping for 2ch - confirmed on:
2956 * - 0x10de0015
2957 * - 0x10de0040
2959 static int nvhdmi_chmap_cea_alloc_validate_get_type(struct cea_channel_speaker_allocation *cap,
2960 int channels)
2962 if (cap->ca_index == 0x00 && channels == 2)
2963 return SNDRV_CTL_TLVT_CHMAP_FIXED;
2965 return hdmi_chmap_cea_alloc_validate_get_type(cap, channels);
2968 static int nvhdmi_chmap_validate(int ca, int chs, unsigned char *map)
2970 if (ca == 0x00 && (map[0] != SNDRV_CHMAP_FL || map[1] != SNDRV_CHMAP_FR))
2971 return -EINVAL;
2973 return 0;
2976 static int patch_nvhdmi(struct hda_codec *codec)
2978 struct hdmi_spec *spec;
2979 int err;
2981 err = patch_generic_hdmi(codec);
2982 if (err)
2983 return err;
2985 spec = codec->spec;
2986 spec->dyn_pin_out = true;
2988 spec->ops.chmap_cea_alloc_validate_get_type =
2989 nvhdmi_chmap_cea_alloc_validate_get_type;
2990 spec->ops.chmap_validate = nvhdmi_chmap_validate;
2992 return 0;
2996 * The HDA codec on NVIDIA Tegra contains two scratch registers that are
2997 * accessed using vendor-defined verbs. These registers can be used for
2998 * interoperability between the HDA and HDMI drivers.
3001 /* Audio Function Group node */
3002 #define NVIDIA_AFG_NID 0x01
3005 * The SCRATCH0 register is used to notify the HDMI codec of changes in audio
3006 * format. On Tegra, bit 31 is used as a trigger that causes an interrupt to
3007 * be raised in the HDMI codec. The remainder of the bits is arbitrary. This
3008 * implementation stores the HDA format (see AC_FMT_*) in bits [15:0] and an
3009 * additional bit (at position 30) to signal the validity of the format.
3011 * | 31 | 30 | 29 16 | 15 0 |
3012 * +---------+-------+--------+--------+
3013 * | TRIGGER | VALID | UNUSED | FORMAT |
3014 * +-----------------------------------|
3016 * Note that for the trigger bit to take effect it needs to change value
3017 * (i.e. it needs to be toggled).
3019 #define NVIDIA_GET_SCRATCH0 0xfa6
3020 #define NVIDIA_SET_SCRATCH0_BYTE0 0xfa7
3021 #define NVIDIA_SET_SCRATCH0_BYTE1 0xfa8
3022 #define NVIDIA_SET_SCRATCH0_BYTE2 0xfa9
3023 #define NVIDIA_SET_SCRATCH0_BYTE3 0xfaa
3024 #define NVIDIA_SCRATCH_TRIGGER (1 << 7)
3025 #define NVIDIA_SCRATCH_VALID (1 << 6)
3027 #define NVIDIA_GET_SCRATCH1 0xfab
3028 #define NVIDIA_SET_SCRATCH1_BYTE0 0xfac
3029 #define NVIDIA_SET_SCRATCH1_BYTE1 0xfad
3030 #define NVIDIA_SET_SCRATCH1_BYTE2 0xfae
3031 #define NVIDIA_SET_SCRATCH1_BYTE3 0xfaf
3034 * The format parameter is the HDA audio format (see AC_FMT_*). If set to 0,
3035 * the format is invalidated so that the HDMI codec can be disabled.
3037 static void tegra_hdmi_set_format(struct hda_codec *codec, unsigned int format)
3039 unsigned int value;
3041 /* bits [31:30] contain the trigger and valid bits */
3042 value = snd_hda_codec_read(codec, NVIDIA_AFG_NID, 0,
3043 NVIDIA_GET_SCRATCH0, 0);
3044 value = (value >> 24) & 0xff;
3046 /* bits [15:0] are used to store the HDA format */
3047 snd_hda_codec_write(codec, NVIDIA_AFG_NID, 0,
3048 NVIDIA_SET_SCRATCH0_BYTE0,
3049 (format >> 0) & 0xff);
3050 snd_hda_codec_write(codec, NVIDIA_AFG_NID, 0,
3051 NVIDIA_SET_SCRATCH0_BYTE1,
3052 (format >> 8) & 0xff);
3054 /* bits [16:24] are unused */
3055 snd_hda_codec_write(codec, NVIDIA_AFG_NID, 0,
3056 NVIDIA_SET_SCRATCH0_BYTE2, 0);
3059 * Bit 30 signals that the data is valid and hence that HDMI audio can
3060 * be enabled.
3062 if (format == 0)
3063 value &= ~NVIDIA_SCRATCH_VALID;
3064 else
3065 value |= NVIDIA_SCRATCH_VALID;
3068 * Whenever the trigger bit is toggled, an interrupt is raised in the
3069 * HDMI codec. The HDMI driver will use that as trigger to update its
3070 * configuration.
3072 value ^= NVIDIA_SCRATCH_TRIGGER;
3074 snd_hda_codec_write(codec, NVIDIA_AFG_NID, 0,
3075 NVIDIA_SET_SCRATCH0_BYTE3, value);
3078 static int tegra_hdmi_pcm_prepare(struct hda_pcm_stream *hinfo,
3079 struct hda_codec *codec,
3080 unsigned int stream_tag,
3081 unsigned int format,
3082 struct snd_pcm_substream *substream)
3084 int err;
3086 err = generic_hdmi_playback_pcm_prepare(hinfo, codec, stream_tag,
3087 format, substream);
3088 if (err < 0)
3089 return err;
3091 /* notify the HDMI codec of the format change */
3092 tegra_hdmi_set_format(codec, format);
3094 return 0;
3097 static int tegra_hdmi_pcm_cleanup(struct hda_pcm_stream *hinfo,
3098 struct hda_codec *codec,
3099 struct snd_pcm_substream *substream)
3101 /* invalidate the format in the HDMI codec */
3102 tegra_hdmi_set_format(codec, 0);
3104 return generic_hdmi_playback_pcm_cleanup(hinfo, codec, substream);
3107 static struct hda_pcm *hda_find_pcm_by_type(struct hda_codec *codec, int type)
3109 struct hdmi_spec *spec = codec->spec;
3110 unsigned int i;
3112 for (i = 0; i < spec->num_pins; i++) {
3113 struct hda_pcm *pcm = get_pcm_rec(spec, i);
3115 if (pcm->pcm_type == type)
3116 return pcm;
3119 return NULL;
3122 static int tegra_hdmi_build_pcms(struct hda_codec *codec)
3124 struct hda_pcm_stream *stream;
3125 struct hda_pcm *pcm;
3126 int err;
3128 err = generic_hdmi_build_pcms(codec);
3129 if (err < 0)
3130 return err;
3132 pcm = hda_find_pcm_by_type(codec, HDA_PCM_TYPE_HDMI);
3133 if (!pcm)
3134 return -ENODEV;
3137 * Override ->prepare() and ->cleanup() operations to notify the HDMI
3138 * codec about format changes.
3140 stream = &pcm->stream[SNDRV_PCM_STREAM_PLAYBACK];
3141 stream->ops.prepare = tegra_hdmi_pcm_prepare;
3142 stream->ops.cleanup = tegra_hdmi_pcm_cleanup;
3144 return 0;
3147 static int patch_tegra_hdmi(struct hda_codec *codec)
3149 int err;
3151 err = patch_generic_hdmi(codec);
3152 if (err)
3153 return err;
3155 codec->patch_ops.build_pcms = tegra_hdmi_build_pcms;
3157 return 0;
3161 * ATI/AMD-specific implementations
3164 #define is_amdhdmi_rev3_or_later(codec) \
3165 ((codec)->core.vendor_id == 0x1002aa01 && \
3166 ((codec)->core.revision_id & 0xff00) >= 0x0300)
3167 #define has_amd_full_remap_support(codec) is_amdhdmi_rev3_or_later(codec)
3169 /* ATI/AMD specific HDA pin verbs, see the AMD HDA Verbs specification */
3170 #define ATI_VERB_SET_CHANNEL_ALLOCATION 0x771
3171 #define ATI_VERB_SET_DOWNMIX_INFO 0x772
3172 #define ATI_VERB_SET_MULTICHANNEL_01 0x777
3173 #define ATI_VERB_SET_MULTICHANNEL_23 0x778
3174 #define ATI_VERB_SET_MULTICHANNEL_45 0x779
3175 #define ATI_VERB_SET_MULTICHANNEL_67 0x77a
3176 #define ATI_VERB_SET_HBR_CONTROL 0x77c
3177 #define ATI_VERB_SET_MULTICHANNEL_1 0x785
3178 #define ATI_VERB_SET_MULTICHANNEL_3 0x786
3179 #define ATI_VERB_SET_MULTICHANNEL_5 0x787
3180 #define ATI_VERB_SET_MULTICHANNEL_7 0x788
3181 #define ATI_VERB_SET_MULTICHANNEL_MODE 0x789
3182 #define ATI_VERB_GET_CHANNEL_ALLOCATION 0xf71
3183 #define ATI_VERB_GET_DOWNMIX_INFO 0xf72
3184 #define ATI_VERB_GET_MULTICHANNEL_01 0xf77
3185 #define ATI_VERB_GET_MULTICHANNEL_23 0xf78
3186 #define ATI_VERB_GET_MULTICHANNEL_45 0xf79
3187 #define ATI_VERB_GET_MULTICHANNEL_67 0xf7a
3188 #define ATI_VERB_GET_HBR_CONTROL 0xf7c
3189 #define ATI_VERB_GET_MULTICHANNEL_1 0xf85
3190 #define ATI_VERB_GET_MULTICHANNEL_3 0xf86
3191 #define ATI_VERB_GET_MULTICHANNEL_5 0xf87
3192 #define ATI_VERB_GET_MULTICHANNEL_7 0xf88
3193 #define ATI_VERB_GET_MULTICHANNEL_MODE 0xf89
3195 /* AMD specific HDA cvt verbs */
3196 #define ATI_VERB_SET_RAMP_RATE 0x770
3197 #define ATI_VERB_GET_RAMP_RATE 0xf70
3199 #define ATI_OUT_ENABLE 0x1
3201 #define ATI_MULTICHANNEL_MODE_PAIRED 0
3202 #define ATI_MULTICHANNEL_MODE_SINGLE 1
3204 #define ATI_HBR_CAPABLE 0x01
3205 #define ATI_HBR_ENABLE 0x10
3207 static int atihdmi_pin_get_eld(struct hda_codec *codec, hda_nid_t nid,
3208 unsigned char *buf, int *eld_size)
3210 /* call hda_eld.c ATI/AMD-specific function */
3211 return snd_hdmi_get_eld_ati(codec, nid, buf, eld_size,
3212 is_amdhdmi_rev3_or_later(codec));
3215 static void atihdmi_pin_setup_infoframe(struct hda_codec *codec, hda_nid_t pin_nid, int ca,
3216 int active_channels, int conn_type)
3218 snd_hda_codec_write(codec, pin_nid, 0, ATI_VERB_SET_CHANNEL_ALLOCATION, ca);
3221 static int atihdmi_paired_swap_fc_lfe(int pos)
3224 * ATI/AMD have automatic FC/LFE swap built-in
3225 * when in pairwise mapping mode.
3228 switch (pos) {
3229 /* see channel_allocations[].speakers[] */
3230 case 2: return 3;
3231 case 3: return 2;
3232 default: break;
3235 return pos;
3238 static int atihdmi_paired_chmap_validate(int ca, int chs, unsigned char *map)
3240 struct cea_channel_speaker_allocation *cap;
3241 int i, j;
3243 /* check that only channel pairs need to be remapped on old pre-rev3 ATI/AMD */
3245 cap = &channel_allocations[get_channel_allocation_order(ca)];
3246 for (i = 0; i < chs; ++i) {
3247 int mask = to_spk_mask(map[i]);
3248 bool ok = false;
3249 bool companion_ok = false;
3251 if (!mask)
3252 continue;
3254 for (j = 0 + i % 2; j < 8; j += 2) {
3255 int chan_idx = 7 - atihdmi_paired_swap_fc_lfe(j);
3256 if (cap->speakers[chan_idx] == mask) {
3257 /* channel is in a supported position */
3258 ok = true;
3260 if (i % 2 == 0 && i + 1 < chs) {
3261 /* even channel, check the odd companion */
3262 int comp_chan_idx = 7 - atihdmi_paired_swap_fc_lfe(j + 1);
3263 int comp_mask_req = to_spk_mask(map[i+1]);
3264 int comp_mask_act = cap->speakers[comp_chan_idx];
3266 if (comp_mask_req == comp_mask_act)
3267 companion_ok = true;
3268 else
3269 return -EINVAL;
3271 break;
3275 if (!ok)
3276 return -EINVAL;
3278 if (companion_ok)
3279 i++; /* companion channel already checked */
3282 return 0;
3285 static int atihdmi_pin_set_slot_channel(struct hda_codec *codec, hda_nid_t pin_nid,
3286 int hdmi_slot, int stream_channel)
3288 int verb;
3289 int ati_channel_setup = 0;
3291 if (hdmi_slot > 7)
3292 return -EINVAL;
3294 if (!has_amd_full_remap_support(codec)) {
3295 hdmi_slot = atihdmi_paired_swap_fc_lfe(hdmi_slot);
3297 /* In case this is an odd slot but without stream channel, do not
3298 * disable the slot since the corresponding even slot could have a
3299 * channel. In case neither have a channel, the slot pair will be
3300 * disabled when this function is called for the even slot. */
3301 if (hdmi_slot % 2 != 0 && stream_channel == 0xf)
3302 return 0;
3304 hdmi_slot -= hdmi_slot % 2;
3306 if (stream_channel != 0xf)
3307 stream_channel -= stream_channel % 2;
3310 verb = ATI_VERB_SET_MULTICHANNEL_01 + hdmi_slot/2 + (hdmi_slot % 2) * 0x00e;
3312 /* ati_channel_setup format: [7..4] = stream_channel_id, [1] = mute, [0] = enable */
3314 if (stream_channel != 0xf)
3315 ati_channel_setup = (stream_channel << 4) | ATI_OUT_ENABLE;
3317 return snd_hda_codec_write(codec, pin_nid, 0, verb, ati_channel_setup);
3320 static int atihdmi_pin_get_slot_channel(struct hda_codec *codec, hda_nid_t pin_nid,
3321 int asp_slot)
3323 bool was_odd = false;
3324 int ati_asp_slot = asp_slot;
3325 int verb;
3326 int ati_channel_setup;
3328 if (asp_slot > 7)
3329 return -EINVAL;
3331 if (!has_amd_full_remap_support(codec)) {
3332 ati_asp_slot = atihdmi_paired_swap_fc_lfe(asp_slot);
3333 if (ati_asp_slot % 2 != 0) {
3334 ati_asp_slot -= 1;
3335 was_odd = true;
3339 verb = ATI_VERB_GET_MULTICHANNEL_01 + ati_asp_slot/2 + (ati_asp_slot % 2) * 0x00e;
3341 ati_channel_setup = snd_hda_codec_read(codec, pin_nid, 0, verb, 0);
3343 if (!(ati_channel_setup & ATI_OUT_ENABLE))
3344 return 0xf;
3346 return ((ati_channel_setup & 0xf0) >> 4) + !!was_odd;
3349 static int atihdmi_paired_chmap_cea_alloc_validate_get_type(struct cea_channel_speaker_allocation *cap,
3350 int channels)
3352 int c;
3355 * Pre-rev3 ATI/AMD codecs operate in a paired channel mode, so
3356 * we need to take that into account (a single channel may take 2
3357 * channel slots if we need to carry a silent channel next to it).
3358 * On Rev3+ AMD codecs this function is not used.
3360 int chanpairs = 0;
3362 /* We only produce even-numbered channel count TLVs */
3363 if ((channels % 2) != 0)
3364 return -1;
3366 for (c = 0; c < 7; c += 2) {
3367 if (cap->speakers[c] || cap->speakers[c+1])
3368 chanpairs++;
3371 if (chanpairs * 2 != channels)
3372 return -1;
3374 return SNDRV_CTL_TLVT_CHMAP_PAIRED;
3377 static void atihdmi_paired_cea_alloc_to_tlv_chmap(struct cea_channel_speaker_allocation *cap,
3378 unsigned int *chmap, int channels)
3380 /* produce paired maps for pre-rev3 ATI/AMD codecs */
3381 int count = 0;
3382 int c;
3384 for (c = 7; c >= 0; c--) {
3385 int chan = 7 - atihdmi_paired_swap_fc_lfe(7 - c);
3386 int spk = cap->speakers[chan];
3387 if (!spk) {
3388 /* add N/A channel if the companion channel is occupied */
3389 if (cap->speakers[chan + (chan % 2 ? -1 : 1)])
3390 chmap[count++] = SNDRV_CHMAP_NA;
3392 continue;
3395 chmap[count++] = spk_to_chmap(spk);
3398 WARN_ON(count != channels);
3401 static int atihdmi_pin_hbr_setup(struct hda_codec *codec, hda_nid_t pin_nid,
3402 bool hbr)
3404 int hbr_ctl, hbr_ctl_new;
3406 hbr_ctl = snd_hda_codec_read(codec, pin_nid, 0, ATI_VERB_GET_HBR_CONTROL, 0);
3407 if (hbr_ctl >= 0 && (hbr_ctl & ATI_HBR_CAPABLE)) {
3408 if (hbr)
3409 hbr_ctl_new = hbr_ctl | ATI_HBR_ENABLE;
3410 else
3411 hbr_ctl_new = hbr_ctl & ~ATI_HBR_ENABLE;
3413 codec_dbg(codec,
3414 "atihdmi_pin_hbr_setup: NID=0x%x, %shbr-ctl=0x%x\n",
3415 pin_nid,
3416 hbr_ctl == hbr_ctl_new ? "" : "new-",
3417 hbr_ctl_new);
3419 if (hbr_ctl != hbr_ctl_new)
3420 snd_hda_codec_write(codec, pin_nid, 0,
3421 ATI_VERB_SET_HBR_CONTROL,
3422 hbr_ctl_new);
3424 } else if (hbr)
3425 return -EINVAL;
3427 return 0;
3430 static int atihdmi_setup_stream(struct hda_codec *codec, hda_nid_t cvt_nid,
3431 hda_nid_t pin_nid, u32 stream_tag, int format)
3434 if (is_amdhdmi_rev3_or_later(codec)) {
3435 int ramp_rate = 180; /* default as per AMD spec */
3436 /* disable ramp-up/down for non-pcm as per AMD spec */
3437 if (format & AC_FMT_TYPE_NON_PCM)
3438 ramp_rate = 0;
3440 snd_hda_codec_write(codec, cvt_nid, 0, ATI_VERB_SET_RAMP_RATE, ramp_rate);
3443 return hdmi_setup_stream(codec, cvt_nid, pin_nid, stream_tag, format);
3447 static int atihdmi_init(struct hda_codec *codec)
3449 struct hdmi_spec *spec = codec->spec;
3450 int pin_idx, err;
3452 err = generic_hdmi_init(codec);
3454 if (err)
3455 return err;
3457 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
3458 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
3460 /* make sure downmix information in infoframe is zero */
3461 snd_hda_codec_write(codec, per_pin->pin_nid, 0, ATI_VERB_SET_DOWNMIX_INFO, 0);
3463 /* enable channel-wise remap mode if supported */
3464 if (has_amd_full_remap_support(codec))
3465 snd_hda_codec_write(codec, per_pin->pin_nid, 0,
3466 ATI_VERB_SET_MULTICHANNEL_MODE,
3467 ATI_MULTICHANNEL_MODE_SINGLE);
3470 return 0;
3473 static int patch_atihdmi(struct hda_codec *codec)
3475 struct hdmi_spec *spec;
3476 struct hdmi_spec_per_cvt *per_cvt;
3477 int err, cvt_idx;
3479 err = patch_generic_hdmi(codec);
3481 if (err)
3482 return err;
3484 codec->patch_ops.init = atihdmi_init;
3486 spec = codec->spec;
3488 spec->ops.pin_get_eld = atihdmi_pin_get_eld;
3489 spec->ops.pin_get_slot_channel = atihdmi_pin_get_slot_channel;
3490 spec->ops.pin_set_slot_channel = atihdmi_pin_set_slot_channel;
3491 spec->ops.pin_setup_infoframe = atihdmi_pin_setup_infoframe;
3492 spec->ops.pin_hbr_setup = atihdmi_pin_hbr_setup;
3493 spec->ops.setup_stream = atihdmi_setup_stream;
3495 if (!has_amd_full_remap_support(codec)) {
3496 /* override to ATI/AMD-specific versions with pairwise mapping */
3497 spec->ops.chmap_cea_alloc_validate_get_type =
3498 atihdmi_paired_chmap_cea_alloc_validate_get_type;
3499 spec->ops.cea_alloc_to_tlv_chmap = atihdmi_paired_cea_alloc_to_tlv_chmap;
3500 spec->ops.chmap_validate = atihdmi_paired_chmap_validate;
3503 /* ATI/AMD converters do not advertise all of their capabilities */
3504 for (cvt_idx = 0; cvt_idx < spec->num_cvts; cvt_idx++) {
3505 per_cvt = get_cvt(spec, cvt_idx);
3506 per_cvt->channels_max = max(per_cvt->channels_max, 8u);
3507 per_cvt->rates |= SUPPORTED_RATES;
3508 per_cvt->formats |= SUPPORTED_FORMATS;
3509 per_cvt->maxbps = max(per_cvt->maxbps, 24u);
3512 spec->channels_max = max(spec->channels_max, 8u);
3514 return 0;
3517 /* VIA HDMI Implementation */
3518 #define VIAHDMI_CVT_NID 0x02 /* audio converter1 */
3519 #define VIAHDMI_PIN_NID 0x03 /* HDMI output pin1 */
3521 static int patch_via_hdmi(struct hda_codec *codec)
3523 return patch_simple_hdmi(codec, VIAHDMI_CVT_NID, VIAHDMI_PIN_NID);
3527 * patch entries
3529 static const struct hda_device_id snd_hda_id_hdmi[] = {
3530 HDA_CODEC_ENTRY(0x1002793c, "RS600 HDMI", patch_atihdmi),
3531 HDA_CODEC_ENTRY(0x10027919, "RS600 HDMI", patch_atihdmi),
3532 HDA_CODEC_ENTRY(0x1002791a, "RS690/780 HDMI", patch_atihdmi),
3533 HDA_CODEC_ENTRY(0x1002aa01, "R6xx HDMI", patch_atihdmi),
3534 HDA_CODEC_ENTRY(0x10951390, "SiI1390 HDMI", patch_generic_hdmi),
3535 HDA_CODEC_ENTRY(0x10951392, "SiI1392 HDMI", patch_generic_hdmi),
3536 HDA_CODEC_ENTRY(0x17e80047, "Chrontel HDMI", patch_generic_hdmi),
3537 HDA_CODEC_ENTRY(0x10de0002, "MCP77/78 HDMI", patch_nvhdmi_8ch_7x),
3538 HDA_CODEC_ENTRY(0x10de0003, "MCP77/78 HDMI", patch_nvhdmi_8ch_7x),
3539 HDA_CODEC_ENTRY(0x10de0005, "MCP77/78 HDMI", patch_nvhdmi_8ch_7x),
3540 HDA_CODEC_ENTRY(0x10de0006, "MCP77/78 HDMI", patch_nvhdmi_8ch_7x),
3541 HDA_CODEC_ENTRY(0x10de0007, "MCP79/7A HDMI", patch_nvhdmi_8ch_7x),
3542 HDA_CODEC_ENTRY(0x10de000a, "GPU 0a HDMI/DP", patch_nvhdmi),
3543 HDA_CODEC_ENTRY(0x10de000b, "GPU 0b HDMI/DP", patch_nvhdmi),
3544 HDA_CODEC_ENTRY(0x10de000c, "MCP89 HDMI", patch_nvhdmi),
3545 HDA_CODEC_ENTRY(0x10de000d, "GPU 0d HDMI/DP", patch_nvhdmi),
3546 HDA_CODEC_ENTRY(0x10de0010, "GPU 10 HDMI/DP", patch_nvhdmi),
3547 HDA_CODEC_ENTRY(0x10de0011, "GPU 11 HDMI/DP", patch_nvhdmi),
3548 HDA_CODEC_ENTRY(0x10de0012, "GPU 12 HDMI/DP", patch_nvhdmi),
3549 HDA_CODEC_ENTRY(0x10de0013, "GPU 13 HDMI/DP", patch_nvhdmi),
3550 HDA_CODEC_ENTRY(0x10de0014, "GPU 14 HDMI/DP", patch_nvhdmi),
3551 HDA_CODEC_ENTRY(0x10de0015, "GPU 15 HDMI/DP", patch_nvhdmi),
3552 HDA_CODEC_ENTRY(0x10de0016, "GPU 16 HDMI/DP", patch_nvhdmi),
3553 /* 17 is known to be absent */
3554 HDA_CODEC_ENTRY(0x10de0018, "GPU 18 HDMI/DP", patch_nvhdmi),
3555 HDA_CODEC_ENTRY(0x10de0019, "GPU 19 HDMI/DP", patch_nvhdmi),
3556 HDA_CODEC_ENTRY(0x10de001a, "GPU 1a HDMI/DP", patch_nvhdmi),
3557 HDA_CODEC_ENTRY(0x10de001b, "GPU 1b HDMI/DP", patch_nvhdmi),
3558 HDA_CODEC_ENTRY(0x10de001c, "GPU 1c HDMI/DP", patch_nvhdmi),
3559 HDA_CODEC_ENTRY(0x10de0020, "Tegra30 HDMI", patch_tegra_hdmi),
3560 HDA_CODEC_ENTRY(0x10de0022, "Tegra114 HDMI", patch_tegra_hdmi),
3561 HDA_CODEC_ENTRY(0x10de0028, "Tegra124 HDMI", patch_tegra_hdmi),
3562 HDA_CODEC_ENTRY(0x10de0029, "Tegra210 HDMI/DP", patch_tegra_hdmi),
3563 HDA_CODEC_ENTRY(0x10de0040, "GPU 40 HDMI/DP", patch_nvhdmi),
3564 HDA_CODEC_ENTRY(0x10de0041, "GPU 41 HDMI/DP", patch_nvhdmi),
3565 HDA_CODEC_ENTRY(0x10de0042, "GPU 42 HDMI/DP", patch_nvhdmi),
3566 HDA_CODEC_ENTRY(0x10de0043, "GPU 43 HDMI/DP", patch_nvhdmi),
3567 HDA_CODEC_ENTRY(0x10de0044, "GPU 44 HDMI/DP", patch_nvhdmi),
3568 HDA_CODEC_ENTRY(0x10de0051, "GPU 51 HDMI/DP", patch_nvhdmi),
3569 HDA_CODEC_ENTRY(0x10de0060, "GPU 60 HDMI/DP", patch_nvhdmi),
3570 HDA_CODEC_ENTRY(0x10de0067, "MCP67 HDMI", patch_nvhdmi_2ch),
3571 HDA_CODEC_ENTRY(0x10de0070, "GPU 70 HDMI/DP", patch_nvhdmi),
3572 HDA_CODEC_ENTRY(0x10de0071, "GPU 71 HDMI/DP", patch_nvhdmi),
3573 HDA_CODEC_ENTRY(0x10de0072, "GPU 72 HDMI/DP", patch_nvhdmi),
3574 HDA_CODEC_ENTRY(0x10de007d, "GPU 7d HDMI/DP", patch_nvhdmi),
3575 HDA_CODEC_ENTRY(0x10de8001, "MCP73 HDMI", patch_nvhdmi_2ch),
3576 HDA_CODEC_ENTRY(0x11069f80, "VX900 HDMI/DP", patch_via_hdmi),
3577 HDA_CODEC_ENTRY(0x11069f81, "VX900 HDMI/DP", patch_via_hdmi),
3578 HDA_CODEC_ENTRY(0x11069f84, "VX11 HDMI/DP", patch_generic_hdmi),
3579 HDA_CODEC_ENTRY(0x11069f85, "VX11 HDMI/DP", patch_generic_hdmi),
3580 HDA_CODEC_ENTRY(0x80860054, "IbexPeak HDMI", patch_generic_hdmi),
3581 HDA_CODEC_ENTRY(0x80862801, "Bearlake HDMI", patch_generic_hdmi),
3582 HDA_CODEC_ENTRY(0x80862802, "Cantiga HDMI", patch_generic_hdmi),
3583 HDA_CODEC_ENTRY(0x80862803, "Eaglelake HDMI", patch_generic_hdmi),
3584 HDA_CODEC_ENTRY(0x80862804, "IbexPeak HDMI", patch_generic_hdmi),
3585 HDA_CODEC_ENTRY(0x80862805, "CougarPoint HDMI", patch_generic_hdmi),
3586 HDA_CODEC_ENTRY(0x80862806, "PantherPoint HDMI", patch_generic_hdmi),
3587 HDA_CODEC_ENTRY(0x80862807, "Haswell HDMI", patch_generic_hdmi),
3588 HDA_CODEC_ENTRY(0x80862808, "Broadwell HDMI", patch_generic_hdmi),
3589 HDA_CODEC_ENTRY(0x80862809, "Skylake HDMI", patch_generic_hdmi),
3590 HDA_CODEC_ENTRY(0x8086280a, "Broxton HDMI", patch_generic_hdmi),
3591 HDA_CODEC_ENTRY(0x8086280b, "Kabylake HDMI", patch_generic_hdmi),
3592 HDA_CODEC_ENTRY(0x80862880, "CedarTrail HDMI", patch_generic_hdmi),
3593 HDA_CODEC_ENTRY(0x80862882, "Valleyview2 HDMI", patch_generic_hdmi),
3594 HDA_CODEC_ENTRY(0x80862883, "Braswell HDMI", patch_generic_hdmi),
3595 HDA_CODEC_ENTRY(0x808629fb, "Crestline HDMI", patch_generic_hdmi),
3596 /* special ID for generic HDMI */
3597 HDA_CODEC_ENTRY(HDA_CODEC_ID_GENERIC_HDMI, "Generic HDMI", patch_generic_hdmi),
3598 {} /* terminator */
3600 MODULE_DEVICE_TABLE(hdaudio, snd_hda_id_hdmi);
3602 MODULE_LICENSE("GPL");
3603 MODULE_DESCRIPTION("HDMI HD-audio codec");
3604 MODULE_ALIAS("snd-hda-codec-intelhdmi");
3605 MODULE_ALIAS("snd-hda-codec-nvhdmi");
3606 MODULE_ALIAS("snd-hda-codec-atihdmi");
3608 static struct hda_codec_driver hdmi_driver = {
3609 .id = snd_hda_id_hdmi,
3612 module_hda_codec_driver(hdmi_driver);