projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
Merge remote-tracking branch 'spi/topic/build' into spi-next
[deliverable/linux.git] / sound / pci / hda / patch_hdmi.c
1 /*
2 *
3 * patch_hdmi.c - routines for HDMI/DisplayPort codecs
4 *
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 *
10 * Authors:
11 * Wu Fengguang <wfg@linux.intel.com>
12 *
13 * Maintained by:
14 * Wu Fengguang <wfg@linux.intel.com>
15 *
16 * This program is free software; you can redistribute it and/or modify it
17 * under the terms of the GNU General Public License as published by the Free
18 * Software Foundation; either version 2 of the License, or (at your option)
19 * any later version.
20 *
21 * This program is distributed in the hope that it will be useful, but
22 * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
23 * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
24 * for more details.
25 *
26 * You should have received a copy of the GNU General Public License
27 * along with this program; if not, write to the Free Software Foundation,
28 * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
29 */
30
31 #include <linux/init.h>
32 #include <linux/delay.h>
33 #include <linux/slab.h>
34 #include <linux/module.h>
35 #include <sound/core.h>
36 #include <sound/jack.h>
37 #include <sound/asoundef.h>
38 #include <sound/tlv.h>
39 #include "hda_codec.h"
40 #include "hda_local.h"
41 #include "hda_jack.h"
42
43 static bool static_hdmi_pcm;
44 module_param(static_hdmi_pcm, bool, 0644);
45 MODULE_PARM_DESC(static_hdmi_pcm, "Don't restrict PCM parameters per ELD info");
46
47 struct hdmi_spec_per_cvt {
48 hda_nid_t cvt_nid;
49 int assigned;
50 unsigned int channels_min;
51 unsigned int channels_max;
52 u32 rates;
53 u64 formats;
54 unsigned int maxbps;
55 };
56
57 /* max. connections to a widget */
58 #define HDA_MAX_CONNECTIONS 32
59
60 struct hdmi_spec_per_pin {
61 hda_nid_t pin_nid;
62 int num_mux_nids;
63 hda_nid_t mux_nids[HDA_MAX_CONNECTIONS];
64
65 struct hda_codec *codec;
66 struct hdmi_eld sink_eld;
67 struct delayed_work work;
68 struct snd_kcontrol *eld_ctl;
69 int repoll_count;
70 bool non_pcm;
71 bool chmap_set; /* channel-map override by ALSA API? */
72 unsigned char chmap[8]; /* ALSA API channel-map */
73 char pcm_name[8]; /* filled in build_pcm callbacks */
74 };
75
76 struct hdmi_spec {
77 int num_cvts;
78 struct snd_array cvts; /* struct hdmi_spec_per_cvt */
79 hda_nid_t cvt_nids[4]; /* only for haswell fix */
80
81 int num_pins;
82 struct snd_array pins; /* struct hdmi_spec_per_pin */
83 struct snd_array pcm_rec; /* struct hda_pcm */
84 unsigned int channels_max; /* max over all cvts */
85
86 struct hdmi_eld temp_eld;
87 /*
88 * Non-generic ATI/NVIDIA specific
89 */
90 struct hda_multi_out multiout;
91 struct hda_pcm_stream pcm_playback;
92 };
93
94
95 struct hdmi_audio_infoframe {
96 u8 type; /* 0x84 */
97 u8 ver; /* 0x01 */
98 u8 len; /* 0x0a */
99
100 u8 checksum;
101
102 u8 CC02_CT47; /* CC in bits 0:2, CT in 4:7 */
103 u8 SS01_SF24;
104 u8 CXT04;
105 u8 CA;
106 u8 LFEPBL01_LSV36_DM_INH7;
107 };
108
109 struct dp_audio_infoframe {
110 u8 type; /* 0x84 */
111 u8 len; /* 0x1b */
112 u8 ver; /* 0x11 << 2 */
113
114 u8 CC02_CT47; /* match with HDMI infoframe from this on */
115 u8 SS01_SF24;
116 u8 CXT04;
117 u8 CA;
118 u8 LFEPBL01_LSV36_DM_INH7;
119 };
120
121 union audio_infoframe {
122 struct hdmi_audio_infoframe hdmi;
123 struct dp_audio_infoframe dp;
124 u8 bytes[0];
125 };
126
127 /*
128 * CEA speaker placement:
129 *
130 * FLH FCH FRH
131 * FLW FL FLC FC FRC FR FRW
132 *
133 * LFE
134 * TC
135 *
136 * RL RLC RC RRC RR
137 *
138 * The Left/Right Surround channel _notions_ LS/RS in SMPTE 320M corresponds to
139 * CEA RL/RR; The SMPTE channel _assignment_ C/LFE is swapped to CEA LFE/FC.
140 */
141 enum cea_speaker_placement {
142 FL = (1 << 0), /* Front Left */
143 FC = (1 << 1), /* Front Center */
144 FR = (1 << 2), /* Front Right */
145 FLC = (1 << 3), /* Front Left Center */
146 FRC = (1 << 4), /* Front Right Center */
147 RL = (1 << 5), /* Rear Left */
148 RC = (1 << 6), /* Rear Center */
149 RR = (1 << 7), /* Rear Right */
150 RLC = (1 << 8), /* Rear Left Center */
151 RRC = (1 << 9), /* Rear Right Center */
152 LFE = (1 << 10), /* Low Frequency Effect */
153 FLW = (1 << 11), /* Front Left Wide */
154 FRW = (1 << 12), /* Front Right Wide */
155 FLH = (1 << 13), /* Front Left High */
156 FCH = (1 << 14), /* Front Center High */
157 FRH = (1 << 15), /* Front Right High */
158 TC = (1 << 16), /* Top Center */
159 };
160
161 /*
162 * ELD SA bits in the CEA Speaker Allocation data block
163 */
164 static int eld_speaker_allocation_bits[] = {
165 [0] = FL | FR,
166 [1] = LFE,
167 [2] = FC,
168 [3] = RL | RR,
169 [4] = RC,
170 [5] = FLC | FRC,
171 [6] = RLC | RRC,
172 /* the following are not defined in ELD yet */
173 [7] = FLW | FRW,
174 [8] = FLH | FRH,
175 [9] = TC,
176 [10] = FCH,
177 };
178
179 struct cea_channel_speaker_allocation {
180 int ca_index;
181 int speakers[8];
182
183 /* derived values, just for convenience */
184 int channels;
185 int spk_mask;
186 };
187
188 /*
189 * ALSA sequence is:
190 *
191 * surround40 surround41 surround50 surround51 surround71
192 * ch0 front left = = = =
193 * ch1 front right = = = =
194 * ch2 rear left = = = =
195 * ch3 rear right = = = =
196 * ch4 LFE center center center
197 * ch5 LFE LFE
198 * ch6 side left
199 * ch7 side right
200 *
201 * surround71 = {FL, FR, RLC, RRC, FC, LFE, RL, RR}
202 */
203 static int hdmi_channel_mapping[0x32][8] = {
204 /* stereo */
205 [0x00] = { 0x00, 0x11, 0xf2, 0xf3, 0xf4, 0xf5, 0xf6, 0xf7 },
206 /* 2.1 */
207 [0x01] = { 0x00, 0x11, 0x22, 0xf3, 0xf4, 0xf5, 0xf6, 0xf7 },
208 /* Dolby Surround */
209 [0x02] = { 0x00, 0x11, 0x23, 0xf2, 0xf4, 0xf5, 0xf6, 0xf7 },
210 /* surround40 */
211 [0x08] = { 0x00, 0x11, 0x24, 0x35, 0xf3, 0xf2, 0xf6, 0xf7 },
212 /* 4ch */
213 [0x03] = { 0x00, 0x11, 0x23, 0x32, 0x44, 0xf5, 0xf6, 0xf7 },
214 /* surround41 */
215 [0x09] = { 0x00, 0x11, 0x24, 0x35, 0x42, 0xf3, 0xf6, 0xf7 },
216 /* surround50 */
217 [0x0a] = { 0x00, 0x11, 0x24, 0x35, 0x43, 0xf2, 0xf6, 0xf7 },
218 /* surround51 */
219 [0x0b] = { 0x00, 0x11, 0x24, 0x35, 0x43, 0x52, 0xf6, 0xf7 },
220 /* 7.1 */
221 [0x13] = { 0x00, 0x11, 0x26, 0x37, 0x43, 0x52, 0x64, 0x75 },
222 };
223
224 /*
225 * This is an ordered list!
226 *
227 * The preceding ones have better chances to be selected by
228 * hdmi_channel_allocation().
229 */
230 static struct cea_channel_speaker_allocation channel_allocations[] = {
231 /* channel: 7 6 5 4 3 2 1 0 */
232 { .ca_index = 0x00, .speakers = { 0, 0, 0, 0, 0, 0, FR, FL } },
233 /* 2.1 */
234 { .ca_index = 0x01, .speakers = { 0, 0, 0, 0, 0, LFE, FR, FL } },
235 /* Dolby Surround */
236 { .ca_index = 0x02, .speakers = { 0, 0, 0, 0, FC, 0, FR, FL } },
237 /* surround40 */
238 { .ca_index = 0x08, .speakers = { 0, 0, RR, RL, 0, 0, FR, FL } },
239 /* surround41 */
240 { .ca_index = 0x09, .speakers = { 0, 0, RR, RL, 0, LFE, FR, FL } },
241 /* surround50 */
242 { .ca_index = 0x0a, .speakers = { 0, 0, RR, RL, FC, 0, FR, FL } },
243 /* surround51 */
244 { .ca_index = 0x0b, .speakers = { 0, 0, RR, RL, FC, LFE, FR, FL } },
245 /* 6.1 */
246 { .ca_index = 0x0f, .speakers = { 0, RC, RR, RL, FC, LFE, FR, FL } },
247 /* surround71 */
248 { .ca_index = 0x13, .speakers = { RRC, RLC, RR, RL, FC, LFE, FR, FL } },
249
250 { .ca_index = 0x03, .speakers = { 0, 0, 0, 0, FC, LFE, FR, FL } },
251 { .ca_index = 0x04, .speakers = { 0, 0, 0, RC, 0, 0, FR, FL } },
252 { .ca_index = 0x05, .speakers = { 0, 0, 0, RC, 0, LFE, FR, FL } },
253 { .ca_index = 0x06, .speakers = { 0, 0, 0, RC, FC, 0, FR, FL } },
254 { .ca_index = 0x07, .speakers = { 0, 0, 0, RC, FC, LFE, FR, FL } },
255 { .ca_index = 0x0c, .speakers = { 0, RC, RR, RL, 0, 0, FR, FL } },
256 { .ca_index = 0x0d, .speakers = { 0, RC, RR, RL, 0, LFE, FR, FL } },
257 { .ca_index = 0x0e, .speakers = { 0, RC, RR, RL, FC, 0, FR, FL } },
258 { .ca_index = 0x10, .speakers = { RRC, RLC, RR, RL, 0, 0, FR, FL } },
259 { .ca_index = 0x11, .speakers = { RRC, RLC, RR, RL, 0, LFE, FR, FL } },
260 { .ca_index = 0x12, .speakers = { RRC, RLC, RR, RL, FC, 0, FR, FL } },
261 { .ca_index = 0x14, .speakers = { FRC, FLC, 0, 0, 0, 0, FR, FL } },
262 { .ca_index = 0x15, .speakers = { FRC, FLC, 0, 0, 0, LFE, FR, FL } },
263 { .ca_index = 0x16, .speakers = { FRC, FLC, 0, 0, FC, 0, FR, FL } },
264 { .ca_index = 0x17, .speakers = { FRC, FLC, 0, 0, FC, LFE, FR, FL } },
265 { .ca_index = 0x18, .speakers = { FRC, FLC, 0, RC, 0, 0, FR, FL } },
266 { .ca_index = 0x19, .speakers = { FRC, FLC, 0, RC, 0, LFE, FR, FL } },
267 { .ca_index = 0x1a, .speakers = { FRC, FLC, 0, RC, FC, 0, FR, FL } },
268 { .ca_index = 0x1b, .speakers = { FRC, FLC, 0, RC, FC, LFE, FR, FL } },
269 { .ca_index = 0x1c, .speakers = { FRC, FLC, RR, RL, 0, 0, FR, FL } },
270 { .ca_index = 0x1d, .speakers = { FRC, FLC, RR, RL, 0, LFE, FR, FL } },
271 { .ca_index = 0x1e, .speakers = { FRC, FLC, RR, RL, FC, 0, FR, FL } },
272 { .ca_index = 0x1f, .speakers = { FRC, FLC, RR, RL, FC, LFE, FR, FL } },
273 { .ca_index = 0x20, .speakers = { 0, FCH, RR, RL, FC, 0, FR, FL } },
274 { .ca_index = 0x21, .speakers = { 0, FCH, RR, RL, FC, LFE, FR, FL } },
275 { .ca_index = 0x22, .speakers = { TC, 0, RR, RL, FC, 0, FR, FL } },
276 { .ca_index = 0x23, .speakers = { TC, 0, RR, RL, FC, LFE, FR, FL } },
277 { .ca_index = 0x24, .speakers = { FRH, FLH, RR, RL, 0, 0, FR, FL } },
278 { .ca_index = 0x25, .speakers = { FRH, FLH, RR, RL, 0, LFE, FR, FL } },
279 { .ca_index = 0x26, .speakers = { FRW, FLW, RR, RL, 0, 0, FR, FL } },
280 { .ca_index = 0x27, .speakers = { FRW, FLW, RR, RL, 0, LFE, FR, FL } },
281 { .ca_index = 0x28, .speakers = { TC, RC, RR, RL, FC, 0, FR, FL } },
282 { .ca_index = 0x29, .speakers = { TC, RC, RR, RL, FC, LFE, FR, FL } },
283 { .ca_index = 0x2a, .speakers = { FCH, RC, RR, RL, FC, 0, FR, FL } },
284 { .ca_index = 0x2b, .speakers = { FCH, RC, RR, RL, FC, LFE, FR, FL } },
285 { .ca_index = 0x2c, .speakers = { TC, FCH, RR, RL, FC, 0, FR, FL } },
286 { .ca_index = 0x2d, .speakers = { TC, FCH, RR, RL, FC, LFE, FR, FL } },
287 { .ca_index = 0x2e, .speakers = { FRH, FLH, RR, RL, FC, 0, FR, FL } },
288 { .ca_index = 0x2f, .speakers = { FRH, FLH, RR, RL, FC, LFE, FR, FL } },
289 { .ca_index = 0x30, .speakers = { FRW, FLW, RR, RL, FC, 0, FR, FL } },
290 { .ca_index = 0x31, .speakers = { FRW, FLW, RR, RL, FC, LFE, FR, FL } },
291 };
292
293
294 /*
295 * HDMI routines
296 */
297
298 #define get_pin(spec, idx) \
299 ((struct hdmi_spec_per_pin *)snd_array_elem(&spec->pins, idx))
300 #define get_cvt(spec, idx) \
301 ((struct hdmi_spec_per_cvt *)snd_array_elem(&spec->cvts, idx))
302 #define get_pcm_rec(spec, idx) \
303 ((struct hda_pcm *)snd_array_elem(&spec->pcm_rec, idx))
304
305 static int pin_nid_to_pin_index(struct hdmi_spec *spec, hda_nid_t pin_nid)
306 {
307 int pin_idx;
308
309 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++)
310 if (get_pin(spec, pin_idx)->pin_nid == pin_nid)
311 return pin_idx;
312
313 snd_printk(KERN_WARNING "HDMI: pin nid %d not registered\n", pin_nid);
314 return -EINVAL;
315 }
316
317 static int hinfo_to_pin_index(struct hdmi_spec *spec,
318 struct hda_pcm_stream *hinfo)
319 {
320 int pin_idx;
321
322 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++)
323 if (get_pcm_rec(spec, pin_idx)->stream == hinfo)
324 return pin_idx;
325
326 snd_printk(KERN_WARNING "HDMI: hinfo %p not registered\n", hinfo);
327 return -EINVAL;
328 }
329
330 static int cvt_nid_to_cvt_index(struct hdmi_spec *spec, hda_nid_t cvt_nid)
331 {
332 int cvt_idx;
333
334 for (cvt_idx = 0; cvt_idx < spec->num_cvts; cvt_idx++)
335 if (get_cvt(spec, cvt_idx)->cvt_nid == cvt_nid)
336 return cvt_idx;
337
338 snd_printk(KERN_WARNING "HDMI: cvt nid %d not registered\n", cvt_nid);
339 return -EINVAL;
340 }
341
342 static int hdmi_eld_ctl_info(struct snd_kcontrol *kcontrol,
343 struct snd_ctl_elem_info *uinfo)
344 {
345 struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
346 struct hdmi_spec *spec = codec->spec;
347 struct hdmi_eld *eld;
348 int pin_idx;
349
350 uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES;
351
352 pin_idx = kcontrol->private_value;
353 eld = &get_pin(spec, pin_idx)->sink_eld;
354
355 mutex_lock(&eld->lock);
356 uinfo->count = eld->eld_valid ? eld->eld_size : 0;
357 mutex_unlock(&eld->lock);
358
359 return 0;
360 }
361
362 static int hdmi_eld_ctl_get(struct snd_kcontrol *kcontrol,
363 struct snd_ctl_elem_value *ucontrol)
364 {
365 struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
366 struct hdmi_spec *spec = codec->spec;
367 struct hdmi_eld *eld;
368 int pin_idx;
369
370 pin_idx = kcontrol->private_value;
371 eld = &get_pin(spec, pin_idx)->sink_eld;
372
373 mutex_lock(&eld->lock);
374 if (eld->eld_size > ARRAY_SIZE(ucontrol->value.bytes.data)) {
375 mutex_unlock(&eld->lock);
376 snd_BUG();
377 return -EINVAL;
378 }
379
380 memset(ucontrol->value.bytes.data, 0,
381 ARRAY_SIZE(ucontrol->value.bytes.data));
382 if (eld->eld_valid)
383 memcpy(ucontrol->value.bytes.data, eld->eld_buffer,
384 eld->eld_size);
385 mutex_unlock(&eld->lock);
386
387 return 0;
388 }
389
390 static struct snd_kcontrol_new eld_bytes_ctl = {
391 .access = SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE,
392 .iface = SNDRV_CTL_ELEM_IFACE_PCM,
393 .name = "ELD",
394 .info = hdmi_eld_ctl_info,
395 .get = hdmi_eld_ctl_get,
396 };
397
398 static int hdmi_create_eld_ctl(struct hda_codec *codec, int pin_idx,
399 int device)
400 {
401 struct snd_kcontrol *kctl;
402 struct hdmi_spec *spec = codec->spec;
403 int err;
404
405 kctl = snd_ctl_new1(&eld_bytes_ctl, codec);
406 if (!kctl)
407 return -ENOMEM;
408 kctl->private_value = pin_idx;
409 kctl->id.device = device;
410
411 err = snd_hda_ctl_add(codec, get_pin(spec, pin_idx)->pin_nid, kctl);
412 if (err < 0)
413 return err;
414
415 get_pin(spec, pin_idx)->eld_ctl = kctl;
416 return 0;
417 }
418
419 #ifdef BE_PARANOID
420 static void hdmi_get_dip_index(struct hda_codec *codec, hda_nid_t pin_nid,
421 int *packet_index, int *byte_index)
422 {
423 int val;
424
425 val = snd_hda_codec_read(codec, pin_nid, 0,
426 AC_VERB_GET_HDMI_DIP_INDEX, 0);
427
428 *packet_index = val >> 5;
429 *byte_index = val & 0x1f;
430 }
431 #endif
432
433 static void hdmi_set_dip_index(struct hda_codec *codec, hda_nid_t pin_nid,
434 int packet_index, int byte_index)
435 {
436 int val;
437
438 val = (packet_index << 5) | (byte_index & 0x1f);
439
440 snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_INDEX, val);
441 }
442
443 static void hdmi_write_dip_byte(struct hda_codec *codec, hda_nid_t pin_nid,
444 unsigned char val)
445 {
446 snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_DATA, val);
447 }
448
449 static void hdmi_init_pin(struct hda_codec *codec, hda_nid_t pin_nid)
450 {
451 /* Unmute */
452 if (get_wcaps(codec, pin_nid) & AC_WCAP_OUT_AMP)
453 snd_hda_codec_write(codec, pin_nid, 0,
454 AC_VERB_SET_AMP_GAIN_MUTE, AMP_OUT_UNMUTE);
455 /* Enable pin out: some machines with GM965 gets broken output when
456 * the pin is disabled or changed while using with HDMI
457 */
458 snd_hda_codec_write(codec, pin_nid, 0,
459 AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT);
460 }
461
462 static int hdmi_get_channel_count(struct hda_codec *codec, hda_nid_t cvt_nid)
463 {
464 return 1 + snd_hda_codec_read(codec, cvt_nid, 0,
465 AC_VERB_GET_CVT_CHAN_COUNT, 0);
466 }
467
468 static void hdmi_set_channel_count(struct hda_codec *codec,
469 hda_nid_t cvt_nid, int chs)
470 {
471 if (chs != hdmi_get_channel_count(codec, cvt_nid))
472 snd_hda_codec_write(codec, cvt_nid, 0,
473 AC_VERB_SET_CVT_CHAN_COUNT, chs - 1);
474 }
475
476
477 /*
478 * Channel mapping routines
479 */
480
481 /*
482 * Compute derived values in channel_allocations[].
483 */
484 static void init_channel_allocations(void)
485 {
486 int i, j;
487 struct cea_channel_speaker_allocation *p;
488
489 for (i = 0; i < ARRAY_SIZE(channel_allocations); i++) {
490 p = channel_allocations + i;
491 p->channels = 0;
492 p->spk_mask = 0;
493 for (j = 0; j < ARRAY_SIZE(p->speakers); j++)
494 if (p->speakers[j]) {
495 p->channels++;
496 p->spk_mask |= p->speakers[j];
497 }
498 }
499 }
500
501 static int get_channel_allocation_order(int ca)
502 {
503 int i;
504
505 for (i = 0; i < ARRAY_SIZE(channel_allocations); i++) {
506 if (channel_allocations[i].ca_index == ca)
507 break;
508 }
509 return i;
510 }
511
512 /*
513 * The transformation takes two steps:
514 *
515 * eld->spk_alloc => (eld_speaker_allocation_bits[]) => spk_mask
516 * spk_mask => (channel_allocations[]) => ai->CA
517 *
518 * TODO: it could select the wrong CA from multiple candidates.
519 */
520 static int hdmi_channel_allocation(struct hdmi_eld *eld, int channels)
521 {
522 int i;
523 int ca = 0;
524 int spk_mask = 0;
525 char buf[SND_PRINT_CHANNEL_ALLOCATION_ADVISED_BUFSIZE];
526
527 /*
528 * CA defaults to 0 for basic stereo audio
529 */
530 if (channels <= 2)
531 return 0;
532
533 /*
534 * expand ELD's speaker allocation mask
535 *
536 * ELD tells the speaker mask in a compact(paired) form,
537 * expand ELD's notions to match the ones used by Audio InfoFrame.
538 */
539 for (i = 0; i < ARRAY_SIZE(eld_speaker_allocation_bits); i++) {
540 if (eld->info.spk_alloc & (1 << i))
541 spk_mask |= eld_speaker_allocation_bits[i];
542 }
543
544 /* search for the first working match in the CA table */
545 for (i = 0; i < ARRAY_SIZE(channel_allocations); i++) {
546 if (channels == channel_allocations[i].channels &&
547 (spk_mask & channel_allocations[i].spk_mask) ==
548 channel_allocations[i].spk_mask) {
549 ca = channel_allocations[i].ca_index;
550 break;
551 }
552 }
553
554 snd_print_channel_allocation(eld->info.spk_alloc, buf, sizeof(buf));
555 snd_printdd("HDMI: select CA 0x%x for %d-channel allocation: %s\n",
556 ca, channels, buf);
557
558 return ca;
559 }
560
561 static void hdmi_debug_channel_mapping(struct hda_codec *codec,
562 hda_nid_t pin_nid)
563 {
564 #ifdef CONFIG_SND_DEBUG_VERBOSE
565 int i;
566 int slot;
567
568 for (i = 0; i < 8; i++) {
569 slot = snd_hda_codec_read(codec, pin_nid, 0,
570 AC_VERB_GET_HDMI_CHAN_SLOT, i);
571 printk(KERN_DEBUG "HDMI: ASP channel %d => slot %d\n",
572 slot >> 4, slot & 0xf);
573 }
574 #endif
575 }
576
577
578 static void hdmi_std_setup_channel_mapping(struct hda_codec *codec,
579 hda_nid_t pin_nid,
580 bool non_pcm,
581 int ca)
582 {
583 int i;
584 int err;
585 int order;
586 int non_pcm_mapping[8];
587
588 order = get_channel_allocation_order(ca);
589
590 if (hdmi_channel_mapping[ca][1] == 0) {
591 for (i = 0; i < channel_allocations[order].channels; i++)
592 hdmi_channel_mapping[ca][i] = i | (i << 4);
593 for (; i < 8; i++)
594 hdmi_channel_mapping[ca][i] = 0xf | (i << 4);
595 }
596
597 if (non_pcm) {
598 for (i = 0; i < channel_allocations[order].channels; i++)
599 non_pcm_mapping[i] = i | (i << 4);
600 for (; i < 8; i++)
601 non_pcm_mapping[i] = 0xf | (i << 4);
602 }
603
604 for (i = 0; i < 8; i++) {
605 err = snd_hda_codec_write(codec, pin_nid, 0,
606 AC_VERB_SET_HDMI_CHAN_SLOT,
607 non_pcm ? non_pcm_mapping[i] : hdmi_channel_mapping[ca][i]);
608 if (err) {
609 snd_printdd(KERN_NOTICE
610 "HDMI: channel mapping failed\n");
611 break;
612 }
613 }
614
615 hdmi_debug_channel_mapping(codec, pin_nid);
616 }
617
618 struct channel_map_table {
619 unsigned char map; /* ALSA API channel map position */
620 unsigned char cea_slot; /* CEA slot value */
621 int spk_mask; /* speaker position bit mask */
622 };
623
624 static struct channel_map_table map_tables[] = {
625 { SNDRV_CHMAP_FL, 0x00, FL },
626 { SNDRV_CHMAP_FR, 0x01, FR },
627 { SNDRV_CHMAP_RL, 0x04, RL },
628 { SNDRV_CHMAP_RR, 0x05, RR },
629 { SNDRV_CHMAP_LFE, 0x02, LFE },
630 { SNDRV_CHMAP_FC, 0x03, FC },
631 { SNDRV_CHMAP_RLC, 0x06, RLC },
632 { SNDRV_CHMAP_RRC, 0x07, RRC },
633 {} /* terminator */
634 };
635
636 /* from ALSA API channel position to speaker bit mask */
637 static int to_spk_mask(unsigned char c)
638 {
639 struct channel_map_table *t = map_tables;
640 for (; t->map; t++) {
641 if (t->map == c)
642 return t->spk_mask;
643 }
644 return 0;
645 }
646
647 /* from ALSA API channel position to CEA slot */
648 static int to_cea_slot(unsigned char c)
649 {
650 struct channel_map_table *t = map_tables;
651 for (; t->map; t++) {
652 if (t->map == c)
653 return t->cea_slot;
654 }
655 return 0x0f;
656 }
657
658 /* from CEA slot to ALSA API channel position */
659 static int from_cea_slot(unsigned char c)
660 {
661 struct channel_map_table *t = map_tables;
662 for (; t->map; t++) {
663 if (t->cea_slot == c)
664 return t->map;
665 }
666 return 0;
667 }
668
669 /* from speaker bit mask to ALSA API channel position */
670 static int spk_to_chmap(int spk)
671 {
672 struct channel_map_table *t = map_tables;
673 for (; t->map; t++) {
674 if (t->spk_mask == spk)
675 return t->map;
676 }
677 return 0;
678 }
679
680 /* get the CA index corresponding to the given ALSA API channel map */
681 static int hdmi_manual_channel_allocation(int chs, unsigned char *map)
682 {
683 int i, spks = 0, spk_mask = 0;
684
685 for (i = 0; i < chs; i++) {
686 int mask = to_spk_mask(map[i]);
687 if (mask) {
688 spk_mask |= mask;
689 spks++;
690 }
691 }
692
693 for (i = 0; i < ARRAY_SIZE(channel_allocations); i++) {
694 if ((chs == channel_allocations[i].channels ||
695 spks == channel_allocations[i].channels) &&
696 (spk_mask & channel_allocations[i].spk_mask) ==
697 channel_allocations[i].spk_mask)
698 return channel_allocations[i].ca_index;
699 }
700 return -1;
701 }
702
703 /* set up the channel slots for the given ALSA API channel map */
704 static int hdmi_manual_setup_channel_mapping(struct hda_codec *codec,
705 hda_nid_t pin_nid,
706 int chs, unsigned char *map)
707 {
708 int i;
709 for (i = 0; i < 8; i++) {
710 int val, err;
711 if (i < chs)
712 val = to_cea_slot(map[i]);
713 else
714 val = 0xf;
715 val |= (i << 4);
716 err = snd_hda_codec_write(codec, pin_nid, 0,
717 AC_VERB_SET_HDMI_CHAN_SLOT, val);
718 if (err)
719 return -EINVAL;
720 }
721 return 0;
722 }
723
724 /* store ALSA API channel map from the current default map */
725 static void hdmi_setup_fake_chmap(unsigned char *map, int ca)
726 {
727 int i;
728 for (i = 0; i < 8; i++) {
729 if (i < channel_allocations[ca].channels)
730 map[i] = from_cea_slot((hdmi_channel_mapping[ca][i] >> 4) & 0x0f);
731 else
732 map[i] = 0;
733 }
734 }
735
736 static void hdmi_setup_channel_mapping(struct hda_codec *codec,
737 hda_nid_t pin_nid, bool non_pcm, int ca,
738 int channels, unsigned char *map,
739 bool chmap_set)
740 {
741 if (!non_pcm && chmap_set) {
742 hdmi_manual_setup_channel_mapping(codec, pin_nid,
743 channels, map);
744 } else {
745 hdmi_std_setup_channel_mapping(codec, pin_nid, non_pcm, ca);
746 hdmi_setup_fake_chmap(map, ca);
747 }
748 }
749
750 /*
751 * Audio InfoFrame routines
752 */
753
754 /*
755 * Enable Audio InfoFrame Transmission
756 */
757 static void hdmi_start_infoframe_trans(struct hda_codec *codec,
758 hda_nid_t pin_nid)
759 {
760 hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0);
761 snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_XMIT,
762 AC_DIPXMIT_BEST);
763 }
764
765 /*
766 * Disable Audio InfoFrame Transmission
767 */
768 static void hdmi_stop_infoframe_trans(struct hda_codec *codec,
769 hda_nid_t pin_nid)
770 {
771 hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0);
772 snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_XMIT,
773 AC_DIPXMIT_DISABLE);
774 }
775
776 static void hdmi_debug_dip_size(struct hda_codec *codec, hda_nid_t pin_nid)
777 {
778 #ifdef CONFIG_SND_DEBUG_VERBOSE
779 int i;
780 int size;
781
782 size = snd_hdmi_get_eld_size(codec, pin_nid);
783 printk(KERN_DEBUG "HDMI: ELD buf size is %d\n", size);
784
785 for (i = 0; i < 8; i++) {
786 size = snd_hda_codec_read(codec, pin_nid, 0,
787 AC_VERB_GET_HDMI_DIP_SIZE, i);
788 printk(KERN_DEBUG "HDMI: DIP GP[%d] buf size is %d\n", i, size);
789 }
790 #endif
791 }
792
793 static void hdmi_clear_dip_buffers(struct hda_codec *codec, hda_nid_t pin_nid)
794 {
795 #ifdef BE_PARANOID
796 int i, j;
797 int size;
798 int pi, bi;
799 for (i = 0; i < 8; i++) {
800 size = snd_hda_codec_read(codec, pin_nid, 0,
801 AC_VERB_GET_HDMI_DIP_SIZE, i);
802 if (size == 0)
803 continue;
804
805 hdmi_set_dip_index(codec, pin_nid, i, 0x0);
806 for (j = 1; j < 1000; j++) {
807 hdmi_write_dip_byte(codec, pin_nid, 0x0);
808 hdmi_get_dip_index(codec, pin_nid, &pi, &bi);
809 if (pi != i)
810 snd_printd(KERN_INFO "dip index %d: %d != %d\n",
811 bi, pi, i);
812 if (bi == 0) /* byte index wrapped around */
813 break;
814 }
815 snd_printd(KERN_INFO
816 "HDMI: DIP GP[%d] buf reported size=%d, written=%d\n",
817 i, size, j);
818 }
819 #endif
820 }
821
822 static void hdmi_checksum_audio_infoframe(struct hdmi_audio_infoframe *hdmi_ai)
823 {
824 u8 *bytes = (u8 *)hdmi_ai;
825 u8 sum = 0;
826 int i;
827
828 hdmi_ai->checksum = 0;
829
830 for (i = 0; i < sizeof(*hdmi_ai); i++)
831 sum += bytes[i];
832
833 hdmi_ai->checksum = -sum;
834 }
835
836 static void hdmi_fill_audio_infoframe(struct hda_codec *codec,
837 hda_nid_t pin_nid,
838 u8 *dip, int size)
839 {
840 int i;
841
842 hdmi_debug_dip_size(codec, pin_nid);
843 hdmi_clear_dip_buffers(codec, pin_nid); /* be paranoid */
844
845 hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0);
846 for (i = 0; i < size; i++)
847 hdmi_write_dip_byte(codec, pin_nid, dip[i]);
848 }
849
850 static bool hdmi_infoframe_uptodate(struct hda_codec *codec, hda_nid_t pin_nid,
851 u8 *dip, int size)
852 {
853 u8 val;
854 int i;
855
856 if (snd_hda_codec_read(codec, pin_nid, 0, AC_VERB_GET_HDMI_DIP_XMIT, 0)
857 != AC_DIPXMIT_BEST)
858 return false;
859
860 hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0);
861 for (i = 0; i < size; i++) {
862 val = snd_hda_codec_read(codec, pin_nid, 0,
863 AC_VERB_GET_HDMI_DIP_DATA, 0);
864 if (val != dip[i])
865 return false;
866 }
867
868 return true;
869 }
870
871 static void hdmi_setup_audio_infoframe(struct hda_codec *codec, int pin_idx,
872 bool non_pcm,
873 struct snd_pcm_substream *substream)
874 {
875 struct hdmi_spec *spec = codec->spec;
876 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
877 hda_nid_t pin_nid = per_pin->pin_nid;
878 int channels = substream->runtime->channels;
879 struct hdmi_eld *eld;
880 int ca;
881 union audio_infoframe ai;
882
883 eld = &per_pin->sink_eld;
884 if (!eld->monitor_present)
885 return;
886
887 if (!non_pcm && per_pin->chmap_set)
888 ca = hdmi_manual_channel_allocation(channels, per_pin->chmap);
889 else
890 ca = hdmi_channel_allocation(eld, channels);
891 if (ca < 0)
892 ca = 0;
893
894 memset(&ai, 0, sizeof(ai));
895 if (eld->info.conn_type == 0) { /* HDMI */
896 struct hdmi_audio_infoframe *hdmi_ai = &ai.hdmi;
897
898 hdmi_ai->type = 0x84;
899 hdmi_ai->ver = 0x01;
900 hdmi_ai->len = 0x0a;
901 hdmi_ai->CC02_CT47 = channels - 1;
902 hdmi_ai->CA = ca;
903 hdmi_checksum_audio_infoframe(hdmi_ai);
904 } else if (eld->info.conn_type == 1) { /* DisplayPort */
905 struct dp_audio_infoframe *dp_ai = &ai.dp;
906
907 dp_ai->type = 0x84;
908 dp_ai->len = 0x1b;
909 dp_ai->ver = 0x11 << 2;
910 dp_ai->CC02_CT47 = channels - 1;
911 dp_ai->CA = ca;
912 } else {
913 snd_printd("HDMI: unknown connection type at pin %d\n",
914 pin_nid);
915 return;
916 }
917
918 /*
919 * sizeof(ai) is used instead of sizeof(*hdmi_ai) or
920 * sizeof(*dp_ai) to avoid partial match/update problems when
921 * the user switches between HDMI/DP monitors.
922 */
923 if (!hdmi_infoframe_uptodate(codec, pin_nid, ai.bytes,
924 sizeof(ai))) {
925 snd_printdd("hdmi_setup_audio_infoframe: "
926 "pin=%d channels=%d\n",
927 pin_nid,
928 channels);
929 hdmi_setup_channel_mapping(codec, pin_nid, non_pcm, ca,
930 channels, per_pin->chmap,
931 per_pin->chmap_set);
932 hdmi_stop_infoframe_trans(codec, pin_nid);
933 hdmi_fill_audio_infoframe(codec, pin_nid,
934 ai.bytes, sizeof(ai));
935 hdmi_start_infoframe_trans(codec, pin_nid);
936 } else {
937 /* For non-pcm audio switch, setup new channel mapping
938 * accordingly */
939 if (per_pin->non_pcm != non_pcm)
940 hdmi_setup_channel_mapping(codec, pin_nid, non_pcm, ca,
941 channels, per_pin->chmap,
942 per_pin->chmap_set);
943 }
944
945 per_pin->non_pcm = non_pcm;
946 }
947
948
949 /*
950 * Unsolicited events
951 */
952
953 static void hdmi_present_sense(struct hdmi_spec_per_pin *per_pin, int repoll);
954
955 static void hdmi_intrinsic_event(struct hda_codec *codec, unsigned int res)
956 {
957 struct hdmi_spec *spec = codec->spec;
958 int tag = res >> AC_UNSOL_RES_TAG_SHIFT;
959 int pin_nid;
960 int pin_idx;
961 struct hda_jack_tbl *jack;
962
963 jack = snd_hda_jack_tbl_get_from_tag(codec, tag);
964 if (!jack)
965 return;
966 pin_nid = jack->nid;
967 jack->jack_dirty = 1;
968
969 _snd_printd(SND_PR_VERBOSE,
970 "HDMI hot plug event: Codec=%d Pin=%d Presence_Detect=%d ELD_Valid=%d\n",
971 codec->addr, pin_nid,
972 !!(res & AC_UNSOL_RES_PD), !!(res & AC_UNSOL_RES_ELDV));
973
974 pin_idx = pin_nid_to_pin_index(spec, pin_nid);
975 if (pin_idx < 0)
976 return;
977
978 hdmi_present_sense(get_pin(spec, pin_idx), 1);
979 snd_hda_jack_report_sync(codec);
980 }
981
982 static void hdmi_non_intrinsic_event(struct hda_codec *codec, unsigned int res)
983 {
984 int tag = res >> AC_UNSOL_RES_TAG_SHIFT;
985 int subtag = (res & AC_UNSOL_RES_SUBTAG) >> AC_UNSOL_RES_SUBTAG_SHIFT;
986 int cp_state = !!(res & AC_UNSOL_RES_CP_STATE);
987 int cp_ready = !!(res & AC_UNSOL_RES_CP_READY);
988
989 printk(KERN_INFO
990 "HDMI CP event: CODEC=%d TAG=%d SUBTAG=0x%x CP_STATE=%d CP_READY=%d\n",
991 codec->addr,
992 tag,
993 subtag,
994 cp_state,
995 cp_ready);
996
997 /* TODO */
998 if (cp_state)
999 ;
1000 if (cp_ready)
1001 ;
1002 }
1003
1004
1005 static void hdmi_unsol_event(struct hda_codec *codec, unsigned int res)
1006 {
1007 int tag = res >> AC_UNSOL_RES_TAG_SHIFT;
1008 int subtag = (res & AC_UNSOL_RES_SUBTAG) >> AC_UNSOL_RES_SUBTAG_SHIFT;
1009
1010 if (!snd_hda_jack_tbl_get_from_tag(codec, tag)) {
1011 snd_printd(KERN_INFO "Unexpected HDMI event tag 0x%x\n", tag);
1012 return;
1013 }
1014
1015 if (subtag == 0)
1016 hdmi_intrinsic_event(codec, res);
1017 else
1018 hdmi_non_intrinsic_event(codec, res);
1019 }
1020
1021 static void haswell_verify_pin_D0(struct hda_codec *codec,
1022 hda_nid_t cvt_nid, hda_nid_t nid)
1023 {
1024 int pwr, lamp, ramp;
1025
1026 /* For Haswell, the converter 1/2 may keep in D3 state after bootup,
1027 * thus pins could only choose converter 0 for use. Make sure the
1028 * converters are in correct power state */
1029 if (!snd_hda_check_power_state(codec, cvt_nid, AC_PWRST_D0))
1030 snd_hda_codec_write(codec, cvt_nid, 0, AC_VERB_SET_POWER_STATE, AC_PWRST_D0);
1031
1032 if (!snd_hda_check_power_state(codec, nid, AC_PWRST_D0)) {
1033 snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_POWER_STATE,
1034 AC_PWRST_D0);
1035 msleep(40);
1036 pwr = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_POWER_STATE, 0);
1037 pwr = (pwr & AC_PWRST_ACTUAL) >> AC_PWRST_ACTUAL_SHIFT;
1038 snd_printd("Haswell HDMI audio: Power for pin 0x%x is now D%d\n", nid, pwr);
1039 }
1040
1041 lamp = snd_hda_codec_read(codec, nid, 0,
1042 AC_VERB_GET_AMP_GAIN_MUTE,
1043 AC_AMP_GET_LEFT | AC_AMP_GET_OUTPUT);
1044 ramp = snd_hda_codec_read(codec, nid, 0,
1045 AC_VERB_GET_AMP_GAIN_MUTE,
1046 AC_AMP_GET_RIGHT | AC_AMP_GET_OUTPUT);
1047 if (lamp != ramp) {
1048 snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_AMP_GAIN_MUTE,
1049 AC_AMP_SET_RIGHT | AC_AMP_SET_OUTPUT | lamp);
1050
1051 lamp = snd_hda_codec_read(codec, nid, 0,
1052 AC_VERB_GET_AMP_GAIN_MUTE,
1053 AC_AMP_GET_LEFT | AC_AMP_GET_OUTPUT);
1054 ramp = snd_hda_codec_read(codec, nid, 0,
1055 AC_VERB_GET_AMP_GAIN_MUTE,
1056 AC_AMP_GET_RIGHT | AC_AMP_GET_OUTPUT);
1057 snd_printd("Haswell HDMI audio: Mute after set on pin 0x%x: [0x%x 0x%x]\n", nid, lamp, ramp);
1058 }
1059 }
1060
1061 /*
1062 * Callbacks
1063 */
1064
1065 /* HBR should be Non-PCM, 8 channels */
1066 #define is_hbr_format(format) \
1067 ((format & AC_FMT_TYPE_NON_PCM) && (format & AC_FMT_CHAN_MASK) == 7)
1068
1069 static int hdmi_setup_stream(struct hda_codec *codec, hda_nid_t cvt_nid,
1070 hda_nid_t pin_nid, u32 stream_tag, int format)
1071 {
1072 int pinctl;
1073 int new_pinctl = 0;
1074
1075 if (codec->vendor_id == 0x80862807)
1076 haswell_verify_pin_D0(codec, cvt_nid, pin_nid);
1077
1078 if (snd_hda_query_pin_caps(codec, pin_nid) & AC_PINCAP_HBR) {
1079 pinctl = snd_hda_codec_read(codec, pin_nid, 0,
1080 AC_VERB_GET_PIN_WIDGET_CONTROL, 0);
1081
1082 new_pinctl = pinctl & ~AC_PINCTL_EPT;
1083 if (is_hbr_format(format))
1084 new_pinctl |= AC_PINCTL_EPT_HBR;
1085 else
1086 new_pinctl |= AC_PINCTL_EPT_NATIVE;
1087
1088 snd_printdd("hdmi_setup_stream: "
1089 "NID=0x%x, %spinctl=0x%x\n",
1090 pin_nid,
1091 pinctl == new_pinctl ? "" : "new-",
1092 new_pinctl);
1093
1094 if (pinctl != new_pinctl)
1095 snd_hda_codec_write(codec, pin_nid, 0,
1096 AC_VERB_SET_PIN_WIDGET_CONTROL,
1097 new_pinctl);
1098
1099 }
1100 if (is_hbr_format(format) && !new_pinctl) {
1101 snd_printdd("hdmi_setup_stream: HBR is not supported\n");
1102 return -EINVAL;
1103 }
1104
1105 snd_hda_codec_setup_stream(codec, cvt_nid, stream_tag, 0, format);
1106 return 0;
1107 }
1108
1109 static int hdmi_choose_cvt(struct hda_codec *codec,
1110 int pin_idx, int *cvt_id, int *mux_id)
1111 {
1112 struct hdmi_spec *spec = codec->spec;
1113 struct hdmi_spec_per_pin *per_pin;
1114 struct hdmi_spec_per_cvt *per_cvt = NULL;
1115 int cvt_idx, mux_idx = 0;
1116
1117 per_pin = get_pin(spec, pin_idx);
1118
1119 /* Dynamically assign converter to stream */
1120 for (cvt_idx = 0; cvt_idx < spec->num_cvts; cvt_idx++) {
1121 per_cvt = get_cvt(spec, cvt_idx);
1122
1123 /* Must not already be assigned */
1124 if (per_cvt->assigned)
1125 continue;
1126 /* Must be in pin's mux's list of converters */
1127 for (mux_idx = 0; mux_idx < per_pin->num_mux_nids; mux_idx++)
1128 if (per_pin->mux_nids[mux_idx] == per_cvt->cvt_nid)
1129 break;
1130 /* Not in mux list */
1131 if (mux_idx == per_pin->num_mux_nids)
1132 continue;
1133 break;
1134 }
1135
1136 /* No free converters */
1137 if (cvt_idx == spec->num_cvts)
1138 return -ENODEV;
1139
1140 if (cvt_id)
1141 *cvt_id = cvt_idx;
1142 if (mux_id)
1143 *mux_id = mux_idx;
1144
1145 return 0;
1146 }
1147
1148 static void haswell_config_cvts(struct hda_codec *codec,
1149 int pin_id, int mux_id)
1150 {
1151 struct hdmi_spec *spec = codec->spec;
1152 struct hdmi_spec_per_pin *per_pin;
1153 int pin_idx, mux_idx;
1154 int curr;
1155 int err;
1156
1157 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
1158 per_pin = get_pin(spec, pin_idx);
1159
1160 if (pin_idx == pin_id)
1161 continue;
1162
1163 curr = snd_hda_codec_read(codec, per_pin->pin_nid, 0,
1164 AC_VERB_GET_CONNECT_SEL, 0);
1165
1166 /* Choose another unused converter */
1167 if (curr == mux_id) {
1168 err = hdmi_choose_cvt(codec, pin_idx, NULL, &mux_idx);
1169 if (err < 0)
1170 return;
1171 snd_printdd("HDMI: choose converter %d for pin %d\n", mux_idx, pin_idx);
1172 snd_hda_codec_write_cache(codec, per_pin->pin_nid, 0,
1173 AC_VERB_SET_CONNECT_SEL,
1174 mux_idx);
1175 }
1176 }
1177 }
1178
1179 /*
1180 * HDA PCM callbacks
1181 */
1182 static int hdmi_pcm_open(struct hda_pcm_stream *hinfo,
1183 struct hda_codec *codec,
1184 struct snd_pcm_substream *substream)
1185 {
1186 struct hdmi_spec *spec = codec->spec;
1187 struct snd_pcm_runtime *runtime = substream->runtime;
1188 int pin_idx, cvt_idx, mux_idx = 0;
1189 struct hdmi_spec_per_pin *per_pin;
1190 struct hdmi_eld *eld;
1191 struct hdmi_spec_per_cvt *per_cvt = NULL;
1192 int err;
1193
1194 /* Validate hinfo */
1195 pin_idx = hinfo_to_pin_index(spec, hinfo);
1196 if (snd_BUG_ON(pin_idx < 0))
1197 return -EINVAL;
1198 per_pin = get_pin(spec, pin_idx);
1199 eld = &per_pin->sink_eld;
1200
1201 err = hdmi_choose_cvt(codec, pin_idx, &cvt_idx, &mux_idx);
1202 if (err < 0)
1203 return err;
1204
1205 per_cvt = get_cvt(spec, cvt_idx);
1206 /* Claim converter */
1207 per_cvt->assigned = 1;
1208 hinfo->nid = per_cvt->cvt_nid;
1209
1210 snd_hda_codec_write_cache(codec, per_pin->pin_nid, 0,
1211 AC_VERB_SET_CONNECT_SEL,
1212 mux_idx);
1213
1214 /* configure unused pins to choose other converters */
1215 if (codec->vendor_id == 0x80862807)
1216 haswell_config_cvts(codec, pin_idx, mux_idx);
1217
1218 snd_hda_spdif_ctls_assign(codec, pin_idx, per_cvt->cvt_nid);
1219
1220 /* Initially set the converter's capabilities */
1221 hinfo->channels_min = per_cvt->channels_min;
1222 hinfo->channels_max = per_cvt->channels_max;
1223 hinfo->rates = per_cvt->rates;
1224 hinfo->formats = per_cvt->formats;
1225 hinfo->maxbps = per_cvt->maxbps;
1226
1227 /* Restrict capabilities by ELD if this isn't disabled */
1228 if (!static_hdmi_pcm && eld->eld_valid) {
1229 snd_hdmi_eld_update_pcm_info(&eld->info, hinfo);
1230 if (hinfo->channels_min > hinfo->channels_max ||
1231 !hinfo->rates || !hinfo->formats) {
1232 per_cvt->assigned = 0;
1233 hinfo->nid = 0;
1234 snd_hda_spdif_ctls_unassign(codec, pin_idx);
1235 return -ENODEV;
1236 }
1237 }
1238
1239 /* Store the updated parameters */
1240 runtime->hw.channels_min = hinfo->channels_min;
1241 runtime->hw.channels_max = hinfo->channels_max;
1242 runtime->hw.formats = hinfo->formats;
1243 runtime->hw.rates = hinfo->rates;
1244
1245 snd_pcm_hw_constraint_step(substream->runtime, 0,
1246 SNDRV_PCM_HW_PARAM_CHANNELS, 2);
1247 return 0;
1248 }
1249
1250 /*
1251 * HDA/HDMI auto parsing
1252 */
1253 static int hdmi_read_pin_conn(struct hda_codec *codec, int pin_idx)
1254 {
1255 struct hdmi_spec *spec = codec->spec;
1256 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
1257 hda_nid_t pin_nid = per_pin->pin_nid;
1258
1259 if (!(get_wcaps(codec, pin_nid) & AC_WCAP_CONN_LIST)) {
1260 snd_printk(KERN_WARNING
1261 "HDMI: pin %d wcaps %#x "
1262 "does not support connection list\n",
1263 pin_nid, get_wcaps(codec, pin_nid));
1264 return -EINVAL;
1265 }
1266
1267 per_pin->num_mux_nids = snd_hda_get_connections(codec, pin_nid,
1268 per_pin->mux_nids,
1269 HDA_MAX_CONNECTIONS);
1270
1271 return 0;
1272 }
1273
1274 static void hdmi_present_sense(struct hdmi_spec_per_pin *per_pin, int repoll)
1275 {
1276 struct hda_codec *codec = per_pin->codec;
1277 struct hdmi_spec *spec = codec->spec;
1278 struct hdmi_eld *eld = &spec->temp_eld;
1279 struct hdmi_eld *pin_eld = &per_pin->sink_eld;
1280 hda_nid_t pin_nid = per_pin->pin_nid;
1281 /*
1282 * Always execute a GetPinSense verb here, even when called from
1283 * hdmi_intrinsic_event; for some NVIDIA HW, the unsolicited
1284 * response's PD bit is not the real PD value, but indicates that
1285 * the real PD value changed. An older version of the HD-audio
1286 * specification worked this way. Hence, we just ignore the data in
1287 * the unsolicited response to avoid custom WARs.
1288 */
1289 int present = snd_hda_pin_sense(codec, pin_nid);
1290 bool update_eld = false;
1291 bool eld_changed = false;
1292
1293 pin_eld->monitor_present = !!(present & AC_PINSENSE_PRESENCE);
1294 if (pin_eld->monitor_present)
1295 eld->eld_valid = !!(present & AC_PINSENSE_ELDV);
1296 else
1297 eld->eld_valid = false;
1298
1299 _snd_printd(SND_PR_VERBOSE,
1300 "HDMI status: Codec=%d Pin=%d Presence_Detect=%d ELD_Valid=%d\n",
1301 codec->addr, pin_nid, pin_eld->monitor_present, eld->eld_valid);
1302
1303 if (eld->eld_valid) {
1304 if (snd_hdmi_get_eld(codec, pin_nid, eld->eld_buffer,
1305 &eld->eld_size) < 0)
1306 eld->eld_valid = false;
1307 else {
1308 memset(&eld->info, 0, sizeof(struct parsed_hdmi_eld));
1309 if (snd_hdmi_parse_eld(&eld->info, eld->eld_buffer,
1310 eld->eld_size) < 0)
1311 eld->eld_valid = false;
1312 }
1313
1314 if (eld->eld_valid) {
1315 snd_hdmi_show_eld(&eld->info);
1316 update_eld = true;
1317 }
1318 else if (repoll) {
1319 queue_delayed_work(codec->bus->workq,
1320 &per_pin->work,
1321 msecs_to_jiffies(300));
1322 return;
1323 }
1324 }
1325
1326 mutex_lock(&pin_eld->lock);
1327 if (pin_eld->eld_valid && !eld->eld_valid) {
1328 update_eld = true;
1329 eld_changed = true;
1330 }
1331 if (update_eld) {
1332 pin_eld->eld_valid = eld->eld_valid;
1333 eld_changed = pin_eld->eld_size != eld->eld_size ||
1334 memcmp(pin_eld->eld_buffer, eld->eld_buffer,
1335 eld->eld_size) != 0;
1336 if (eld_changed)
1337 memcpy(pin_eld->eld_buffer, eld->eld_buffer,
1338 eld->eld_size);
1339 pin_eld->eld_size = eld->eld_size;
1340 pin_eld->info = eld->info;
1341 }
1342 mutex_unlock(&pin_eld->lock);
1343
1344 if (eld_changed)
1345 snd_ctl_notify(codec->bus->card,
1346 SNDRV_CTL_EVENT_MASK_VALUE | SNDRV_CTL_EVENT_MASK_INFO,
1347 &per_pin->eld_ctl->id);
1348 }
1349
1350 static void hdmi_repoll_eld(struct work_struct *work)
1351 {
1352 struct hdmi_spec_per_pin *per_pin =
1353 container_of(to_delayed_work(work), struct hdmi_spec_per_pin, work);
1354
1355 if (per_pin->repoll_count++ > 6)
1356 per_pin->repoll_count = 0;
1357
1358 hdmi_present_sense(per_pin, per_pin->repoll_count);
1359 }
1360
1361 static void intel_haswell_fixup_connect_list(struct hda_codec *codec,
1362 hda_nid_t nid);
1363
1364 static int hdmi_add_pin(struct hda_codec *codec, hda_nid_t pin_nid)
1365 {
1366 struct hdmi_spec *spec = codec->spec;
1367 unsigned int caps, config;
1368 int pin_idx;
1369 struct hdmi_spec_per_pin *per_pin;
1370 int err;
1371
1372 caps = snd_hda_query_pin_caps(codec, pin_nid);
1373 if (!(caps & (AC_PINCAP_HDMI | AC_PINCAP_DP)))
1374 return 0;
1375
1376 config = snd_hda_codec_get_pincfg(codec, pin_nid);
1377 if (get_defcfg_connect(config) == AC_JACK_PORT_NONE)
1378 return 0;
1379
1380 if (codec->vendor_id == 0x80862807)
1381 intel_haswell_fixup_connect_list(codec, pin_nid);
1382
1383 pin_idx = spec->num_pins;
1384 per_pin = snd_array_new(&spec->pins);
1385 if (!per_pin)
1386 return -ENOMEM;
1387
1388 per_pin->pin_nid = pin_nid;
1389 per_pin->non_pcm = false;
1390
1391 err = hdmi_read_pin_conn(codec, pin_idx);
1392 if (err < 0)
1393 return err;
1394
1395 spec->num_pins++;
1396
1397 return 0;
1398 }
1399
1400 static int hdmi_add_cvt(struct hda_codec *codec, hda_nid_t cvt_nid)
1401 {
1402 struct hdmi_spec *spec = codec->spec;
1403 struct hdmi_spec_per_cvt *per_cvt;
1404 unsigned int chans;
1405 int err;
1406
1407 chans = get_wcaps(codec, cvt_nid);
1408 chans = get_wcaps_channels(chans);
1409
1410 per_cvt = snd_array_new(&spec->cvts);
1411 if (!per_cvt)
1412 return -ENOMEM;
1413
1414 per_cvt->cvt_nid = cvt_nid;
1415 per_cvt->channels_min = 2;
1416 if (chans <= 16) {
1417 per_cvt->channels_max = chans;
1418 if (chans > spec->channels_max)
1419 spec->channels_max = chans;
1420 }
1421
1422 err = snd_hda_query_supported_pcm(codec, cvt_nid,
1423 &per_cvt->rates,
1424 &per_cvt->formats,
1425 &per_cvt->maxbps);
1426 if (err < 0)
1427 return err;
1428
1429 if (spec->num_cvts < ARRAY_SIZE(spec->cvt_nids))
1430 spec->cvt_nids[spec->num_cvts] = cvt_nid;
1431 spec->num_cvts++;
1432
1433 return 0;
1434 }
1435
1436 static int hdmi_parse_codec(struct hda_codec *codec)
1437 {
1438 hda_nid_t nid;
1439 int i, nodes;
1440
1441 nodes = snd_hda_get_sub_nodes(codec, codec->afg, &nid);
1442 if (!nid || nodes < 0) {
1443 snd_printk(KERN_WARNING "HDMI: failed to get afg sub nodes\n");
1444 return -EINVAL;
1445 }
1446
1447 for (i = 0; i < nodes; i++, nid++) {
1448 unsigned int caps;
1449 unsigned int type;
1450
1451 caps = get_wcaps(codec, nid);
1452 type = get_wcaps_type(caps);
1453
1454 if (!(caps & AC_WCAP_DIGITAL))
1455 continue;
1456
1457 switch (type) {
1458 case AC_WID_AUD_OUT:
1459 hdmi_add_cvt(codec, nid);
1460 break;
1461 case AC_WID_PIN:
1462 hdmi_add_pin(codec, nid);
1463 break;
1464 }
1465 }
1466
1467 #ifdef CONFIG_PM
1468 /* We're seeing some problems with unsolicited hot plug events on
1469 * PantherPoint after S3, if this is not enabled */
1470 if (codec->vendor_id == 0x80862806)
1471 codec->bus->power_keep_link_on = 1;
1472 /*
1473 * G45/IbexPeak don't support EPSS: the unsolicited pin hot plug event
1474 * can be lost and presence sense verb will become inaccurate if the
1475 * HDA link is powered off at hot plug or hw initialization time.
1476 */
1477 else if (!(snd_hda_param_read(codec, codec->afg, AC_PAR_POWER_STATE) &
1478 AC_PWRST_EPSS))
1479 codec->bus->power_keep_link_on = 1;
1480 #endif
1481
1482 return 0;
1483 }
1484
1485 /*
1486 */
1487 static bool check_non_pcm_per_cvt(struct hda_codec *codec, hda_nid_t cvt_nid)
1488 {
1489 struct hda_spdif_out *spdif;
1490 bool non_pcm;
1491
1492 mutex_lock(&codec->spdif_mutex);
1493 spdif = snd_hda_spdif_out_of_nid(codec, cvt_nid);
1494 non_pcm = !!(spdif->status & IEC958_AES0_NONAUDIO);
1495 mutex_unlock(&codec->spdif_mutex);
1496 return non_pcm;
1497 }
1498
1499
1500 /*
1501 * HDMI callbacks
1502 */
1503
1504 static int generic_hdmi_playback_pcm_prepare(struct hda_pcm_stream *hinfo,
1505 struct hda_codec *codec,
1506 unsigned int stream_tag,
1507 unsigned int format,
1508 struct snd_pcm_substream *substream)
1509 {
1510 hda_nid_t cvt_nid = hinfo->nid;
1511 struct hdmi_spec *spec = codec->spec;
1512 int pin_idx = hinfo_to_pin_index(spec, hinfo);
1513 hda_nid_t pin_nid = get_pin(spec, pin_idx)->pin_nid;
1514 bool non_pcm;
1515
1516 non_pcm = check_non_pcm_per_cvt(codec, cvt_nid);
1517
1518 hdmi_set_channel_count(codec, cvt_nid, substream->runtime->channels);
1519
1520 hdmi_setup_audio_infoframe(codec, pin_idx, non_pcm, substream);
1521
1522 return hdmi_setup_stream(codec, cvt_nid, pin_nid, stream_tag, format);
1523 }
1524
1525 static int generic_hdmi_playback_pcm_cleanup(struct hda_pcm_stream *hinfo,
1526 struct hda_codec *codec,
1527 struct snd_pcm_substream *substream)
1528 {
1529 snd_hda_codec_cleanup_stream(codec, hinfo->nid);
1530 return 0;
1531 }
1532
1533 static int hdmi_pcm_close(struct hda_pcm_stream *hinfo,
1534 struct hda_codec *codec,
1535 struct snd_pcm_substream *substream)
1536 {
1537 struct hdmi_spec *spec = codec->spec;
1538 int cvt_idx, pin_idx;
1539 struct hdmi_spec_per_cvt *per_cvt;
1540 struct hdmi_spec_per_pin *per_pin;
1541
1542 if (hinfo->nid) {
1543 cvt_idx = cvt_nid_to_cvt_index(spec, hinfo->nid);
1544 if (snd_BUG_ON(cvt_idx < 0))
1545 return -EINVAL;
1546 per_cvt = get_cvt(spec, cvt_idx);
1547
1548 snd_BUG_ON(!per_cvt->assigned);
1549 per_cvt->assigned = 0;
1550 hinfo->nid = 0;
1551
1552 pin_idx = hinfo_to_pin_index(spec, hinfo);
1553 if (snd_BUG_ON(pin_idx < 0))
1554 return -EINVAL;
1555 per_pin = get_pin(spec, pin_idx);
1556
1557 snd_hda_spdif_ctls_unassign(codec, pin_idx);
1558 per_pin->chmap_set = false;
1559 memset(per_pin->chmap, 0, sizeof(per_pin->chmap));
1560 }
1561
1562 return 0;
1563 }
1564
1565 static const struct hda_pcm_ops generic_ops = {
1566 .open = hdmi_pcm_open,
1567 .close = hdmi_pcm_close,
1568 .prepare = generic_hdmi_playback_pcm_prepare,
1569 .cleanup = generic_hdmi_playback_pcm_cleanup,
1570 };
1571
1572 /*
1573 * ALSA API channel-map control callbacks
1574 */
1575 static int hdmi_chmap_ctl_info(struct snd_kcontrol *kcontrol,
1576 struct snd_ctl_elem_info *uinfo)
1577 {
1578 struct snd_pcm_chmap *info = snd_kcontrol_chip(kcontrol);
1579 struct hda_codec *codec = info->private_data;
1580 struct hdmi_spec *spec = codec->spec;
1581 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
1582 uinfo->count = spec->channels_max;
1583 uinfo->value.integer.min = 0;
1584 uinfo->value.integer.max = SNDRV_CHMAP_LAST;
1585 return 0;
1586 }
1587
1588 static int hdmi_chmap_ctl_tlv(struct snd_kcontrol *kcontrol, int op_flag,
1589 unsigned int size, unsigned int __user *tlv)
1590 {
1591 struct snd_pcm_chmap *info = snd_kcontrol_chip(kcontrol);
1592 struct hda_codec *codec = info->private_data;
1593 struct hdmi_spec *spec = codec->spec;
1594 const unsigned int valid_mask =
1595 FL | FR | RL | RR | LFE | FC | RLC | RRC;
1596 unsigned int __user *dst;
1597 int chs, count = 0;
1598
1599 if (size < 8)
1600 return -ENOMEM;
1601 if (put_user(SNDRV_CTL_TLVT_CONTAINER, tlv))
1602 return -EFAULT;
1603 size -= 8;
1604 dst = tlv + 2;
1605 for (chs = 2; chs <= spec->channels_max; chs++) {
1606 int i, c;
1607 struct cea_channel_speaker_allocation *cap;
1608 cap = channel_allocations;
1609 for (i = 0; i < ARRAY_SIZE(channel_allocations); i++, cap++) {
1610 int chs_bytes = chs * 4;
1611 if (cap->channels != chs)
1612 continue;
1613 if (cap->spk_mask & ~valid_mask)
1614 continue;
1615 if (size < 8)
1616 return -ENOMEM;
1617 if (put_user(SNDRV_CTL_TLVT_CHMAP_VAR, dst) ||
1618 put_user(chs_bytes, dst + 1))
1619 return -EFAULT;
1620 dst += 2;
1621 size -= 8;
1622 count += 8;
1623 if (size < chs_bytes)
1624 return -ENOMEM;
1625 size -= chs_bytes;
1626 count += chs_bytes;
1627 for (c = 7; c >= 0; c--) {
1628 int spk = cap->speakers[c];
1629 if (!spk)
1630 continue;
1631 if (put_user(spk_to_chmap(spk), dst))
1632 return -EFAULT;
1633 dst++;
1634 }
1635 }
1636 }
1637 if (put_user(count, tlv + 1))
1638 return -EFAULT;
1639 return 0;
1640 }
1641
1642 static int hdmi_chmap_ctl_get(struct snd_kcontrol *kcontrol,
1643 struct snd_ctl_elem_value *ucontrol)
1644 {
1645 struct snd_pcm_chmap *info = snd_kcontrol_chip(kcontrol);
1646 struct hda_codec *codec = info->private_data;
1647 struct hdmi_spec *spec = codec->spec;
1648 int pin_idx = kcontrol->private_value;
1649 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
1650 int i;
1651
1652 for (i = 0; i < ARRAY_SIZE(per_pin->chmap); i++)
1653 ucontrol->value.integer.value[i] = per_pin->chmap[i];
1654 return 0;
1655 }
1656
1657 static int hdmi_chmap_ctl_put(struct snd_kcontrol *kcontrol,
1658 struct snd_ctl_elem_value *ucontrol)
1659 {
1660 struct snd_pcm_chmap *info = snd_kcontrol_chip(kcontrol);
1661 struct hda_codec *codec = info->private_data;
1662 struct hdmi_spec *spec = codec->spec;
1663 int pin_idx = kcontrol->private_value;
1664 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
1665 unsigned int ctl_idx;
1666 struct snd_pcm_substream *substream;
1667 unsigned char chmap[8];
1668 int i, ca, prepared = 0;
1669
1670 ctl_idx = snd_ctl_get_ioffidx(kcontrol, &ucontrol->id);
1671 substream = snd_pcm_chmap_substream(info, ctl_idx);
1672 if (!substream || !substream->runtime)
1673 return 0; /* just for avoiding error from alsactl restore */
1674 switch (substream->runtime->status->state) {
1675 case SNDRV_PCM_STATE_OPEN:
1676 case SNDRV_PCM_STATE_SETUP:
1677 break;
1678 case SNDRV_PCM_STATE_PREPARED:
1679 prepared = 1;
1680 break;
1681 default:
1682 return -EBUSY;
1683 }
1684 memset(chmap, 0, sizeof(chmap));
1685 for (i = 0; i < ARRAY_SIZE(chmap); i++)
1686 chmap[i] = ucontrol->value.integer.value[i];
1687 if (!memcmp(chmap, per_pin->chmap, sizeof(chmap)))
1688 return 0;
1689 ca = hdmi_manual_channel_allocation(ARRAY_SIZE(chmap), chmap);
1690 if (ca < 0)
1691 return -EINVAL;
1692 per_pin->chmap_set = true;
1693 memcpy(per_pin->chmap, chmap, sizeof(chmap));
1694 if (prepared)
1695 hdmi_setup_audio_infoframe(codec, pin_idx, per_pin->non_pcm,
1696 substream);
1697
1698 return 0;
1699 }
1700
1701 static int generic_hdmi_build_pcms(struct hda_codec *codec)
1702 {
1703 struct hdmi_spec *spec = codec->spec;
1704 int pin_idx;
1705
1706 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
1707 struct hda_pcm *info;
1708 struct hda_pcm_stream *pstr;
1709 struct hdmi_spec_per_pin *per_pin;
1710
1711 per_pin = get_pin(spec, pin_idx);
1712 sprintf(per_pin->pcm_name, "HDMI %d", pin_idx);
1713 info = snd_array_new(&spec->pcm_rec);
1714 if (!info)
1715 return -ENOMEM;
1716 info->name = per_pin->pcm_name;
1717 info->pcm_type = HDA_PCM_TYPE_HDMI;
1718 info->own_chmap = true;
1719
1720 pstr = &info->stream[SNDRV_PCM_STREAM_PLAYBACK];
1721 pstr->substreams = 1;
1722 pstr->ops = generic_ops;
1723 /* other pstr fields are set in open */
1724 }
1725
1726 codec->num_pcms = spec->num_pins;
1727 codec->pcm_info = spec->pcm_rec.list;
1728
1729 return 0;
1730 }
1731
1732 static int generic_hdmi_build_jack(struct hda_codec *codec, int pin_idx)
1733 {
1734 char hdmi_str[32] = "HDMI/DP";
1735 struct hdmi_spec *spec = codec->spec;
1736 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
1737 int pcmdev = get_pcm_rec(spec, pin_idx)->device;
1738
1739 if (pcmdev > 0)
1740 sprintf(hdmi_str + strlen(hdmi_str), ",pcm=%d", pcmdev);
1741 if (!is_jack_detectable(codec, per_pin->pin_nid))
1742 strncat(hdmi_str, " Phantom",
1743 sizeof(hdmi_str) - strlen(hdmi_str) - 1);
1744
1745 return snd_hda_jack_add_kctl(codec, per_pin->pin_nid, hdmi_str, 0);
1746 }
1747
1748 static int generic_hdmi_build_controls(struct hda_codec *codec)
1749 {
1750 struct hdmi_spec *spec = codec->spec;
1751 int err;
1752 int pin_idx;
1753
1754 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
1755 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
1756
1757 err = generic_hdmi_build_jack(codec, pin_idx);
1758 if (err < 0)
1759 return err;
1760
1761 err = snd_hda_create_dig_out_ctls(codec,
1762 per_pin->pin_nid,
1763 per_pin->mux_nids[0],
1764 HDA_PCM_TYPE_HDMI);
1765 if (err < 0)
1766 return err;
1767 snd_hda_spdif_ctls_unassign(codec, pin_idx);
1768
1769 /* add control for ELD Bytes */
1770 err = hdmi_create_eld_ctl(codec, pin_idx,
1771 get_pcm_rec(spec, pin_idx)->device);
1772
1773 if (err < 0)
1774 return err;
1775
1776 hdmi_present_sense(per_pin, 0);
1777 }
1778
1779 /* add channel maps */
1780 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
1781 struct snd_pcm_chmap *chmap;
1782 struct snd_kcontrol *kctl;
1783 int i;
1784 err = snd_pcm_add_chmap_ctls(codec->pcm_info[pin_idx].pcm,
1785 SNDRV_PCM_STREAM_PLAYBACK,
1786 NULL, 0, pin_idx, &chmap);
1787 if (err < 0)
1788 return err;
1789 /* override handlers */
1790 chmap->private_data = codec;
1791 kctl = chmap->kctl;
1792 for (i = 0; i < kctl->count; i++)
1793 kctl->vd[i].access |= SNDRV_CTL_ELEM_ACCESS_WRITE;
1794 kctl->info = hdmi_chmap_ctl_info;
1795 kctl->get = hdmi_chmap_ctl_get;
1796 kctl->put = hdmi_chmap_ctl_put;
1797 kctl->tlv.c = hdmi_chmap_ctl_tlv;
1798 }
1799
1800 return 0;
1801 }
1802
1803 static int generic_hdmi_init_per_pins(struct hda_codec *codec)
1804 {
1805 struct hdmi_spec *spec = codec->spec;
1806 int pin_idx;
1807
1808 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
1809 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
1810 struct hdmi_eld *eld = &per_pin->sink_eld;
1811
1812 per_pin->codec = codec;
1813 mutex_init(&eld->lock);
1814 INIT_DELAYED_WORK(&per_pin->work, hdmi_repoll_eld);
1815 snd_hda_eld_proc_new(codec, eld, pin_idx);
1816 }
1817 return 0;
1818 }
1819
1820 static int generic_hdmi_init(struct hda_codec *codec)
1821 {
1822 struct hdmi_spec *spec = codec->spec;
1823 int pin_idx;
1824
1825 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
1826 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
1827 hda_nid_t pin_nid = per_pin->pin_nid;
1828
1829 hdmi_init_pin(codec, pin_nid);
1830 snd_hda_jack_detect_enable(codec, pin_nid, pin_nid);
1831 }
1832 return 0;
1833 }
1834
1835 static void hdmi_array_init(struct hdmi_spec *spec, int nums)
1836 {
1837 snd_array_init(&spec->pins, sizeof(struct hdmi_spec_per_pin), nums);
1838 snd_array_init(&spec->cvts, sizeof(struct hdmi_spec_per_cvt), nums);
1839 snd_array_init(&spec->pcm_rec, sizeof(struct hda_pcm), nums);
1840 }
1841
1842 static void hdmi_array_free(struct hdmi_spec *spec)
1843 {
1844 snd_array_free(&spec->pins);
1845 snd_array_free(&spec->cvts);
1846 snd_array_free(&spec->pcm_rec);
1847 }
1848
1849 static void generic_hdmi_free(struct hda_codec *codec)
1850 {
1851 struct hdmi_spec *spec = codec->spec;
1852 int pin_idx;
1853
1854 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
1855 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
1856 struct hdmi_eld *eld = &per_pin->sink_eld;
1857
1858 cancel_delayed_work(&per_pin->work);
1859 snd_hda_eld_proc_free(codec, eld);
1860 }
1861
1862 flush_workqueue(codec->bus->workq);
1863 hdmi_array_free(spec);
1864 kfree(spec);
1865 }
1866
1867 #ifdef CONFIG_PM
1868 static int generic_hdmi_resume(struct hda_codec *codec)
1869 {
1870 struct hdmi_spec *spec = codec->spec;
1871 int pin_idx;
1872
1873 generic_hdmi_init(codec);
1874 snd_hda_codec_resume_amp(codec);
1875 snd_hda_codec_resume_cache(codec);
1876
1877 for (pin_idx = 0; pin_idx < spec->num_pins; pin_idx++) {
1878 struct hdmi_spec_per_pin *per_pin = get_pin(spec, pin_idx);
1879 hdmi_present_sense(per_pin, 1);
1880 }
1881 return 0;
1882 }
1883 #endif
1884
1885 static const struct hda_codec_ops generic_hdmi_patch_ops = {
1886 .init = generic_hdmi_init,
1887 .free = generic_hdmi_free,
1888 .build_pcms = generic_hdmi_build_pcms,
1889 .build_controls = generic_hdmi_build_controls,
1890 .unsol_event = hdmi_unsol_event,
1891 #ifdef CONFIG_PM
1892 .resume = generic_hdmi_resume,
1893 #endif
1894 };
1895
1896
1897 static void intel_haswell_fixup_connect_list(struct hda_codec *codec,
1898 hda_nid_t nid)
1899 {
1900 struct hdmi_spec *spec = codec->spec;
1901 hda_nid_t conns[4];
1902 int nconns;
1903
1904 nconns = snd_hda_get_connections(codec, nid, conns, ARRAY_SIZE(conns));
1905 if (nconns == spec->num_cvts &&
1906 !memcmp(conns, spec->cvt_nids, spec->num_cvts * sizeof(hda_nid_t)))
1907 return;
1908
1909 /* override pins connection list */
1910 snd_printdd("hdmi: haswell: override pin connection 0x%x\n", nid);
1911 snd_hda_override_conn_list(codec, nid, spec->num_cvts, spec->cvt_nids);
1912 }
1913
1914 #define INTEL_VENDOR_NID 0x08
1915 #define INTEL_GET_VENDOR_VERB 0xf81
1916 #define INTEL_SET_VENDOR_VERB 0x781
1917 #define INTEL_EN_DP12 0x02 /* enable DP 1.2 features */
1918 #define INTEL_EN_ALL_PIN_CVTS 0x01 /* enable 2nd & 3rd pins and convertors */
1919
1920 static void intel_haswell_enable_all_pins(struct hda_codec *codec,
1921 bool update_tree)
1922 {
1923 unsigned int vendor_param;
1924
1925 vendor_param = snd_hda_codec_read(codec, INTEL_VENDOR_NID, 0,
1926 INTEL_GET_VENDOR_VERB, 0);
1927 if (vendor_param == -1 || vendor_param & INTEL_EN_ALL_PIN_CVTS)
1928 return;
1929
1930 vendor_param |= INTEL_EN_ALL_PIN_CVTS;
1931 vendor_param = snd_hda_codec_read(codec, INTEL_VENDOR_NID, 0,
1932 INTEL_SET_VENDOR_VERB, vendor_param);
1933 if (vendor_param == -1)
1934 return;
1935
1936 if (update_tree)
1937 snd_hda_codec_update_widgets(codec);
1938 }
1939
1940 static void intel_haswell_fixup_enable_dp12(struct hda_codec *codec)
1941 {
1942 unsigned int vendor_param;
1943
1944 vendor_param = snd_hda_codec_read(codec, INTEL_VENDOR_NID, 0,
1945 INTEL_GET_VENDOR_VERB, 0);
1946 if (vendor_param == -1 || vendor_param & INTEL_EN_DP12)
1947 return;
1948
1949 /* enable DP1.2 mode */
1950 vendor_param |= INTEL_EN_DP12;
1951 snd_hda_codec_write_cache(codec, INTEL_VENDOR_NID, 0,
1952 INTEL_SET_VENDOR_VERB, vendor_param);
1953 }
1954
1955 /* Haswell needs to re-issue the vendor-specific verbs before turning to D0.
1956 * Otherwise you may get severe h/w communication errors.
1957 */
1958 static void haswell_set_power_state(struct hda_codec *codec, hda_nid_t fg,
1959 unsigned int power_state)
1960 {
1961 if (power_state == AC_PWRST_D0) {
1962 intel_haswell_enable_all_pins(codec, false);
1963 intel_haswell_fixup_enable_dp12(codec);
1964 }
1965
1966 snd_hda_codec_read(codec, fg, 0, AC_VERB_SET_POWER_STATE, power_state);
1967 snd_hda_codec_set_power_to_all(codec, fg, power_state);
1968 }
1969
1970 static int patch_generic_hdmi(struct hda_codec *codec)
1971 {
1972 struct hdmi_spec *spec;
1973
1974 spec = kzalloc(sizeof(*spec), GFP_KERNEL);
1975 if (spec == NULL)
1976 return -ENOMEM;
1977
1978 codec->spec = spec;
1979 hdmi_array_init(spec, 4);
1980
1981 if (codec->vendor_id == 0x80862807) {
1982 intel_haswell_enable_all_pins(codec, true);
1983 intel_haswell_fixup_enable_dp12(codec);
1984 }
1985
1986 if (hdmi_parse_codec(codec) < 0) {
1987 codec->spec = NULL;
1988 kfree(spec);
1989 return -EINVAL;
1990 }
1991 codec->patch_ops = generic_hdmi_patch_ops;
1992 if (codec->vendor_id == 0x80862807)
1993 codec->patch_ops.set_power_state = haswell_set_power_state;
1994
1995 generic_hdmi_init_per_pins(codec);
1996
1997 init_channel_allocations();
1998
1999 return 0;
2000 }
2001
2002 /*
2003 * Shared non-generic implementations
2004 */
2005
2006 static int simple_playback_build_pcms(struct hda_codec *codec)
2007 {
2008 struct hdmi_spec *spec = codec->spec;
2009 struct hda_pcm *info;
2010 unsigned int chans;
2011 struct hda_pcm_stream *pstr;
2012 struct hdmi_spec_per_cvt *per_cvt;
2013
2014 per_cvt = get_cvt(spec, 0);
2015 chans = get_wcaps(codec, per_cvt->cvt_nid);
2016 chans = get_wcaps_channels(chans);
2017
2018 info = snd_array_new(&spec->pcm_rec);
2019 if (!info)
2020 return -ENOMEM;
2021 info->name = get_pin(spec, 0)->pcm_name;
2022 sprintf(info->name, "HDMI 0");
2023 info->pcm_type = HDA_PCM_TYPE_HDMI;
2024 pstr = &info->stream[SNDRV_PCM_STREAM_PLAYBACK];
2025 *pstr = spec->pcm_playback;
2026 pstr->nid = per_cvt->cvt_nid;
2027 if (pstr->channels_max <= 2 && chans && chans <= 16)
2028 pstr->channels_max = chans;
2029
2030 codec->num_pcms = 1;
2031 codec->pcm_info = info;
2032
2033 return 0;
2034 }
2035
2036 /* unsolicited event for jack sensing */
2037 static void simple_hdmi_unsol_event(struct hda_codec *codec,
2038 unsigned int res)
2039 {
2040 snd_hda_jack_set_dirty_all(codec);
2041 snd_hda_jack_report_sync(codec);
2042 }
2043
2044 /* generic_hdmi_build_jack can be used for simple_hdmi, too,
2045 * as long as spec->pins[] is set correctly
2046 */
2047 #define simple_hdmi_build_jack generic_hdmi_build_jack
2048
2049 static int simple_playback_build_controls(struct hda_codec *codec)
2050 {
2051 struct hdmi_spec *spec = codec->spec;
2052 struct hdmi_spec_per_cvt *per_cvt;
2053 int err;
2054
2055 per_cvt = get_cvt(spec, 0);
2056 err = snd_hda_create_spdif_out_ctls(codec, per_cvt->cvt_nid,
2057 per_cvt->cvt_nid);
2058 if (err < 0)
2059 return err;
2060 return simple_hdmi_build_jack(codec, 0);
2061 }
2062
2063 static int simple_playback_init(struct hda_codec *codec)
2064 {
2065 struct hdmi_spec *spec = codec->spec;
2066 struct hdmi_spec_per_pin *per_pin = get_pin(spec, 0);
2067 hda_nid_t pin = per_pin->pin_nid;
2068
2069 snd_hda_codec_write(codec, pin, 0,
2070 AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT);
2071 /* some codecs require to unmute the pin */
2072 if (get_wcaps(codec, pin) & AC_WCAP_OUT_AMP)
2073 snd_hda_codec_write(codec, pin, 0, AC_VERB_SET_AMP_GAIN_MUTE,
2074 AMP_OUT_UNMUTE);
2075 snd_hda_jack_detect_enable(codec, pin, pin);
2076 return 0;
2077 }
2078
2079 static void simple_playback_free(struct hda_codec *codec)
2080 {
2081 struct hdmi_spec *spec = codec->spec;
2082
2083 hdmi_array_free(spec);
2084 kfree(spec);
2085 }
2086
2087 /*
2088 * Nvidia specific implementations
2089 */
2090
2091 #define Nv_VERB_SET_Channel_Allocation 0xF79
2092 #define Nv_VERB_SET_Info_Frame_Checksum 0xF7A
2093 #define Nv_VERB_SET_Audio_Protection_On 0xF98
2094 #define Nv_VERB_SET_Audio_Protection_Off 0xF99
2095
2096 #define nvhdmi_master_con_nid_7x 0x04
2097 #define nvhdmi_master_pin_nid_7x 0x05
2098
2099 static const hda_nid_t nvhdmi_con_nids_7x[4] = {
2100 /*front, rear, clfe, rear_surr */
2101 0x6, 0x8, 0xa, 0xc,
2102 };
2103
2104 static const struct hda_verb nvhdmi_basic_init_7x_2ch[] = {
2105 /* set audio protect on */
2106 { 0x1, Nv_VERB_SET_Audio_Protection_On, 0x1},
2107 /* enable digital output on pin widget */
2108 { 0x5, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
2109 {} /* terminator */
2110 };
2111
2112 static const struct hda_verb nvhdmi_basic_init_7x_8ch[] = {
2113 /* set audio protect on */
2114 { 0x1, Nv_VERB_SET_Audio_Protection_On, 0x1},
2115 /* enable digital output on pin widget */
2116 { 0x5, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
2117 { 0x7, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
2118 { 0x9, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
2119 { 0xb, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
2120 { 0xd, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 },
2121 {} /* terminator */
2122 };
2123
2124 #ifdef LIMITED_RATE_FMT_SUPPORT
2125 /* support only the safe format and rate */
2126 #define SUPPORTED_RATES SNDRV_PCM_RATE_48000
2127 #define SUPPORTED_MAXBPS 16
2128 #define SUPPORTED_FORMATS SNDRV_PCM_FMTBIT_S16_LE
2129 #else
2130 /* support all rates and formats */
2131 #define SUPPORTED_RATES \
2132 (SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |\
2133 SNDRV_PCM_RATE_88200 | SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |\
2134 SNDRV_PCM_RATE_192000)
2135 #define SUPPORTED_MAXBPS 24
2136 #define SUPPORTED_FORMATS \
2137 (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S32_LE)
2138 #endif
2139
2140 static int nvhdmi_7x_init_2ch(struct hda_codec *codec)
2141 {
2142 snd_hda_sequence_write(codec, nvhdmi_basic_init_7x_2ch);
2143 return 0;
2144 }
2145
2146 static int nvhdmi_7x_init_8ch(struct hda_codec *codec)
2147 {
2148 snd_hda_sequence_write(codec, nvhdmi_basic_init_7x_8ch);
2149 return 0;
2150 }
2151
2152 static unsigned int channels_2_6_8[] = {
2153 2, 6, 8
2154 };
2155
2156 static unsigned int channels_2_8[] = {
2157 2, 8
2158 };
2159
2160 static struct snd_pcm_hw_constraint_list hw_constraints_2_6_8_channels = {
2161 .count = ARRAY_SIZE(channels_2_6_8),
2162 .list = channels_2_6_8,
2163 .mask = 0,
2164 };
2165
2166 static struct snd_pcm_hw_constraint_list hw_constraints_2_8_channels = {
2167 .count = ARRAY_SIZE(channels_2_8),
2168 .list = channels_2_8,
2169 .mask = 0,
2170 };
2171
2172 static int simple_playback_pcm_open(struct hda_pcm_stream *hinfo,
2173 struct hda_codec *codec,
2174 struct snd_pcm_substream *substream)
2175 {
2176 struct hdmi_spec *spec = codec->spec;
2177 struct snd_pcm_hw_constraint_list *hw_constraints_channels = NULL;
2178
2179 switch (codec->preset->id) {
2180 case 0x10de0002:
2181 case 0x10de0003:
2182 case 0x10de0005:
2183 case 0x10de0006:
2184 hw_constraints_channels = &hw_constraints_2_8_channels;
2185 break;
2186 case 0x10de0007:
2187 hw_constraints_channels = &hw_constraints_2_6_8_channels;
2188 break;
2189 default:
2190 break;
2191 }
2192
2193 if (hw_constraints_channels != NULL) {
2194 snd_pcm_hw_constraint_list(substream->runtime, 0,
2195 SNDRV_PCM_HW_PARAM_CHANNELS,
2196 hw_constraints_channels);
2197 } else {
2198 snd_pcm_hw_constraint_step(substream->runtime, 0,
2199 SNDRV_PCM_HW_PARAM_CHANNELS, 2);
2200 }
2201
2202 return snd_hda_multi_out_dig_open(codec, &spec->multiout);
2203 }
2204
2205 static int simple_playback_pcm_close(struct hda_pcm_stream *hinfo,
2206 struct hda_codec *codec,
2207 struct snd_pcm_substream *substream)
2208 {
2209 struct hdmi_spec *spec = codec->spec;
2210 return snd_hda_multi_out_dig_close(codec, &spec->multiout);
2211 }
2212
2213 static int simple_playback_pcm_prepare(struct hda_pcm_stream *hinfo,
2214 struct hda_codec *codec,
2215 unsigned int stream_tag,
2216 unsigned int format,
2217 struct snd_pcm_substream *substream)
2218 {
2219 struct hdmi_spec *spec = codec->spec;
2220 return snd_hda_multi_out_dig_prepare(codec, &spec->multiout,
2221 stream_tag, format, substream);
2222 }
2223
2224 static const struct hda_pcm_stream simple_pcm_playback = {
2225 .substreams = 1,
2226 .channels_min = 2,
2227 .channels_max = 2,
2228 .ops = {
2229 .open = simple_playback_pcm_open,
2230 .close = simple_playback_pcm_close,
2231 .prepare = simple_playback_pcm_prepare
2232 },
2233 };
2234
2235 static const struct hda_codec_ops simple_hdmi_patch_ops = {
2236 .build_controls = simple_playback_build_controls,
2237 .build_pcms = simple_playback_build_pcms,
2238 .init = simple_playback_init,
2239 .free = simple_playback_free,
2240 .unsol_event = simple_hdmi_unsol_event,
2241 };
2242
2243 static int patch_simple_hdmi(struct hda_codec *codec,
2244 hda_nid_t cvt_nid, hda_nid_t pin_nid)
2245 {
2246 struct hdmi_spec *spec;
2247 struct hdmi_spec_per_cvt *per_cvt;
2248 struct hdmi_spec_per_pin *per_pin;
2249
2250 spec = kzalloc(sizeof(*spec), GFP_KERNEL);
2251 if (!spec)
2252 return -ENOMEM;
2253
2254 codec->spec = spec;
2255 hdmi_array_init(spec, 1);
2256
2257 spec->multiout.num_dacs = 0; /* no analog */
2258 spec->multiout.max_channels = 2;
2259 spec->multiout.dig_out_nid = cvt_nid;
2260 spec->num_cvts = 1;
2261 spec->num_pins = 1;
2262 per_pin = snd_array_new(&spec->pins);
2263 per_cvt = snd_array_new(&spec->cvts);
2264 if (!per_pin || !per_cvt) {
2265 simple_playback_free(codec);
2266 return -ENOMEM;
2267 }
2268 per_cvt->cvt_nid = cvt_nid;
2269 per_pin->pin_nid = pin_nid;
2270 spec->pcm_playback = simple_pcm_playback;
2271
2272 codec->patch_ops = simple_hdmi_patch_ops;
2273
2274 return 0;
2275 }
2276
2277 static void nvhdmi_8ch_7x_set_info_frame_parameters(struct hda_codec *codec,
2278 int channels)
2279 {
2280 unsigned int chanmask;
2281 int chan = channels ? (channels - 1) : 1;
2282
2283 switch (channels) {
2284 default:
2285 case 0:
2286 case 2:
2287 chanmask = 0x00;
2288 break;
2289 case 4:
2290 chanmask = 0x08;
2291 break;
2292 case 6:
2293 chanmask = 0x0b;
2294 break;
2295 case 8:
2296 chanmask = 0x13;
2297 break;
2298 }
2299
2300 /* Set the audio infoframe channel allocation and checksum fields. The
2301 * channel count is computed implicitly by the hardware. */
2302 snd_hda_codec_write(codec, 0x1, 0,
2303 Nv_VERB_SET_Channel_Allocation, chanmask);
2304
2305 snd_hda_codec_write(codec, 0x1, 0,
2306 Nv_VERB_SET_Info_Frame_Checksum,
2307 (0x71 - chan - chanmask));
2308 }
2309
2310 static int nvhdmi_8ch_7x_pcm_close(struct hda_pcm_stream *hinfo,
2311 struct hda_codec *codec,
2312 struct snd_pcm_substream *substream)
2313 {
2314 struct hdmi_spec *spec = codec->spec;
2315 int i;
2316
2317 snd_hda_codec_write(codec, nvhdmi_master_con_nid_7x,
2318 0, AC_VERB_SET_CHANNEL_STREAMID, 0);
2319 for (i = 0; i < 4; i++) {
2320 /* set the stream id */
2321 snd_hda_codec_write(codec, nvhdmi_con_nids_7x[i], 0,
2322 AC_VERB_SET_CHANNEL_STREAMID, 0);
2323 /* set the stream format */
2324 snd_hda_codec_write(codec, nvhdmi_con_nids_7x[i], 0,
2325 AC_VERB_SET_STREAM_FORMAT, 0);
2326 }
2327
2328 /* The audio hardware sends a channel count of 0x7 (8ch) when all the
2329 * streams are disabled. */
2330 nvhdmi_8ch_7x_set_info_frame_parameters(codec, 8);
2331
2332 return snd_hda_multi_out_dig_close(codec, &spec->multiout);
2333 }
2334
2335 static int nvhdmi_8ch_7x_pcm_prepare(struct hda_pcm_stream *hinfo,
2336 struct hda_codec *codec,
2337 unsigned int stream_tag,
2338 unsigned int format,
2339 struct snd_pcm_substream *substream)
2340 {
2341 int chs;
2342 unsigned int dataDCC2, channel_id;
2343 int i;
2344 struct hdmi_spec *spec = codec->spec;
2345 struct hda_spdif_out *spdif;
2346 struct hdmi_spec_per_cvt *per_cvt;
2347
2348 mutex_lock(&codec->spdif_mutex);
2349 per_cvt = get_cvt(spec, 0);
2350 spdif = snd_hda_spdif_out_of_nid(codec, per_cvt->cvt_nid);
2351
2352 chs = substream->runtime->channels;
2353
2354 dataDCC2 = 0x2;
2355
2356 /* turn off SPDIF once; otherwise the IEC958 bits won't be updated */
2357 if (codec->spdif_status_reset && (spdif->ctls & AC_DIG1_ENABLE))
2358 snd_hda_codec_write(codec,
2359 nvhdmi_master_con_nid_7x,
2360 0,
2361 AC_VERB_SET_DIGI_CONVERT_1,
2362 spdif->ctls & ~AC_DIG1_ENABLE & 0xff);
2363
2364 /* set the stream id */
2365 snd_hda_codec_write(codec, nvhdmi_master_con_nid_7x, 0,
2366 AC_VERB_SET_CHANNEL_STREAMID, (stream_tag << 4) | 0x0);
2367
2368 /* set the stream format */
2369 snd_hda_codec_write(codec, nvhdmi_master_con_nid_7x, 0,
2370 AC_VERB_SET_STREAM_FORMAT, format);
2371
2372 /* turn on again (if needed) */
2373 /* enable and set the channel status audio/data flag */
2374 if (codec->spdif_status_reset && (spdif->ctls & AC_DIG1_ENABLE)) {
2375 snd_hda_codec_write(codec,
2376 nvhdmi_master_con_nid_7x,
2377 0,
2378 AC_VERB_SET_DIGI_CONVERT_1,
2379 spdif->ctls & 0xff);
2380 snd_hda_codec_write(codec,
2381 nvhdmi_master_con_nid_7x,
2382 0,
2383 AC_VERB_SET_DIGI_CONVERT_2, dataDCC2);
2384 }
2385
2386 for (i = 0; i < 4; i++) {
2387 if (chs == 2)
2388 channel_id = 0;
2389 else
2390 channel_id = i * 2;
2391
2392 /* turn off SPDIF once;
2393 *otherwise the IEC958 bits won't be updated
2394 */
2395 if (codec->spdif_status_reset &&
2396 (spdif->ctls & AC_DIG1_ENABLE))
2397 snd_hda_codec_write(codec,
2398 nvhdmi_con_nids_7x[i],
2399 0,
2400 AC_VERB_SET_DIGI_CONVERT_1,
2401 spdif->ctls & ~AC_DIG1_ENABLE & 0xff);
2402 /* set the stream id */
2403 snd_hda_codec_write(codec,
2404 nvhdmi_con_nids_7x[i],
2405 0,
2406 AC_VERB_SET_CHANNEL_STREAMID,
2407 (stream_tag << 4) | channel_id);
2408 /* set the stream format */
2409 snd_hda_codec_write(codec,
2410 nvhdmi_con_nids_7x[i],
2411 0,
2412 AC_VERB_SET_STREAM_FORMAT,
2413 format);
2414 /* turn on again (if needed) */
2415 /* enable and set the channel status audio/data flag */
2416 if (codec->spdif_status_reset &&
2417 (spdif->ctls & AC_DIG1_ENABLE)) {
2418 snd_hda_codec_write(codec,
2419 nvhdmi_con_nids_7x[i],
2420 0,
2421 AC_VERB_SET_DIGI_CONVERT_1,
2422 spdif->ctls & 0xff);
2423 snd_hda_codec_write(codec,
2424 nvhdmi_con_nids_7x[i],
2425 0,
2426 AC_VERB_SET_DIGI_CONVERT_2, dataDCC2);
2427 }
2428 }
2429
2430 nvhdmi_8ch_7x_set_info_frame_parameters(codec, chs);
2431
2432 mutex_unlock(&codec->spdif_mutex);
2433 return 0;
2434 }
2435
2436 static const struct hda_pcm_stream nvhdmi_pcm_playback_8ch_7x = {
2437 .substreams = 1,
2438 .channels_min = 2,
2439 .channels_max = 8,
2440 .nid = nvhdmi_master_con_nid_7x,
2441 .rates = SUPPORTED_RATES,
2442 .maxbps = SUPPORTED_MAXBPS,
2443 .formats = SUPPORTED_FORMATS,
2444 .ops = {
2445 .open = simple_playback_pcm_open,
2446 .close = nvhdmi_8ch_7x_pcm_close,
2447 .prepare = nvhdmi_8ch_7x_pcm_prepare
2448 },
2449 };
2450
2451 static int patch_nvhdmi_2ch(struct hda_codec *codec)
2452 {
2453 struct hdmi_spec *spec;
2454 int err = patch_simple_hdmi(codec, nvhdmi_master_con_nid_7x,
2455 nvhdmi_master_pin_nid_7x);
2456 if (err < 0)
2457 return err;
2458
2459 codec->patch_ops.init = nvhdmi_7x_init_2ch;
2460 /* override the PCM rates, etc, as the codec doesn't give full list */
2461 spec = codec->spec;
2462 spec->pcm_playback.rates = SUPPORTED_RATES;
2463 spec->pcm_playback.maxbps = SUPPORTED_MAXBPS;
2464 spec->pcm_playback.formats = SUPPORTED_FORMATS;
2465 return 0;
2466 }
2467
2468 static int nvhdmi_7x_8ch_build_pcms(struct hda_codec *codec)
2469 {
2470 struct hdmi_spec *spec = codec->spec;
2471 int err = simple_playback_build_pcms(codec);
2472 if (!err) {
2473 struct hda_pcm *info = get_pcm_rec(spec, 0);
2474 info->own_chmap = true;
2475 }
2476 return err;
2477 }
2478
2479 static int nvhdmi_7x_8ch_build_controls(struct hda_codec *codec)
2480 {
2481 struct hdmi_spec *spec = codec->spec;
2482 struct hda_pcm *info;
2483 struct snd_pcm_chmap *chmap;
2484 int err;
2485
2486 err = simple_playback_build_controls(codec);
2487 if (err < 0)
2488 return err;
2489
2490 /* add channel maps */
2491 info = get_pcm_rec(spec, 0);
2492 err = snd_pcm_add_chmap_ctls(info->pcm,
2493 SNDRV_PCM_STREAM_PLAYBACK,
2494 snd_pcm_alt_chmaps, 8, 0, &chmap);
2495 if (err < 0)
2496 return err;
2497 switch (codec->preset->id) {
2498 case 0x10de0002:
2499 case 0x10de0003:
2500 case 0x10de0005:
2501 case 0x10de0006:
2502 chmap->channel_mask = (1U << 2) | (1U << 8);
2503 break;
2504 case 0x10de0007:
2505 chmap->channel_mask = (1U << 2) | (1U << 6) | (1U << 8);
2506 }
2507 return 0;
2508 }
2509
2510 static int patch_nvhdmi_8ch_7x(struct hda_codec *codec)
2511 {
2512 struct hdmi_spec *spec;
2513 int err = patch_nvhdmi_2ch(codec);
2514 if (err < 0)
2515 return err;
2516 spec = codec->spec;
2517 spec->multiout.max_channels = 8;
2518 spec->pcm_playback = nvhdmi_pcm_playback_8ch_7x;
2519 codec->patch_ops.init = nvhdmi_7x_init_8ch;
2520 codec->patch_ops.build_pcms = nvhdmi_7x_8ch_build_pcms;
2521 codec->patch_ops.build_controls = nvhdmi_7x_8ch_build_controls;
2522
2523 /* Initialize the audio infoframe channel mask and checksum to something
2524 * valid */
2525 nvhdmi_8ch_7x_set_info_frame_parameters(codec, 8);
2526
2527 return 0;
2528 }
2529
2530 /*
2531 * ATI-specific implementations
2532 *
2533 * FIXME: we may omit the whole this and use the generic code once after
2534 * it's confirmed to work.
2535 */
2536
2537 #define ATIHDMI_CVT_NID 0x02 /* audio converter */
2538 #define ATIHDMI_PIN_NID 0x03 /* HDMI output pin */
2539
2540 static int atihdmi_playback_pcm_prepare(struct hda_pcm_stream *hinfo,
2541 struct hda_codec *codec,
2542 unsigned int stream_tag,
2543 unsigned int format,
2544 struct snd_pcm_substream *substream)
2545 {
2546 struct hdmi_spec *spec = codec->spec;
2547 struct hdmi_spec_per_cvt *per_cvt = get_cvt(spec, 0);
2548 int chans = substream->runtime->channels;
2549 int i, err;
2550
2551 err = simple_playback_pcm_prepare(hinfo, codec, stream_tag, format,
2552 substream);
2553 if (err < 0)
2554 return err;
2555 snd_hda_codec_write(codec, per_cvt->cvt_nid, 0,
2556 AC_VERB_SET_CVT_CHAN_COUNT, chans - 1);
2557 /* FIXME: XXX */
2558 for (i = 0; i < chans; i++) {
2559 snd_hda_codec_write(codec, per_cvt->cvt_nid, 0,
2560 AC_VERB_SET_HDMI_CHAN_SLOT,
2561 (i << 4) | i);
2562 }
2563 return 0;
2564 }
2565
2566 static int patch_atihdmi(struct hda_codec *codec)
2567 {
2568 struct hdmi_spec *spec;
2569 int err = patch_simple_hdmi(codec, ATIHDMI_CVT_NID, ATIHDMI_PIN_NID);
2570 if (err < 0)
2571 return err;
2572 spec = codec->spec;
2573 spec->pcm_playback.ops.prepare = atihdmi_playback_pcm_prepare;
2574 return 0;
2575 }
2576
2577 /* VIA HDMI Implementation */
2578 #define VIAHDMI_CVT_NID 0x02 /* audio converter1 */
2579 #define VIAHDMI_PIN_NID 0x03 /* HDMI output pin1 */
2580
2581 static int patch_via_hdmi(struct hda_codec *codec)
2582 {
2583 return patch_simple_hdmi(codec, VIAHDMI_CVT_NID, VIAHDMI_PIN_NID);
2584 }
2585
2586 /*
2587 * patch entries
2588 */
2589 static const struct hda_codec_preset snd_hda_preset_hdmi[] = {
2590 { .id = 0x1002793c, .name = "RS600 HDMI", .patch = patch_atihdmi },
2591 { .id = 0x10027919, .name = "RS600 HDMI", .patch = patch_atihdmi },
2592 { .id = 0x1002791a, .name = "RS690/780 HDMI", .patch = patch_atihdmi },
2593 { .id = 0x1002aa01, .name = "R6xx HDMI", .patch = patch_generic_hdmi },
2594 { .id = 0x10951390, .name = "SiI1390 HDMI", .patch = patch_generic_hdmi },
2595 { .id = 0x10951392, .name = "SiI1392 HDMI", .patch = patch_generic_hdmi },
2596 { .id = 0x17e80047, .name = "Chrontel HDMI", .patch = patch_generic_hdmi },
2597 { .id = 0x10de0002, .name = "MCP77/78 HDMI", .patch = patch_nvhdmi_8ch_7x },
2598 { .id = 0x10de0003, .name = "MCP77/78 HDMI", .patch = patch_nvhdmi_8ch_7x },
2599 { .id = 0x10de0005, .name = "MCP77/78 HDMI", .patch = patch_nvhdmi_8ch_7x },
2600 { .id = 0x10de0006, .name = "MCP77/78 HDMI", .patch = patch_nvhdmi_8ch_7x },
2601 { .id = 0x10de0007, .name = "MCP79/7A HDMI", .patch = patch_nvhdmi_8ch_7x },
2602 { .id = 0x10de000a, .name = "GPU 0a HDMI/DP", .patch = patch_generic_hdmi },
2603 { .id = 0x10de000b, .name = "GPU 0b HDMI/DP", .patch = patch_generic_hdmi },
2604 { .id = 0x10de000c, .name = "MCP89 HDMI", .patch = patch_generic_hdmi },
2605 { .id = 0x10de000d, .name = "GPU 0d HDMI/DP", .patch = patch_generic_hdmi },
2606 { .id = 0x10de0010, .name = "GPU 10 HDMI/DP", .patch = patch_generic_hdmi },
2607 { .id = 0x10de0011, .name = "GPU 11 HDMI/DP", .patch = patch_generic_hdmi },
2608 { .id = 0x10de0012, .name = "GPU 12 HDMI/DP", .patch = patch_generic_hdmi },
2609 { .id = 0x10de0013, .name = "GPU 13 HDMI/DP", .patch = patch_generic_hdmi },
2610 { .id = 0x10de0014, .name = "GPU 14 HDMI/DP", .patch = patch_generic_hdmi },
2611 { .id = 0x10de0015, .name = "GPU 15 HDMI/DP", .patch = patch_generic_hdmi },
2612 { .id = 0x10de0016, .name = "GPU 16 HDMI/DP", .patch = patch_generic_hdmi },
2613 /* 17 is known to be absent */
2614 { .id = 0x10de0018, .name = "GPU 18 HDMI/DP", .patch = patch_generic_hdmi },
2615 { .id = 0x10de0019, .name = "GPU 19 HDMI/DP", .patch = patch_generic_hdmi },
2616 { .id = 0x10de001a, .name = "GPU 1a HDMI/DP", .patch = patch_generic_hdmi },
2617 { .id = 0x10de001b, .name = "GPU 1b HDMI/DP", .patch = patch_generic_hdmi },
2618 { .id = 0x10de001c, .name = "GPU 1c HDMI/DP", .patch = patch_generic_hdmi },
2619 { .id = 0x10de0040, .name = "GPU 40 HDMI/DP", .patch = patch_generic_hdmi },
2620 { .id = 0x10de0041, .name = "GPU 41 HDMI/DP", .patch = patch_generic_hdmi },
2621 { .id = 0x10de0042, .name = "GPU 42 HDMI/DP", .patch = patch_generic_hdmi },
2622 { .id = 0x10de0043, .name = "GPU 43 HDMI/DP", .patch = patch_generic_hdmi },
2623 { .id = 0x10de0044, .name = "GPU 44 HDMI/DP", .patch = patch_generic_hdmi },
2624 { .id = 0x10de0051, .name = "GPU 51 HDMI/DP", .patch = patch_generic_hdmi },
2625 { .id = 0x10de0060, .name = "GPU 60 HDMI/DP", .patch = patch_generic_hdmi },
2626 { .id = 0x10de0067, .name = "MCP67 HDMI", .patch = patch_nvhdmi_2ch },
2627 { .id = 0x10de8001, .name = "MCP73 HDMI", .patch = patch_nvhdmi_2ch },
2628 { .id = 0x11069f80, .name = "VX900 HDMI/DP", .patch = patch_via_hdmi },
2629 { .id = 0x11069f81, .name = "VX900 HDMI/DP", .patch = patch_via_hdmi },
2630 { .id = 0x11069f84, .name = "VX11 HDMI/DP", .patch = patch_generic_hdmi },
2631 { .id = 0x11069f85, .name = "VX11 HDMI/DP", .patch = patch_generic_hdmi },
2632 { .id = 0x80860054, .name = "IbexPeak HDMI", .patch = patch_generic_hdmi },
2633 { .id = 0x80862801, .name = "Bearlake HDMI", .patch = patch_generic_hdmi },
2634 { .id = 0x80862802, .name = "Cantiga HDMI", .patch = patch_generic_hdmi },
2635 { .id = 0x80862803, .name = "Eaglelake HDMI", .patch = patch_generic_hdmi },
2636 { .id = 0x80862804, .name = "IbexPeak HDMI", .patch = patch_generic_hdmi },
2637 { .id = 0x80862805, .name = "CougarPoint HDMI", .patch = patch_generic_hdmi },
2638 { .id = 0x80862806, .name = "PantherPoint HDMI", .patch = patch_generic_hdmi },
2639 { .id = 0x80862807, .name = "Haswell HDMI", .patch = patch_generic_hdmi },
2640 { .id = 0x80862880, .name = "CedarTrail HDMI", .patch = patch_generic_hdmi },
2641 { .id = 0x808629fb, .name = "Crestline HDMI", .patch = patch_generic_hdmi },
2642 {} /* terminator */
2643 };
2644
2645 MODULE_ALIAS("snd-hda-codec-id:1002793c");
2646 MODULE_ALIAS("snd-hda-codec-id:10027919");
2647 MODULE_ALIAS("snd-hda-codec-id:1002791a");
2648 MODULE_ALIAS("snd-hda-codec-id:1002aa01");
2649 MODULE_ALIAS("snd-hda-codec-id:10951390");
2650 MODULE_ALIAS("snd-hda-codec-id:10951392");
2651 MODULE_ALIAS("snd-hda-codec-id:10de0002");
2652 MODULE_ALIAS("snd-hda-codec-id:10de0003");
2653 MODULE_ALIAS("snd-hda-codec-id:10de0005");
2654 MODULE_ALIAS("snd-hda-codec-id:10de0006");
2655 MODULE_ALIAS("snd-hda-codec-id:10de0007");
2656 MODULE_ALIAS("snd-hda-codec-id:10de000a");
2657 MODULE_ALIAS("snd-hda-codec-id:10de000b");
2658 MODULE_ALIAS("snd-hda-codec-id:10de000c");
2659 MODULE_ALIAS("snd-hda-codec-id:10de000d");
2660 MODULE_ALIAS("snd-hda-codec-id:10de0010");
2661 MODULE_ALIAS("snd-hda-codec-id:10de0011");
2662 MODULE_ALIAS("snd-hda-codec-id:10de0012");
2663 MODULE_ALIAS("snd-hda-codec-id:10de0013");
2664 MODULE_ALIAS("snd-hda-codec-id:10de0014");
2665 MODULE_ALIAS("snd-hda-codec-id:10de0015");
2666 MODULE_ALIAS("snd-hda-codec-id:10de0016");
2667 MODULE_ALIAS("snd-hda-codec-id:10de0018");
2668 MODULE_ALIAS("snd-hda-codec-id:10de0019");
2669 MODULE_ALIAS("snd-hda-codec-id:10de001a");
2670 MODULE_ALIAS("snd-hda-codec-id:10de001b");
2671 MODULE_ALIAS("snd-hda-codec-id:10de001c");
2672 MODULE_ALIAS("snd-hda-codec-id:10de0040");
2673 MODULE_ALIAS("snd-hda-codec-id:10de0041");
2674 MODULE_ALIAS("snd-hda-codec-id:10de0042");
2675 MODULE_ALIAS("snd-hda-codec-id:10de0043");
2676 MODULE_ALIAS("snd-hda-codec-id:10de0044");
2677 MODULE_ALIAS("snd-hda-codec-id:10de0051");
2678 MODULE_ALIAS("snd-hda-codec-id:10de0060");
2679 MODULE_ALIAS("snd-hda-codec-id:10de0067");
2680 MODULE_ALIAS("snd-hda-codec-id:10de8001");
2681 MODULE_ALIAS("snd-hda-codec-id:11069f80");
2682 MODULE_ALIAS("snd-hda-codec-id:11069f81");
2683 MODULE_ALIAS("snd-hda-codec-id:11069f84");
2684 MODULE_ALIAS("snd-hda-codec-id:11069f85");
2685 MODULE_ALIAS("snd-hda-codec-id:17e80047");
2686 MODULE_ALIAS("snd-hda-codec-id:80860054");
2687 MODULE_ALIAS("snd-hda-codec-id:80862801");
2688 MODULE_ALIAS("snd-hda-codec-id:80862802");
2689 MODULE_ALIAS("snd-hda-codec-id:80862803");
2690 MODULE_ALIAS("snd-hda-codec-id:80862804");
2691 MODULE_ALIAS("snd-hda-codec-id:80862805");
2692 MODULE_ALIAS("snd-hda-codec-id:80862806");
2693 MODULE_ALIAS("snd-hda-codec-id:80862807");
2694 MODULE_ALIAS("snd-hda-codec-id:80862880");
2695 MODULE_ALIAS("snd-hda-codec-id:808629fb");
2696
2697 MODULE_LICENSE("GPL");
2698 MODULE_DESCRIPTION("HDMI HD-audio codec");
2699 MODULE_ALIAS("snd-hda-codec-intelhdmi");
2700 MODULE_ALIAS("snd-hda-codec-nvhdmi");
2701 MODULE_ALIAS("snd-hda-codec-atihdmi");
2702
2703 static struct hda_codec_preset_list intel_list = {
2704 .preset = snd_hda_preset_hdmi,
2705 .owner = THIS_MODULE,
2706 };
2707
2708 static int __init patch_hdmi_init(void)
2709 {
2710 return snd_hda_add_codec_preset(&intel_list);
2711 }
2712
2713 static void __exit patch_hdmi_exit(void)
2714 {
2715 snd_hda_delete_codec_preset(&intel_list);
2716 }
2717
2718 module_init(patch_hdmi_init)
2719 module_exit(patch_hdmi_exit)
Linux kernel - Deliverables
This page took 0.302574 seconds and 5 git commands to generate.