| /* |
| * |
| * patch_hdmi.c - routines for HDMI/DisplayPort codecs |
| * |
| * Copyright(c) 2008-2010 Intel Corporation. All rights reserved. |
| * Copyright (c) 2006 ATI Technologies Inc. |
| * Copyright (c) 2008 NVIDIA Corp. All rights reserved. |
| * Copyright (c) 2008 Wei Ni <wni@nvidia.com> |
| * |
| * Authors: |
| * Wu Fengguang <wfg@linux.intel.com> |
| * |
| * Maintained by: |
| * Wu Fengguang <wfg@linux.intel.com> |
| * |
| * This program is free software; you can redistribute it and/or modify it |
| * under the terms of the GNU General Public License as published by the Free |
| * Software Foundation; either version 2 of the License, or (at your option) |
| * any later version. |
| * |
| * This program is distributed in the hope that it will be useful, but |
| * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY |
| * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License |
| * for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, write to the Free Software Foundation, |
| * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. |
| */ |
| |
| #include <linux/init.h> |
| #include <linux/delay.h> |
| #include <linux/slab.h> |
| #include <linux/moduleparam.h> |
| #include <sound/core.h> |
| #include "hda_codec.h" |
| #include "hda_local.h" |
| |
| static bool static_hdmi_pcm; |
| module_param(static_hdmi_pcm, bool, 0644); |
| MODULE_PARM_DESC(static_hdmi_pcm, "Don't restrict PCM parameters per ELD info"); |
| |
| /* |
| * The HDMI/DisplayPort configuration can be highly dynamic. A graphics device |
| * could support two independent pipes, each of them can be connected to one or |
| * more ports (DVI, HDMI or DisplayPort). |
| * |
| * The HDA correspondence of pipes/ports are converter/pin nodes. |
| */ |
| #define MAX_HDMI_CVTS 3 |
| #define MAX_HDMI_PINS 3 |
| |
| struct hdmi_spec { |
| int num_cvts; |
| int num_pins; |
| hda_nid_t cvt[MAX_HDMI_CVTS+1]; /* audio sources */ |
| hda_nid_t pin[MAX_HDMI_PINS+1]; /* audio sinks */ |
| |
| /* |
| * source connection for each pin |
| */ |
| hda_nid_t pin_cvt[MAX_HDMI_PINS+1]; |
| |
| /* |
| * HDMI sink attached to each pin |
| */ |
| struct hdmi_eld sink_eld[MAX_HDMI_PINS]; |
| |
| /* |
| * export one pcm per pipe |
| */ |
| struct hda_pcm pcm_rec[MAX_HDMI_CVTS]; |
| struct hda_pcm_stream codec_pcm_pars[MAX_HDMI_CVTS]; |
| |
| /* |
| * ati/nvhdmi specific |
| */ |
| struct hda_multi_out multiout; |
| struct hda_pcm_stream *pcm_playback; |
| |
| /* misc flags */ |
| /* PD bit indicates only the update, not the current state */ |
| unsigned int old_pin_detect:1; |
| }; |
| |
| |
| struct hdmi_audio_infoframe { |
| u8 type; /* 0x84 */ |
| u8 ver; /* 0x01 */ |
| u8 len; /* 0x0a */ |
| |
| u8 checksum; |
| |
| u8 CC02_CT47; /* CC in bits 0:2, CT in 4:7 */ |
| u8 SS01_SF24; |
| u8 CXT04; |
| u8 CA; |
| u8 LFEPBL01_LSV36_DM_INH7; |
| }; |
| |
| struct dp_audio_infoframe { |
| u8 type; /* 0x84 */ |
| u8 len; /* 0x1b */ |
| u8 ver; /* 0x11 << 2 */ |
| |
| u8 CC02_CT47; /* match with HDMI infoframe from this on */ |
| u8 SS01_SF24; |
| u8 CXT04; |
| u8 CA; |
| u8 LFEPBL01_LSV36_DM_INH7; |
| }; |
| |
| /* |
| * CEA speaker placement: |
| * |
| * FLH FCH FRH |
| * FLW FL FLC FC FRC FR FRW |
| * |
| * LFE |
| * TC |
| * |
| * RL RLC RC RRC RR |
| * |
| * The Left/Right Surround channel _notions_ LS/RS in SMPTE 320M corresponds to |
| * CEA RL/RR; The SMPTE channel _assignment_ C/LFE is swapped to CEA LFE/FC. |
| */ |
| enum cea_speaker_placement { |
| FL = (1 << 0), /* Front Left */ |
| FC = (1 << 1), /* Front Center */ |
| FR = (1 << 2), /* Front Right */ |
| FLC = (1 << 3), /* Front Left Center */ |
| FRC = (1 << 4), /* Front Right Center */ |
| RL = (1 << 5), /* Rear Left */ |
| RC = (1 << 6), /* Rear Center */ |
| RR = (1 << 7), /* Rear Right */ |
| RLC = (1 << 8), /* Rear Left Center */ |
| RRC = (1 << 9), /* Rear Right Center */ |
| LFE = (1 << 10), /* Low Frequency Effect */ |
| FLW = (1 << 11), /* Front Left Wide */ |
| FRW = (1 << 12), /* Front Right Wide */ |
| FLH = (1 << 13), /* Front Left High */ |
| FCH = (1 << 14), /* Front Center High */ |
| FRH = (1 << 15), /* Front Right High */ |
| TC = (1 << 16), /* Top Center */ |
| }; |
| |
| /* |
| * ELD SA bits in the CEA Speaker Allocation data block |
| */ |
| static int eld_speaker_allocation_bits[] = { |
| [0] = FL | FR, |
| [1] = LFE, |
| [2] = FC, |
| [3] = RL | RR, |
| [4] = RC, |
| [5] = FLC | FRC, |
| [6] = RLC | RRC, |
| /* the following are not defined in ELD yet */ |
| [7] = FLW | FRW, |
| [8] = FLH | FRH, |
| [9] = TC, |
| [10] = FCH, |
| }; |
| |
| struct cea_channel_speaker_allocation { |
| int ca_index; |
| int speakers[8]; |
| |
| /* derived values, just for convenience */ |
| int channels; |
| int spk_mask; |
| }; |
| |
| /* |
| * ALSA sequence is: |
| * |
| * surround40 surround41 surround50 surround51 surround71 |
| * ch0 front left = = = = |
| * ch1 front right = = = = |
| * ch2 rear left = = = = |
| * ch3 rear right = = = = |
| * ch4 LFE center center center |
| * ch5 LFE LFE |
| * ch6 side left |
| * ch7 side right |
| * |
| * surround71 = {FL, FR, RLC, RRC, FC, LFE, RL, RR} |
| */ |
| static int hdmi_channel_mapping[0x32][8] = { |
| /* stereo */ |
| [0x00] = { 0x00, 0x11, 0xf2, 0xf3, 0xf4, 0xf5, 0xf6, 0xf7 }, |
| /* 2.1 */ |
| [0x01] = { 0x00, 0x11, 0x22, 0xf3, 0xf4, 0xf5, 0xf6, 0xf7 }, |
| /* Dolby Surround */ |
| [0x02] = { 0x00, 0x11, 0x23, 0xf2, 0xf4, 0xf5, 0xf6, 0xf7 }, |
| /* surround40 */ |
| [0x08] = { 0x00, 0x11, 0x24, 0x35, 0xf3, 0xf2, 0xf6, 0xf7 }, |
| /* 4ch */ |
| [0x03] = { 0x00, 0x11, 0x23, 0x32, 0x44, 0xf5, 0xf6, 0xf7 }, |
| /* surround41 */ |
| [0x09] = { 0x00, 0x11, 0x24, 0x35, 0x42, 0xf3, 0xf6, 0xf7 }, |
| /* surround50 */ |
| [0x0a] = { 0x00, 0x11, 0x24, 0x35, 0x43, 0xf2, 0xf6, 0xf7 }, |
| /* surround51 */ |
| [0x0b] = { 0x00, 0x11, 0x24, 0x35, 0x43, 0x52, 0xf6, 0xf7 }, |
| /* 7.1 */ |
| [0x13] = { 0x00, 0x11, 0x26, 0x37, 0x43, 0x52, 0x64, 0x75 }, |
| }; |
| |
| /* |
| * This is an ordered list! |
| * |
| * The preceding ones have better chances to be selected by |
| * hdmi_channel_allocation(). |
| */ |
| static struct cea_channel_speaker_allocation channel_allocations[] = { |
| /* channel: 7 6 5 4 3 2 1 0 */ |
| { .ca_index = 0x00, .speakers = { 0, 0, 0, 0, 0, 0, FR, FL } }, |
| /* 2.1 */ |
| { .ca_index = 0x01, .speakers = { 0, 0, 0, 0, 0, LFE, FR, FL } }, |
| /* Dolby Surround */ |
| { .ca_index = 0x02, .speakers = { 0, 0, 0, 0, FC, 0, FR, FL } }, |
| /* surround40 */ |
| { .ca_index = 0x08, .speakers = { 0, 0, RR, RL, 0, 0, FR, FL } }, |
| /* surround41 */ |
| { .ca_index = 0x09, .speakers = { 0, 0, RR, RL, 0, LFE, FR, FL } }, |
| /* surround50 */ |
| { .ca_index = 0x0a, .speakers = { 0, 0, RR, RL, FC, 0, FR, FL } }, |
| /* surround51 */ |
| { .ca_index = 0x0b, .speakers = { 0, 0, RR, RL, FC, LFE, FR, FL } }, |
| /* 6.1 */ |
| { .ca_index = 0x0f, .speakers = { 0, RC, RR, RL, FC, LFE, FR, FL } }, |
| /* surround71 */ |
| { .ca_index = 0x13, .speakers = { RRC, RLC, RR, RL, FC, LFE, FR, FL } }, |
| |
| { .ca_index = 0x03, .speakers = { 0, 0, 0, 0, FC, LFE, FR, FL } }, |
| { .ca_index = 0x04, .speakers = { 0, 0, 0, RC, 0, 0, FR, FL } }, |
| { .ca_index = 0x05, .speakers = { 0, 0, 0, RC, 0, LFE, FR, FL } }, |
| { .ca_index = 0x06, .speakers = { 0, 0, 0, RC, FC, 0, FR, FL } }, |
| { .ca_index = 0x07, .speakers = { 0, 0, 0, RC, FC, LFE, FR, FL } }, |
| { .ca_index = 0x0c, .speakers = { 0, RC, RR, RL, 0, 0, FR, FL } }, |
| { .ca_index = 0x0d, .speakers = { 0, RC, RR, RL, 0, LFE, FR, FL } }, |
| { .ca_index = 0x0e, .speakers = { 0, RC, RR, RL, FC, 0, FR, FL } }, |
| { .ca_index = 0x10, .speakers = { RRC, RLC, RR, RL, 0, 0, FR, FL } }, |
| { .ca_index = 0x11, .speakers = { RRC, RLC, RR, RL, 0, LFE, FR, FL } }, |
| { .ca_index = 0x12, .speakers = { RRC, RLC, RR, RL, FC, 0, FR, FL } }, |
| { .ca_index = 0x14, .speakers = { FRC, FLC, 0, 0, 0, 0, FR, FL } }, |
| { .ca_index = 0x15, .speakers = { FRC, FLC, 0, 0, 0, LFE, FR, FL } }, |
| { .ca_index = 0x16, .speakers = { FRC, FLC, 0, 0, FC, 0, FR, FL } }, |
| { .ca_index = 0x17, .speakers = { FRC, FLC, 0, 0, FC, LFE, FR, FL } }, |
| { .ca_index = 0x18, .speakers = { FRC, FLC, 0, RC, 0, 0, FR, FL } }, |
| { .ca_index = 0x19, .speakers = { FRC, FLC, 0, RC, 0, LFE, FR, FL } }, |
| { .ca_index = 0x1a, .speakers = { FRC, FLC, 0, RC, FC, 0, FR, FL } }, |
| { .ca_index = 0x1b, .speakers = { FRC, FLC, 0, RC, FC, LFE, FR, FL } }, |
| { .ca_index = 0x1c, .speakers = { FRC, FLC, RR, RL, 0, 0, FR, FL } }, |
| { .ca_index = 0x1d, .speakers = { FRC, FLC, RR, RL, 0, LFE, FR, FL } }, |
| { .ca_index = 0x1e, .speakers = { FRC, FLC, RR, RL, FC, 0, FR, FL } }, |
| { .ca_index = 0x1f, .speakers = { FRC, FLC, RR, RL, FC, LFE, FR, FL } }, |
| { .ca_index = 0x20, .speakers = { 0, FCH, RR, RL, FC, 0, FR, FL } }, |
| { .ca_index = 0x21, .speakers = { 0, FCH, RR, RL, FC, LFE, FR, FL } }, |
| { .ca_index = 0x22, .speakers = { TC, 0, RR, RL, FC, 0, FR, FL } }, |
| { .ca_index = 0x23, .speakers = { TC, 0, RR, RL, FC, LFE, FR, FL } }, |
| { .ca_index = 0x24, .speakers = { FRH, FLH, RR, RL, 0, 0, FR, FL } }, |
| { .ca_index = 0x25, .speakers = { FRH, FLH, RR, RL, 0, LFE, FR, FL } }, |
| { .ca_index = 0x26, .speakers = { FRW, FLW, RR, RL, 0, 0, FR, FL } }, |
| { .ca_index = 0x27, .speakers = { FRW, FLW, RR, RL, 0, LFE, FR, FL } }, |
| { .ca_index = 0x28, .speakers = { TC, RC, RR, RL, FC, 0, FR, FL } }, |
| { .ca_index = 0x29, .speakers = { TC, RC, RR, RL, FC, LFE, FR, FL } }, |
| { .ca_index = 0x2a, .speakers = { FCH, RC, RR, RL, FC, 0, FR, FL } }, |
| { .ca_index = 0x2b, .speakers = { FCH, RC, RR, RL, FC, LFE, FR, FL } }, |
| { .ca_index = 0x2c, .speakers = { TC, FCH, RR, RL, FC, 0, FR, FL } }, |
| { .ca_index = 0x2d, .speakers = { TC, FCH, RR, RL, FC, LFE, FR, FL } }, |
| { .ca_index = 0x2e, .speakers = { FRH, FLH, RR, RL, FC, 0, FR, FL } }, |
| { .ca_index = 0x2f, .speakers = { FRH, FLH, RR, RL, FC, LFE, FR, FL } }, |
| { .ca_index = 0x30, .speakers = { FRW, FLW, RR, RL, FC, 0, FR, FL } }, |
| { .ca_index = 0x31, .speakers = { FRW, FLW, RR, RL, FC, LFE, FR, FL } }, |
| }; |
| |
| |
| /* |
| * HDMI routines |
| */ |
| |
| static int hda_node_index(hda_nid_t *nids, hda_nid_t nid) |
| { |
| int i; |
| |
| for (i = 0; nids[i]; i++) |
| if (nids[i] == nid) |
| return i; |
| |
| snd_printk(KERN_WARNING "HDMI: nid %d not registered\n", nid); |
| return -EINVAL; |
| } |
| |
| static void hdmi_get_show_eld(struct hda_codec *codec, hda_nid_t pin_nid, |
| struct hdmi_eld *eld) |
| { |
| if (!snd_hdmi_get_eld(eld, codec, pin_nid)) |
| snd_hdmi_show_eld(eld); |
| } |
| |
| #ifdef BE_PARANOID |
| static void hdmi_get_dip_index(struct hda_codec *codec, hda_nid_t pin_nid, |
| int *packet_index, int *byte_index) |
| { |
| int val; |
| |
| val = snd_hda_codec_read(codec, pin_nid, 0, |
| AC_VERB_GET_HDMI_DIP_INDEX, 0); |
| |
| *packet_index = val >> 5; |
| *byte_index = val & 0x1f; |
| } |
| #endif |
| |
| static void hdmi_set_dip_index(struct hda_codec *codec, hda_nid_t pin_nid, |
| int packet_index, int byte_index) |
| { |
| int val; |
| |
| val = (packet_index << 5) | (byte_index & 0x1f); |
| |
| snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_INDEX, val); |
| } |
| |
| static void hdmi_write_dip_byte(struct hda_codec *codec, hda_nid_t pin_nid, |
| unsigned char val) |
| { |
| snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_DATA, val); |
| } |
| |
| static void hdmi_enable_output(struct hda_codec *codec, hda_nid_t pin_nid) |
| { |
| /* Unmute */ |
| if (get_wcaps(codec, pin_nid) & AC_WCAP_OUT_AMP) |
| snd_hda_codec_write(codec, pin_nid, 0, |
| AC_VERB_SET_AMP_GAIN_MUTE, AMP_OUT_UNMUTE); |
| /* Enable pin out */ |
| snd_hda_codec_write(codec, pin_nid, 0, |
| AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT); |
| } |
| |
| static int hdmi_get_channel_count(struct hda_codec *codec, hda_nid_t nid) |
| { |
| return 1 + snd_hda_codec_read(codec, nid, 0, |
| AC_VERB_GET_CVT_CHAN_COUNT, 0); |
| } |
| |
| static void hdmi_set_channel_count(struct hda_codec *codec, |
| hda_nid_t nid, int chs) |
| { |
| if (chs != hdmi_get_channel_count(codec, nid)) |
| snd_hda_codec_write(codec, nid, 0, |
| AC_VERB_SET_CVT_CHAN_COUNT, chs - 1); |
| } |
| |
| |
| /* |
| * Channel mapping routines |
| */ |
| |
| /* |
| * Compute derived values in channel_allocations[]. |
| */ |
| static void init_channel_allocations(void) |
| { |
| int i, j; |
| struct cea_channel_speaker_allocation *p; |
| |
| for (i = 0; i < ARRAY_SIZE(channel_allocations); i++) { |
| p = channel_allocations + i; |
| p->channels = 0; |
| p->spk_mask = 0; |
| for (j = 0; j < ARRAY_SIZE(p->speakers); j++) |
| if (p->speakers[j]) { |
| p->channels++; |
| p->spk_mask |= p->speakers[j]; |
| } |
| } |
| } |
| |
| /* |
| * The transformation takes two steps: |
| * |
| * eld->spk_alloc => (eld_speaker_allocation_bits[]) => spk_mask |
| * spk_mask => (channel_allocations[]) => ai->CA |
| * |
| * TODO: it could select the wrong CA from multiple candidates. |
| */ |
| static int hdmi_channel_allocation(struct hda_codec *codec, hda_nid_t nid, |
| int channels) |
| { |
| struct hdmi_spec *spec = codec->spec; |
| struct hdmi_eld *eld; |
| int i; |
| int ca = 0; |
| int spk_mask = 0; |
| char buf[SND_PRINT_CHANNEL_ALLOCATION_ADVISED_BUFSIZE]; |
| |
| /* |
| * CA defaults to 0 for basic stereo audio |
| */ |
| if (channels <= 2) |
| return 0; |
| |
| i = hda_node_index(spec->pin_cvt, nid); |
| if (i < 0) |
| return 0; |
| eld = &spec->sink_eld[i]; |
| |
| /* |
| * HDMI sink's ELD info cannot always be retrieved for now, e.g. |
| * in console or for audio devices. Assume the highest speakers |
| * configuration, to _not_ prohibit multi-channel audio playback. |
| */ |
| if (!eld->spk_alloc) |
| eld->spk_alloc = 0xffff; |
| |
| /* |
| * expand ELD's speaker allocation mask |
| * |
| * ELD tells the speaker mask in a compact(paired) form, |
| * expand ELD's notions to match the ones used by Audio InfoFrame. |
| */ |
| for (i = 0; i < ARRAY_SIZE(eld_speaker_allocation_bits); i++) { |
| if (eld->spk_alloc & (1 << i)) |
| spk_mask |= eld_speaker_allocation_bits[i]; |
| } |
| |
| /* search for the first working match in the CA table */ |
| for (i = 0; i < ARRAY_SIZE(channel_allocations); i++) { |
| if (channels == channel_allocations[i].channels && |
| (spk_mask & channel_allocations[i].spk_mask) == |
| channel_allocations[i].spk_mask) { |
| ca = channel_allocations[i].ca_index; |
| break; |
| } |
| } |
| |
| snd_print_channel_allocation(eld->spk_alloc, buf, sizeof(buf)); |
| snd_printdd("HDMI: select CA 0x%x for %d-channel allocation: %s\n", |
| ca, channels, buf); |
| |
| return ca; |
| } |
| |
| static void hdmi_debug_channel_mapping(struct hda_codec *codec, |
| hda_nid_t pin_nid) |
| { |
| #ifdef CONFIG_SND_DEBUG_VERBOSE |
| int i; |
| int slot; |
| |
| for (i = 0; i < 8; i++) { |
| slot = snd_hda_codec_read(codec, pin_nid, 0, |
| AC_VERB_GET_HDMI_CHAN_SLOT, i); |
| printk(KERN_DEBUG "HDMI: ASP channel %d => slot %d\n", |
| slot >> 4, slot & 0xf); |
| } |
| #endif |
| } |
| |
| |
| static void hdmi_setup_channel_mapping(struct hda_codec *codec, |
| hda_nid_t pin_nid, |
| int ca) |
| { |
| int i; |
| int err; |
| |
| if (hdmi_channel_mapping[ca][1] == 0) { |
| for (i = 0; i < channel_allocations[ca].channels; i++) |
| hdmi_channel_mapping[ca][i] = i | (i << 4); |
| for (; i < 8; i++) |
| hdmi_channel_mapping[ca][i] = 0xf | (i << 4); |
| } |
| |
| for (i = 0; i < 8; i++) { |
| err = snd_hda_codec_write(codec, pin_nid, 0, |
| AC_VERB_SET_HDMI_CHAN_SLOT, |
| hdmi_channel_mapping[ca][i]); |
| if (err) { |
| snd_printdd(KERN_NOTICE |
| "HDMI: channel mapping failed\n"); |
| break; |
| } |
| } |
| |
| hdmi_debug_channel_mapping(codec, pin_nid); |
| } |
| |
| |
| /* |
| * Audio InfoFrame routines |
| */ |
| |
| /* |
| * Enable Audio InfoFrame Transmission |
| */ |
| static void hdmi_start_infoframe_trans(struct hda_codec *codec, |
| hda_nid_t pin_nid) |
| { |
| hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0); |
| snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_XMIT, |
| AC_DIPXMIT_BEST); |
| } |
| |
| /* |
| * Disable Audio InfoFrame Transmission |
| */ |
| static void hdmi_stop_infoframe_trans(struct hda_codec *codec, |
| hda_nid_t pin_nid) |
| { |
| hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0); |
| snd_hda_codec_write(codec, pin_nid, 0, AC_VERB_SET_HDMI_DIP_XMIT, |
| AC_DIPXMIT_DISABLE); |
| } |
| |
| static void hdmi_debug_dip_size(struct hda_codec *codec, hda_nid_t pin_nid) |
| { |
| #ifdef CONFIG_SND_DEBUG_VERBOSE |
| int i; |
| int size; |
| |
| size = snd_hdmi_get_eld_size(codec, pin_nid); |
| printk(KERN_DEBUG "HDMI: ELD buf size is %d\n", size); |
| |
| for (i = 0; i < 8; i++) { |
| size = snd_hda_codec_read(codec, pin_nid, 0, |
| AC_VERB_GET_HDMI_DIP_SIZE, i); |
| printk(KERN_DEBUG "HDMI: DIP GP[%d] buf size is %d\n", i, size); |
| } |
| #endif |
| } |
| |
| static void hdmi_clear_dip_buffers(struct hda_codec *codec, hda_nid_t pin_nid) |
| { |
| #ifdef BE_PARANOID |
| int i, j; |
| int size; |
| int pi, bi; |
| for (i = 0; i < 8; i++) { |
| size = snd_hda_codec_read(codec, pin_nid, 0, |
| AC_VERB_GET_HDMI_DIP_SIZE, i); |
| if (size == 0) |
| continue; |
| |
| hdmi_set_dip_index(codec, pin_nid, i, 0x0); |
| for (j = 1; j < 1000; j++) { |
| hdmi_write_dip_byte(codec, pin_nid, 0x0); |
| hdmi_get_dip_index(codec, pin_nid, &pi, &bi); |
| if (pi != i) |
| snd_printd(KERN_INFO "dip index %d: %d != %d\n", |
| bi, pi, i); |
| if (bi == 0) /* byte index wrapped around */ |
| break; |
| } |
| snd_printd(KERN_INFO |
| "HDMI: DIP GP[%d] buf reported size=%d, written=%d\n", |
| i, size, j); |
| } |
| #endif |
| } |
| |
| static void hdmi_checksum_audio_infoframe(struct hdmi_audio_infoframe *hdmi_ai) |
| { |
| u8 *bytes = (u8 *)hdmi_ai; |
| u8 sum = 0; |
| int i; |
| |
| hdmi_ai->checksum = 0; |
| |
| for (i = 0; i < sizeof(*hdmi_ai); i++) |
| sum += bytes[i]; |
| |
| hdmi_ai->checksum = -sum; |
| } |
| |
| static void hdmi_fill_audio_infoframe(struct hda_codec *codec, |
| hda_nid_t pin_nid, |
| u8 *dip, int size) |
| { |
| int i; |
| |
| hdmi_debug_dip_size(codec, pin_nid); |
| hdmi_clear_dip_buffers(codec, pin_nid); /* be paranoid */ |
| |
| hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0); |
| for (i = 0; i < size; i++) |
| hdmi_write_dip_byte(codec, pin_nid, dip[i]); |
| } |
| |
| static bool hdmi_infoframe_uptodate(struct hda_codec *codec, hda_nid_t pin_nid, |
| u8 *dip, int size) |
| { |
| u8 val; |
| int i; |
| |
| if (snd_hda_codec_read(codec, pin_nid, 0, AC_VERB_GET_HDMI_DIP_XMIT, 0) |
| != AC_DIPXMIT_BEST) |
| return false; |
| |
| hdmi_set_dip_index(codec, pin_nid, 0x0, 0x0); |
| for (i = 0; i < size; i++) { |
| val = snd_hda_codec_read(codec, pin_nid, 0, |
| AC_VERB_GET_HDMI_DIP_DATA, 0); |
| if (val != dip[i]) |
| return false; |
| } |
| |
| return true; |
| } |
| |
| static void hdmi_setup_audio_infoframe(struct hda_codec *codec, hda_nid_t nid, |
| struct snd_pcm_substream *substream) |
| { |
| struct hdmi_spec *spec = codec->spec; |
| hda_nid_t pin_nid; |
| int channels = substream->runtime->channels; |
| int ca; |
| int i; |
| u8 ai[max(sizeof(struct hdmi_audio_infoframe), |
| sizeof(struct dp_audio_infoframe))]; |
| |
| ca = hdmi_channel_allocation(codec, nid, channels); |
| |
| for (i = 0; i < spec->num_pins; i++) { |
| if (spec->pin_cvt[i] != nid) |
| continue; |
| if (!spec->sink_eld[i].monitor_present) |
| continue; |
| |
| pin_nid = spec->pin[i]; |
| |
| memset(ai, 0, sizeof(ai)); |
| if (spec->sink_eld[i].conn_type == 0) { /* HDMI */ |
| struct hdmi_audio_infoframe *hdmi_ai; |
| |
| hdmi_ai = (struct hdmi_audio_infoframe *)ai; |
| hdmi_ai->type = 0x84; |
| hdmi_ai->ver = 0x01; |
| hdmi_ai->len = 0x0a; |
| hdmi_ai->CC02_CT47 = channels - 1; |
| hdmi_checksum_audio_infoframe(hdmi_ai); |
| } else if (spec->sink_eld[i].conn_type == 1) { /* DisplayPort */ |
| struct dp_audio_infoframe *dp_ai; |
| |
| dp_ai = (struct dp_audio_infoframe *)ai; |
| dp_ai->type = 0x84; |
| dp_ai->len = 0x1b; |
| dp_ai->ver = 0x11 << 2; |
| dp_ai->CC02_CT47 = channels - 1; |
| } else { |
| snd_printd("HDMI: unknown connection type at pin %d\n", |
| pin_nid); |
| continue; |
| } |
| |
| /* |
| * sizeof(ai) is used instead of sizeof(*hdmi_ai) or |
| * sizeof(*dp_ai) to avoid partial match/update problems when |
| * the user switches between HDMI/DP monitors. |
| */ |
| if (!hdmi_infoframe_uptodate(codec, pin_nid, ai, sizeof(ai))) { |
| snd_printdd("hdmi_setup_audio_infoframe: " |
| "cvt=%d pin=%d channels=%d\n", |
| nid, pin_nid, |
| channels); |
| hdmi_setup_channel_mapping(codec, pin_nid, ca); |
| hdmi_stop_infoframe_trans(codec, pin_nid); |
| hdmi_fill_audio_infoframe(codec, pin_nid, |
| ai, sizeof(ai)); |
| hdmi_start_infoframe_trans(codec, pin_nid); |
| } |
| } |
| } |
| |
| |
| /* |
| * Unsolicited events |
| */ |
| |
| static void hdmi_present_sense(struct hda_codec *codec, hda_nid_t pin_nid, |
| struct hdmi_eld *eld); |
| |
| static void hdmi_intrinsic_event(struct hda_codec *codec, unsigned int res) |
| { |
| struct hdmi_spec *spec = codec->spec; |
| int tag = res >> AC_UNSOL_RES_TAG_SHIFT; |
| int pind = !!(res & AC_UNSOL_RES_PD); |
| int eldv = !!(res & AC_UNSOL_RES_ELDV); |
| int index; |
| |
| printk(KERN_INFO |
| "HDMI hot plug event: Pin=%d Presence_Detect=%d ELD_Valid=%d\n", |
| tag, pind, eldv); |
| |
| index = hda_node_index(spec->pin, tag); |
| if (index < 0) |
| return; |
| |
| if (spec->old_pin_detect) { |
| if (pind) |
| hdmi_present_sense(codec, tag, &spec->sink_eld[index]); |
| pind = spec->sink_eld[index].monitor_present; |
| } |
| |
| spec->sink_eld[index].monitor_present = pind; |
| spec->sink_eld[index].eld_valid = eldv; |
| |
| if (pind && eldv) { |
| hdmi_get_show_eld(codec, spec->pin[index], |
| &spec->sink_eld[index]); |
| /* TODO: do real things about ELD */ |
| } |
| } |
| |
| static void hdmi_non_intrinsic_event(struct hda_codec *codec, unsigned int res) |
| { |
| int tag = res >> AC_UNSOL_RES_TAG_SHIFT; |
| int subtag = (res & AC_UNSOL_RES_SUBTAG) >> AC_UNSOL_RES_SUBTAG_SHIFT; |
| int cp_state = !!(res & AC_UNSOL_RES_CP_STATE); |
| int cp_ready = !!(res & AC_UNSOL_RES_CP_READY); |
| |
| printk(KERN_INFO |
| "HDMI CP event: PIN=%d SUBTAG=0x%x CP_STATE=%d CP_READY=%d\n", |
| tag, |
| subtag, |
| cp_state, |
| cp_ready); |
| |
| /* TODO */ |
| if (cp_state) |
| ; |
| if (cp_ready) |
| ; |
| } |
| |
| |
| static void hdmi_unsol_event(struct hda_codec *codec, unsigned int res) |
| { |
| struct hdmi_spec *spec = codec->spec; |
| int tag = res >> AC_UNSOL_RES_TAG_SHIFT; |
| int subtag = (res & AC_UNSOL_RES_SUBTAG) >> AC_UNSOL_RES_SUBTAG_SHIFT; |
| |
| if (hda_node_index(spec->pin, tag) < 0) { |
| snd_printd(KERN_INFO "Unexpected HDMI event tag 0x%x\n", tag); |
| return; |
| } |
| |
| if (subtag == 0) |
| hdmi_intrinsic_event(codec, res); |
| else |
| hdmi_non_intrinsic_event(codec, res); |
| } |
| |
| /* |
| * Callbacks |
| */ |
| |
| /* HBR should be Non-PCM, 8 channels */ |
| #define is_hbr_format(format) \ |
| ((format & AC_FMT_TYPE_NON_PCM) && (format & AC_FMT_CHAN_MASK) == 7) |
| |
| static int hdmi_setup_stream(struct hda_codec *codec, hda_nid_t nid, |
| u32 stream_tag, int format) |
| { |
| struct hdmi_spec *spec = codec->spec; |
| int pinctl; |
| int new_pinctl = 0; |
| int i; |
| |
| for (i = 0; i < spec->num_pins; i++) { |
| if (spec->pin_cvt[i] != nid) |
| continue; |
| if (!(snd_hda_query_pin_caps(codec, spec->pin[i]) & AC_PINCAP_HBR)) |
| continue; |
| |
| pinctl = snd_hda_codec_read(codec, spec->pin[i], 0, |
| AC_VERB_GET_PIN_WIDGET_CONTROL, 0); |
| |
| new_pinctl = pinctl & ~AC_PINCTL_EPT; |
| if (is_hbr_format(format)) |
| new_pinctl |= AC_PINCTL_EPT_HBR; |
| else |
| new_pinctl |= AC_PINCTL_EPT_NATIVE; |
| |
| snd_printdd("hdmi_setup_stream: " |
| "NID=0x%x, %spinctl=0x%x\n", |
| spec->pin[i], |
| pinctl == new_pinctl ? "" : "new-", |
| new_pinctl); |
| |
| if (pinctl != new_pinctl) |
| snd_hda_codec_write(codec, spec->pin[i], 0, |
| AC_VERB_SET_PIN_WIDGET_CONTROL, |
| new_pinctl); |
| } |
| |
| if (is_hbr_format(format) && !new_pinctl) { |
| snd_printdd("hdmi_setup_stream: HBR is not supported\n"); |
| return -EINVAL; |
| } |
| |
| snd_hda_codec_setup_stream(codec, nid, stream_tag, 0, format); |
| return 0; |
| } |
| |
| /* |
| * HDA PCM callbacks |
| */ |
| static int hdmi_pcm_open(struct hda_pcm_stream *hinfo, |
| struct hda_codec *codec, |
| struct snd_pcm_substream *substream) |
| { |
| struct hdmi_spec *spec = codec->spec; |
| struct hdmi_eld *eld; |
| struct hda_pcm_stream *codec_pars; |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| unsigned int idx; |
| |
| for (idx = 0; idx < spec->num_cvts; idx++) |
| if (hinfo->nid == spec->cvt[idx]) |
| break; |
| if (snd_BUG_ON(idx >= spec->num_cvts) || |
| snd_BUG_ON(idx >= spec->num_pins)) |
| return -EINVAL; |
| |
| /* save the PCM info the codec provides */ |
| codec_pars = &spec->codec_pcm_pars[idx]; |
| if (!codec_pars->rates) |
| *codec_pars = *hinfo; |
| |
| eld = &spec->sink_eld[idx]; |
| if (!static_hdmi_pcm && eld->eld_valid && eld->sad_count > 0) { |
| hdmi_eld_update_pcm_info(eld, hinfo, codec_pars); |
| if (hinfo->channels_min > hinfo->channels_max || |
| !hinfo->rates || !hinfo->formats) |
| return -ENODEV; |
| } else { |
| /* fallback to the codec default */ |
| hinfo->channels_max = codec_pars->channels_max; |
| hinfo->rates = codec_pars->rates; |
| hinfo->formats = codec_pars->formats; |
| hinfo->maxbps = codec_pars->maxbps; |
| } |
| /* store the updated parameters */ |
| runtime->hw.channels_min = hinfo->channels_min; |
| runtime->hw.channels_max = hinfo->channels_max; |
| runtime->hw.formats = hinfo->formats; |
| runtime->hw.rates = hinfo->rates; |
| |
| snd_pcm_hw_constraint_step(substream->runtime, 0, |
| SNDRV_PCM_HW_PARAM_CHANNELS, 2); |
| return 0; |
| } |
| |
| /* |
| * HDA/HDMI auto parsing |
| */ |
| static int hdmi_read_pin_conn(struct hda_codec *codec, hda_nid_t pin_nid) |
| { |
| struct hdmi_spec *spec = codec->spec; |
| hda_nid_t conn_list[HDA_MAX_CONNECTIONS]; |
| int conn_len, curr; |
| int index; |
| |
| if (!(get_wcaps(codec, pin_nid) & AC_WCAP_CONN_LIST)) { |
| snd_printk(KERN_WARNING |
| "HDMI: pin %d wcaps %#x " |
| "does not support connection list\n", |
| pin_nid, get_wcaps(codec, pin_nid)); |
| return -EINVAL; |
| } |
| |
| conn_len = snd_hda_get_connections(codec, pin_nid, conn_list, |
| HDA_MAX_CONNECTIONS); |
| if (conn_len > 1) |
| curr = snd_hda_codec_read(codec, pin_nid, 0, |
| AC_VERB_GET_CONNECT_SEL, 0); |
| else |
| curr = 0; |
| |
| index = hda_node_index(spec->pin, pin_nid); |
| if (index < 0) |
| return -EINVAL; |
| |
| spec->pin_cvt[index] = conn_list[curr]; |
| |
| return 0; |
| } |
| |
| static void hdmi_present_sense(struct hda_codec *codec, hda_nid_t pin_nid, |
| struct hdmi_eld *eld) |
| { |
| int present = snd_hda_pin_sense(codec, pin_nid); |
| |
| eld->monitor_present = !!(present & AC_PINSENSE_PRESENCE); |
| eld->eld_valid = !!(present & AC_PINSENSE_ELDV); |
| |
| if (present & AC_PINSENSE_ELDV) |
| hdmi_get_show_eld(codec, pin_nid, eld); |
| } |
| |
| static int hdmi_add_pin(struct hda_codec *codec, hda_nid_t pin_nid) |
| { |
| struct hdmi_spec *spec = codec->spec; |
| |
| if (spec->num_pins >= MAX_HDMI_PINS) { |
| snd_printk(KERN_WARNING |
| "HDMI: no space for pin %d\n", pin_nid); |
| return -E2BIG; |
| } |
| |
| hdmi_present_sense(codec, pin_nid, &spec->sink_eld[spec->num_pins]); |
| |
| spec->pin[spec->num_pins] = pin_nid; |
| spec->num_pins++; |
| |
| return hdmi_read_pin_conn(codec, pin_nid); |
| } |
| |
| static int hdmi_add_cvt(struct hda_codec *codec, hda_nid_t nid) |
| { |
| int i, found_pin = 0; |
| struct hdmi_spec *spec = codec->spec; |
| |
| for (i = 0; i < spec->num_pins; i++) |
| if (nid == spec->pin_cvt[i]) { |
| found_pin = 1; |
| break; |
| } |
| |
| if (!found_pin) { |
| snd_printdd("HDMI: Skipping node %d (no connection)\n", nid); |
| return -EINVAL; |
| } |
| |
| if (snd_BUG_ON(spec->num_cvts >= MAX_HDMI_CVTS)) |
| return -E2BIG; |
| |
| spec->cvt[spec->num_cvts] = nid; |
| spec->num_cvts++; |
| |
| return 0; |
| } |
| |
| static int hdmi_parse_codec(struct hda_codec *codec) |
| { |
| hda_nid_t nid; |
| int i, nodes; |
| int num_tmp_cvts = 0; |
| hda_nid_t tmp_cvt[MAX_HDMI_CVTS]; |
| |
| nodes = snd_hda_get_sub_nodes(codec, codec->afg, &nid); |
| if (!nid || nodes < 0) { |
| snd_printk(KERN_WARNING "HDMI: failed to get afg sub nodes\n"); |
| return -EINVAL; |
| } |
| |
| for (i = 0; i < nodes; i++, nid++) { |
| unsigned int caps; |
| unsigned int type; |
| unsigned int config; |
| |
| caps = snd_hda_param_read(codec, nid, AC_PAR_AUDIO_WIDGET_CAP); |
| type = get_wcaps_type(caps); |
| |
| if (!(caps & AC_WCAP_DIGITAL)) |
| continue; |
| |
| switch (type) { |
| case AC_WID_AUD_OUT: |
| if (num_tmp_cvts >= MAX_HDMI_CVTS) { |
| snd_printk(KERN_WARNING |
| "HDMI: no space for converter %d\n", nid); |
| continue; |
| } |
| tmp_cvt[num_tmp_cvts] = nid; |
| num_tmp_cvts++; |
| break; |
| case AC_WID_PIN: |
| caps = snd_hda_param_read(codec, nid, AC_PAR_PIN_CAP); |
| if (!(caps & (AC_PINCAP_HDMI | AC_PINCAP_DP))) |
| continue; |
| |
| config = snd_hda_codec_read(codec, nid, 0, |
| AC_VERB_GET_CONFIG_DEFAULT, 0); |
| if (get_defcfg_connect(config) == AC_JACK_PORT_NONE) |
| continue; |
| |
| hdmi_add_pin(codec, nid); |
| break; |
| } |
| } |
| |
| for (i = 0; i < num_tmp_cvts; i++) |
| hdmi_add_cvt(codec, tmp_cvt[i]); |
| |
| /* |
| * G45/IbexPeak don't support EPSS: the unsolicited pin hot plug event |
| * can be lost and presence sense verb will become inaccurate if the |
| * HDA link is powered off at hot plug or hw initialization time. |
| */ |
| #ifdef CONFIG_SND_HDA_POWER_SAVE |
| if (!(snd_hda_param_read(codec, codec->afg, AC_PAR_POWER_STATE) & |
| AC_PWRST_EPSS)) |
| codec->bus->power_keep_link_on = 1; |
| #endif |
| |
| return 0; |
| } |
| |
| /* |
| */ |
| static char *generic_hdmi_pcm_names[MAX_HDMI_CVTS] = { |
| "HDMI 0", |
| "HDMI 1", |
| "HDMI 2", |
| }; |
| |
| /* |
| * HDMI callbacks |
| */ |
| |
| static int generic_hdmi_playback_pcm_prepare(struct hda_pcm_stream *hinfo, |
| struct hda_codec *codec, |
| unsigned int stream_tag, |
| unsigned int format, |
| struct snd_pcm_substream *substream) |
| { |
| hdmi_set_channel_count(codec, hinfo->nid, |
| substream->runtime->channels); |
| |
| hdmi_setup_audio_infoframe(codec, hinfo->nid, substream); |
| |
| return hdmi_setup_stream(codec, hinfo->nid, stream_tag, format); |
| } |
| |
| static struct hda_pcm_stream generic_hdmi_pcm_playback = { |
| .substreams = 1, |
| .channels_min = 2, |
| .ops = { |
| .open = hdmi_pcm_open, |
| .prepare = generic_hdmi_playback_pcm_prepare, |
| }, |
| }; |
| |
| static int generic_hdmi_build_pcms(struct hda_codec *codec) |
| { |
| struct hdmi_spec *spec = codec->spec; |
| struct hda_pcm *info = spec->pcm_rec; |
| int i; |
| |
| codec->num_pcms = spec->num_cvts; |
| codec->pcm_info = info; |
| |
| for (i = 0; i < codec->num_pcms; i++, info++) { |
| unsigned int chans; |
| struct hda_pcm_stream *pstr; |
| |
| chans = get_wcaps(codec, spec->cvt[i]); |
| chans = get_wcaps_channels(chans); |
| |
| info->name = generic_hdmi_pcm_names[i]; |
| info->pcm_type = HDA_PCM_TYPE_HDMI; |
| pstr = &info->stream[SNDRV_PCM_STREAM_PLAYBACK]; |
| if (spec->pcm_playback) |
| *pstr = *spec->pcm_playback; |
| else |
| *pstr = generic_hdmi_pcm_playback; |
| pstr->nid = spec->cvt[i]; |
| if (pstr->channels_max <= 2 && chans && chans <= 16) |
| pstr->channels_max = chans; |
| } |
| |
| return 0; |
| } |
| |
| static int generic_hdmi_build_controls(struct hda_codec *codec) |
| { |
| struct hdmi_spec *spec = codec->spec; |
| int err; |
| int i; |
| |
| for (i = 0; i < codec->num_pcms; i++) { |
| err = snd_hda_create_spdif_out_ctls(codec, spec->cvt[i]); |
| if (err < 0) |
| return err; |
| } |
| |
| return 0; |
| } |
| |
| static int generic_hdmi_init(struct hda_codec *codec) |
| { |
| struct hdmi_spec *spec = codec->spec; |
| int i; |
| |
| for (i = 0; spec->pin[i]; i++) { |
| hdmi_enable_output(codec, spec->pin[i]); |
| snd_hda_codec_write(codec, spec->pin[i], 0, |
| AC_VERB_SET_UNSOLICITED_ENABLE, |
| AC_USRSP_EN | spec->pin[i]); |
| } |
| return 0; |
| } |
| |
| static void generic_hdmi_free(struct hda_codec *codec) |
| { |
| struct hdmi_spec *spec = codec->spec; |
| int i; |
| |
| for (i = 0; i < spec->num_pins; i++) |
| snd_hda_eld_proc_free(codec, &spec->sink_eld[i]); |
| |
| kfree(spec); |
| } |
| |
| static struct hda_codec_ops generic_hdmi_patch_ops = { |
| .init = generic_hdmi_init, |
| .free = generic_hdmi_free, |
| .build_pcms = generic_hdmi_build_pcms, |
| .build_controls = generic_hdmi_build_controls, |
| .unsol_event = hdmi_unsol_event, |
| }; |
| |
| static int patch_generic_hdmi(struct hda_codec *codec) |
| { |
| struct hdmi_spec *spec; |
| int i; |
| |
| spec = kzalloc(sizeof(*spec), GFP_KERNEL); |
| if (spec == NULL) |
| return -ENOMEM; |
| |
| codec->spec = spec; |
| if (hdmi_parse_codec(codec) < 0) { |
| codec->spec = NULL; |
| kfree(spec); |
| return -EINVAL; |
| } |
| codec->patch_ops = generic_hdmi_patch_ops; |
| |
| for (i = 0; i < spec->num_pins; i++) |
| snd_hda_eld_proc_new(codec, &spec->sink_eld[i], i); |
| |
| init_channel_allocations(); |
| |
| return 0; |
| } |
| |
| /* |
| * Nvidia specific implementations |
| */ |
| |
| #define Nv_VERB_SET_Channel_Allocation 0xF79 |
| #define Nv_VERB_SET_Info_Frame_Checksum 0xF7A |
| #define Nv_VERB_SET_Audio_Protection_On 0xF98 |
| #define Nv_VERB_SET_Audio_Protection_Off 0xF99 |
| |
| #define nvhdmi_master_con_nid_7x 0x04 |
| #define nvhdmi_master_pin_nid_7x 0x05 |
| |
| static hda_nid_t nvhdmi_con_nids_7x[4] = { |
| /*front, rear, clfe, rear_surr */ |
| 0x6, 0x8, 0xa, 0xc, |
| }; |
| |
| static struct hda_verb nvhdmi_basic_init_7x[] = { |
| /* set audio protect on */ |
| { 0x1, Nv_VERB_SET_Audio_Protection_On, 0x1}, |
| /* enable digital output on pin widget */ |
| { 0x5, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 }, |
| { 0x7, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 }, |
| { 0x9, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 }, |
| { 0xb, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 }, |
| { 0xd, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT | 0x5 }, |
| {} /* terminator */ |
| }; |
| |
| #ifdef LIMITED_RATE_FMT_SUPPORT |
| /* support only the safe format and rate */ |
| #define SUPPORTED_RATES SNDRV_PCM_RATE_48000 |
| #define SUPPORTED_MAXBPS 16 |
| #define SUPPORTED_FORMATS SNDRV_PCM_FMTBIT_S16_LE |
| #else |
| /* support all rates and formats */ |
| #define SUPPORTED_RATES \ |
| (SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |\ |
| SNDRV_PCM_RATE_88200 | SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |\ |
| SNDRV_PCM_RATE_192000) |
| #define SUPPORTED_MAXBPS 24 |
| #define SUPPORTED_FORMATS \ |
| (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S32_LE) |
| #endif |
| |
| static int nvhdmi_7x_init(struct hda_codec *codec) |
| { |
| snd_hda_sequence_write(codec, nvhdmi_basic_init_7x); |
| return 0; |
| } |
| |
| static unsigned int channels_2_6_8[] = { |
| 2, 6, 8 |
| }; |
| |
| static unsigned int channels_2_8[] = { |
| 2, 8 |
| }; |
| |
| static struct snd_pcm_hw_constraint_list hw_constraints_2_6_8_channels = { |
| .count = ARRAY_SIZE(channels_2_6_8), |
| .list = channels_2_6_8, |
| .mask = 0, |
| }; |
| |
| static struct snd_pcm_hw_constraint_list hw_constraints_2_8_channels = { |
| .count = ARRAY_SIZE(channels_2_8), |
| .list = channels_2_8, |
| .mask = 0, |
| }; |
| |
| static int simple_playback_pcm_open(struct hda_pcm_stream *hinfo, |
| struct hda_codec *codec, |
| struct snd_pcm_substream *substream) |
| { |
| struct hdmi_spec *spec = codec->spec; |
| struct snd_pcm_hw_constraint_list *hw_constraints_channels = NULL; |
| |
| switch (codec->preset->id) { |
| case 0x10de0002: |
| case 0x10de0003: |
| case 0x10de0005: |
| case 0x10de0006: |
| hw_constraints_channels = &hw_constraints_2_8_channels; |
| break; |
| case 0x10de0007: |
| hw_constraints_channels = &hw_constraints_2_6_8_channels; |
| break; |
| default: |
| break; |
| } |
| |
| if (hw_constraints_channels != NULL) { |
| snd_pcm_hw_constraint_list(substream->runtime, 0, |
| SNDRV_PCM_HW_PARAM_CHANNELS, |
| hw_constraints_channels); |
| } else { |
| snd_pcm_hw_constraint_step(substream->runtime, 0, |
| SNDRV_PCM_HW_PARAM_CHANNELS, 2); |
| } |
| |
| return snd_hda_multi_out_dig_open(codec, &spec->multiout); |
| } |
| |
| static int simple_playback_pcm_close(struct hda_pcm_stream *hinfo, |
| struct hda_codec *codec, |
| struct snd_pcm_substream *substream) |
| { |
| struct hdmi_spec *spec = codec->spec; |
| return snd_hda_multi_out_dig_close(codec, &spec->multiout); |
| } |
| |
| static int simple_playback_pcm_prepare(struct hda_pcm_stream *hinfo, |
| struct hda_codec *codec, |
| unsigned int stream_tag, |
| unsigned int format, |
| struct snd_pcm_substream *substream) |
| { |
| struct hdmi_spec *spec = codec->spec; |
| return snd_hda_multi_out_dig_prepare(codec, &spec->multiout, |
| stream_tag, format, substream); |
| } |
| |
| static int nvhdmi_8ch_7x_pcm_close(struct hda_pcm_stream *hinfo, |
| struct hda_codec *codec, |
| struct snd_pcm_substream *substream) |
| { |
| struct hdmi_spec *spec = codec->spec; |
| int i; |
| |
| snd_hda_codec_write(codec, nvhdmi_master_con_nid_7x, |
| 0, AC_VERB_SET_CHANNEL_STREAMID, 0); |
| for (i = 0; i < 4; i++) { |
| /* set the stream id */ |
| snd_hda_codec_write(codec, nvhdmi_con_nids_7x[i], 0, |
| AC_VERB_SET_CHANNEL_STREAMID, 0); |
| /* set the stream format */ |
| snd_hda_codec_write(codec, nvhdmi_con_nids_7x[i], 0, |
| AC_VERB_SET_STREAM_FORMAT, 0); |
| } |
| |
| return snd_hda_multi_out_dig_close(codec, &spec->multiout); |
| } |
| |
| static int nvhdmi_8ch_7x_pcm_prepare(struct hda_pcm_stream *hinfo, |
| struct hda_codec *codec, |
| unsigned int stream_tag, |
| unsigned int format, |
| struct snd_pcm_substream *substream) |
| { |
| int chs; |
| unsigned int dataDCC1, dataDCC2, chan, chanmask, channel_id; |
| int i; |
| |
| mutex_lock(&codec->spdif_mutex); |
| |
| chs = substream->runtime->channels; |
| chan = chs ? (chs - 1) : 1; |
| |
| switch (chs) { |
| default: |
| case 0: |
| case 2: |
| chanmask = 0x00; |
| break; |
| case 4: |
| chanmask = 0x08; |
| break; |
| case 6: |
| chanmask = 0x0b; |
| break; |
| case 8: |
| chanmask = 0x13; |
| break; |
| } |
| dataDCC1 = AC_DIG1_ENABLE | AC_DIG1_COPYRIGHT; |
| dataDCC2 = 0x2; |
| |
| /* set the Audio InforFrame Channel Allocation */ |
| snd_hda_codec_write(codec, 0x1, 0, |
| Nv_VERB_SET_Channel_Allocation, chanmask); |
| |
| /* turn off SPDIF once; otherwise the IEC958 bits won't be updated */ |
| if (codec->spdif_status_reset && (codec->spdif_ctls & AC_DIG1_ENABLE)) |
| snd_hda_codec_write(codec, |
| nvhdmi_master_con_nid_7x, |
| 0, |
| AC_VERB_SET_DIGI_CONVERT_1, |
| codec->spdif_ctls & ~AC_DIG1_ENABLE & 0xff); |
| |
| /* set the stream id */ |
| snd_hda_codec_write(codec, nvhdmi_master_con_nid_7x, 0, |
| AC_VERB_SET_CHANNEL_STREAMID, (stream_tag << 4) | 0x0); |
| |
| /* set the stream format */ |
| snd_hda_codec_write(codec, nvhdmi_master_con_nid_7x, 0, |
| AC_VERB_SET_STREAM_FORMAT, format); |
| |
| /* turn on again (if needed) */ |
| /* enable and set the channel status audio/data flag */ |
| if (codec->spdif_status_reset && (codec->spdif_ctls & AC_DIG1_ENABLE)) { |
| snd_hda_codec_write(codec, |
| nvhdmi_master_con_nid_7x, |
| 0, |
| AC_VERB_SET_DIGI_CONVERT_1, |
| codec->spdif_ctls & 0xff); |
| snd_hda_codec_write(codec, |
| nvhdmi_master_con_nid_7x, |
| 0, |
| AC_VERB_SET_DIGI_CONVERT_2, dataDCC2); |
| } |
| |
| for (i = 0; i < 4; i++) { |
| if (chs == 2) |
| channel_id = 0; |
| else |
| channel_id = i * 2; |
| |
| /* turn off SPDIF once; |
| *otherwise the IEC958 bits won't be updated |
| */ |
| if (codec->spdif_status_reset && |
| (codec->spdif_ctls & AC_DIG1_ENABLE)) |
| snd_hda_codec_write(codec, |
| nvhdmi_con_nids_7x[i], |
| 0, |
| AC_VERB_SET_DIGI_CONVERT_1, |
| codec->spdif_ctls & ~AC_DIG1_ENABLE & 0xff); |
| /* set the stream id */ |
| snd_hda_codec_write(codec, |
| nvhdmi_con_nids_7x[i], |
| 0, |
| AC_VERB_SET_CHANNEL_STREAMID, |
| (stream_tag << 4) | channel_id); |
| /* set the stream format */ |
| snd_hda_codec_write(codec, |
| nvhdmi_con_nids_7x[i], |
| 0, |
| AC_VERB_SET_STREAM_FORMAT, |
| format); |
| /* turn on again (if needed) */ |
| /* enable and set the channel status audio/data flag */ |
| if (codec->spdif_status_reset && |
| (codec->spdif_ctls & AC_DIG1_ENABLE)) { |
| snd_hda_codec_write(codec, |
| nvhdmi_con_nids_7x[i], |
| 0, |
| AC_VERB_SET_DIGI_CONVERT_1, |
| codec->spdif_ctls & 0xff); |
| snd_hda_codec_write(codec, |
| nvhdmi_con_nids_7x[i], |
| 0, |
| AC_VERB_SET_DIGI_CONVERT_2, dataDCC2); |
| } |
| } |
| |
| /* set the Audio Info Frame Checksum */ |
| snd_hda_codec_write(codec, 0x1, 0, |
| Nv_VERB_SET_Info_Frame_Checksum, |
| (0x71 - chan - chanmask)); |
| |
| mutex_unlock(&codec->spdif_mutex); |
| return 0; |
| } |
| |
| static struct hda_pcm_stream nvhdmi_pcm_playback_8ch_7x = { |
| .substreams = 1, |
| .channels_min = 2, |
| .channels_max = 8, |
| .nid = nvhdmi_master_con_nid_7x, |
| .rates = SUPPORTED_RATES, |
| .maxbps = SUPPORTED_MAXBPS, |
| .formats = SUPPORTED_FORMATS, |
| .ops = { |
| .open = simple_playback_pcm_open, |
| .close = nvhdmi_8ch_7x_pcm_close, |
| .prepare = nvhdmi_8ch_7x_pcm_prepare |
| }, |
| }; |
| |
| static struct hda_pcm_stream nvhdmi_pcm_playback_2ch = { |
| .substreams = 1, |
| .channels_min = 2, |
| .channels_max = 2, |
| .nid = nvhdmi_master_con_nid_7x, |
| .rates = SUPPORTED_RATES, |
| .maxbps = SUPPORTED_MAXBPS, |
| .formats = SUPPORTED_FORMATS, |
| .ops = { |
| .open = simple_playback_pcm_open, |
| .close = simple_playback_pcm_close, |
| .prepare = simple_playback_pcm_prepare |
| }, |
| }; |
| |
| static struct hda_codec_ops nvhdmi_patch_ops_8ch_7x = { |
| .build_controls = generic_hdmi_build_controls, |
| .build_pcms = generic_hdmi_build_pcms, |
| .init = nvhdmi_7x_init, |
| .free = generic_hdmi_free, |
| }; |
| |
| static struct hda_codec_ops nvhdmi_patch_ops_2ch = { |
| .build_controls = generic_hdmi_build_controls, |
| .build_pcms = generic_hdmi_build_pcms, |
| .init = nvhdmi_7x_init, |
| .free = generic_hdmi_free, |
| }; |
| |
| static int patch_nvhdmi_8ch_89(struct hda_codec *codec) |
| { |
| struct hdmi_spec *spec; |
| int err = patch_generic_hdmi(codec); |
| |
| if (err < 0) |
| return err; |
| spec = codec->spec; |
| spec->old_pin_detect = 1; |
| return 0; |
| } |
| |
| static int patch_nvhdmi_2ch(struct hda_codec *codec) |
| { |
| struct hdmi_spec *spec; |
| |
| spec = kzalloc(sizeof(*spec), GFP_KERNEL); |
| if (spec == NULL) |
| return -ENOMEM; |
| |
| codec->spec = spec; |
| |
| spec->multiout.num_dacs = 0; /* no analog */ |
| spec->multiout.max_channels = 2; |
| spec->multiout.dig_out_nid = nvhdmi_master_con_nid_7x; |
| spec->old_pin_detect = 1; |
| spec->num_cvts = 1; |
| spec->cvt[0] = nvhdmi_master_con_nid_7x; |
| spec->pcm_playback = &nvhdmi_pcm_playback_2ch; |
| |
| codec->patch_ops = nvhdmi_patch_ops_2ch; |
| |
| return 0; |
| } |
| |
| static int patch_nvhdmi_8ch_7x(struct hda_codec *codec) |
| { |
| struct hdmi_spec *spec; |
| int err = patch_nvhdmi_2ch(codec); |
| |
| if (err < 0) |
| return err; |
| spec = codec->spec; |
| spec->multiout.max_channels = 8; |
| spec->pcm_playback = &nvhdmi_pcm_playback_8ch_7x; |
| codec->patch_ops = nvhdmi_patch_ops_8ch_7x; |
| return 0; |
| } |
| |
| /* |
| * ATI-specific implementations |
| * |
| * FIXME: we may omit the whole this and use the generic code once after |
| * it's confirmed to work. |
| */ |
| |
| #define ATIHDMI_CVT_NID 0x02 /* audio converter */ |
| #define ATIHDMI_PIN_NID 0x03 /* HDMI output pin */ |
| |
| static int atihdmi_playback_pcm_prepare(struct hda_pcm_stream *hinfo, |
| struct hda_codec *codec, |
| unsigned int stream_tag, |
| unsigned int format, |
| struct snd_pcm_substream *substream) |
| { |
| struct hdmi_spec *spec = codec->spec; |
| int chans = substream->runtime->channels; |
| int i, err; |
| |
| err = simple_playback_pcm_prepare(hinfo, codec, stream_tag, format, |
| substream); |
| if (err < 0) |
| return err; |
| snd_hda_codec_write(codec, spec->cvt[0], 0, AC_VERB_SET_CVT_CHAN_COUNT, |
| chans - 1); |
| /* FIXME: XXX */ |
| for (i = 0; i < chans; i++) { |
| snd_hda_codec_write(codec, spec->cvt[0], 0, |
| AC_VERB_SET_HDMI_CHAN_SLOT, |
| (i << 4) | i); |
| } |
| return 0; |
| } |
| |
| static struct hda_pcm_stream atihdmi_pcm_digital_playback = { |
| .substreams = 1, |
| .channels_min = 2, |
| .channels_max = 2, |
| .nid = ATIHDMI_CVT_NID, |
| .ops = { |
| .open = simple_playback_pcm_open, |
| .close = simple_playback_pcm_close, |
| .prepare = atihdmi_playback_pcm_prepare |
| }, |
| }; |
| |
| static struct hda_verb atihdmi_basic_init[] = { |
| /* enable digital output on pin widget */ |
| { 0x03, AC_VERB_SET_PIN_WIDGET_CONTROL, PIN_OUT }, |
| {} /* terminator */ |
| }; |
| |
| static int atihdmi_init(struct hda_codec *codec) |
| { |
| struct hdmi_spec *spec = codec->spec; |
| |
| snd_hda_sequence_write(codec, atihdmi_basic_init); |
| /* SI codec requires to unmute the pin */ |
| if (get_wcaps(codec, spec->pin[0]) & AC_WCAP_OUT_AMP) |
| snd_hda_codec_write(codec, spec->pin[0], 0, |
| AC_VERB_SET_AMP_GAIN_MUTE, |
| AMP_OUT_UNMUTE); |
| return 0; |
| } |
| |
| static struct hda_codec_ops atihdmi_patch_ops = { |
| .build_controls = generic_hdmi_build_controls, |
| .build_pcms = generic_hdmi_build_pcms, |
| .init = atihdmi_init, |
| .free = generic_hdmi_free, |
| }; |
| |
| |
| static int patch_atihdmi(struct hda_codec *codec) |
| { |
| struct hdmi_spec *spec; |
| |
| spec = kzalloc(sizeof(*spec), GFP_KERNEL); |
| if (spec == NULL) |
| return -ENOMEM; |
| |
| codec->spec = spec; |
| |
| spec->multiout.num_dacs = 0; /* no analog */ |
| spec->multiout.max_channels = 2; |
| spec->multiout.dig_out_nid = ATIHDMI_CVT_NID; |
| spec->num_cvts = 1; |
| spec->cvt[0] = ATIHDMI_CVT_NID; |
| spec->pin[0] = ATIHDMI_PIN_NID; |
| spec->pcm_playback = &atihdmi_pcm_digital_playback; |
| |
| codec->patch_ops = atihdmi_patch_ops; |
| |
| return 0; |
| } |
| |
| |
| /* |
| * patch entries |
| */ |
| static struct hda_codec_preset snd_hda_preset_hdmi[] = { |
| { .id = 0x1002793c, .name = "RS600 HDMI", .patch = patch_atihdmi }, |
| { .id = 0x10027919, .name = "RS600 HDMI", .patch = patch_atihdmi }, |
| { .id = 0x1002791a, .name = "RS690/780 HDMI", .patch = patch_atihdmi }, |
| { .id = 0x1002aa01, .name = "R6xx HDMI", .patch = patch_generic_hdmi }, |
| { .id = 0x10951390, .name = "SiI1390 HDMI", .patch = patch_generic_hdmi }, |
| { .id = 0x10951392, .name = "SiI1392 HDMI", .patch = patch_generic_hdmi }, |
| { .id = 0x17e80047, .name = "Chrontel HDMI", .patch = patch_generic_hdmi }, |
| { .id = 0x10de0002, .name = "MCP77/78 HDMI", .patch = patch_nvhdmi_8ch_7x }, |
| { .id = 0x10de0003, .name = "MCP77/78 HDMI", .patch = patch_nvhdmi_8ch_7x }, |
| { .id = 0x10de0005, .name = "MCP77/78 HDMI", .patch = patch_nvhdmi_8ch_7x }, |
| { .id = 0x10de0006, .name = "MCP77/78 HDMI", .patch = patch_nvhdmi_8ch_7x }, |
| { .id = 0x10de0007, .name = "MCP79/7A HDMI", .patch = patch_nvhdmi_8ch_7x }, |
| { .id = 0x10de000a, .name = "GPU 0a HDMI/DP", .patch = patch_nvhdmi_8ch_89 }, |
| { .id = 0x10de000b, .name = "GPU 0b HDMI/DP", .patch = patch_nvhdmi_8ch_89 }, |
| { .id = 0x10de000c, .name = "MCP89 HDMI", .patch = patch_nvhdmi_8ch_89 }, |
| { .id = 0x10de000d, .name = "GPU 0d HDMI/DP", .patch = patch_nvhdmi_8ch_89 }, |
| { .id = 0x10de0010, .name = "GPU 10 HDMI/DP", .patch = patch_nvhdmi_8ch_89 }, |
| { .id = 0x10de0011, .name = "GPU 11 HDMI/DP", .patch = patch_nvhdmi_8ch_89 }, |
| { .id = 0x10de0012, .name = "GPU 12 HDMI/DP", .patch = patch_nvhdmi_8ch_89 }, |
| { .id = 0x10de0013, .name = "GPU 13 HDMI/DP", .patch = patch_nvhdmi_8ch_89 }, |
| { .id = 0x10de0014, .name = "GPU 14 HDMI/DP", .patch = patch_nvhdmi_8ch_89 }, |
| { .id = 0x10de0018, .name = "GPU 18 HDMI/DP", .patch = patch_nvhdmi_8ch_89 }, |
| { .id = 0x10de0019, .name = "GPU 19 HDMI/DP", .patch = patch_nvhdmi_8ch_89 }, |
| { .id = 0x10de001a, .name = "GPU 1a HDMI/DP", .patch = patch_nvhdmi_8ch_89 }, |
| { .id = 0x10de001b, .name = "GPU 1b HDMI/DP", .patch = patch_nvhdmi_8ch_89 }, |
| { .id = 0x10de001c, .name = "GPU 1c HDMI/DP", .patch = patch_nvhdmi_8ch_89 }, |
| { .id = 0x10de0040, .name = "GPU 40 HDMI/DP", .patch = patch_nvhdmi_8ch_89 }, |
| { .id = 0x10de0041, .name = "GPU 41 HDMI/DP", .patch = patch_nvhdmi_8ch_89 }, |
| { .id = 0x10de0042, .name = "GPU 42 HDMI/DP", .patch = patch_nvhdmi_8ch_89 }, |
| { .id = 0x10de0043, .name = "GPU 43 HDMI/DP", .patch = patch_nvhdmi_8ch_89 }, |
| { .id = 0x10de0044, .name = "GPU 44 HDMI/DP", .patch = patch_nvhdmi_8ch_89 }, |
| { .id = 0x10de0067, .name = "MCP67 HDMI", .patch = patch_nvhdmi_2ch }, |
| { .id = 0x10de8001, .name = "MCP73 HDMI", .patch = patch_nvhdmi_2ch }, |
| { .id = 0x80860054, .name = "IbexPeak HDMI", .patch = patch_generic_hdmi }, |
| { .id = 0x80862801, .name = "Bearlake HDMI", .patch = patch_generic_hdmi }, |
| { .id = 0x80862802, .name = "Cantiga HDMI", .patch = patch_generic_hdmi }, |
| { .id = 0x80862803, .name = "Eaglelake HDMI", .patch = patch_generic_hdmi }, |
| { .id = 0x80862804, .name = "IbexPeak HDMI", .patch = patch_generic_hdmi }, |
| { .id = 0x80862805, .name = "CougarPoint HDMI", .patch = patch_generic_hdmi }, |
| { .id = 0x808629fb, .name = "Crestline HDMI", .patch = patch_generic_hdmi }, |
| {} /* terminator */ |
| }; |
| |
| MODULE_ALIAS("snd-hda-codec-id:1002793c"); |
| MODULE_ALIAS("snd-hda-codec-id:10027919"); |
| MODULE_ALIAS("snd-hda-codec-id:1002791a"); |
| MODULE_ALIAS("snd-hda-codec-id:1002aa01"); |
| MODULE_ALIAS("snd-hda-codec-id:10951390"); |
| MODULE_ALIAS("snd-hda-codec-id:10951392"); |
| MODULE_ALIAS("snd-hda-codec-id:10de0002"); |
| MODULE_ALIAS("snd-hda-codec-id:10de0003"); |
| MODULE_ALIAS("snd-hda-codec-id:10de0005"); |
| MODULE_ALIAS("snd-hda-codec-id:10de0006"); |
| MODULE_ALIAS("snd-hda-codec-id:10de0007"); |
| MODULE_ALIAS("snd-hda-codec-id:10de000a"); |
| MODULE_ALIAS("snd-hda-codec-id:10de000b"); |
| MODULE_ALIAS("snd-hda-codec-id:10de000c"); |
| MODULE_ALIAS("snd-hda-codec-id:10de000d"); |
| MODULE_ALIAS("snd-hda-codec-id:10de0010"); |
| MODULE_ALIAS("snd-hda-codec-id:10de0011"); |
| MODULE_ALIAS("snd-hda-codec-id:10de0012"); |
| MODULE_ALIAS("snd-hda-codec-id:10de0013"); |
| MODULE_ALIAS("snd-hda-codec-id:10de0014"); |
| MODULE_ALIAS("snd-hda-codec-id:10de0018"); |
| MODULE_ALIAS("snd-hda-codec-id:10de0019"); |
| MODULE_ALIAS("snd-hda-codec-id:10de001a"); |
| MODULE_ALIAS("snd-hda-codec-id:10de001b"); |
| MODULE_ALIAS("snd-hda-codec-id:10de001c"); |
| MODULE_ALIAS("snd-hda-codec-id:10de0040"); |
| MODULE_ALIAS("snd-hda-codec-id:10de0041"); |
| MODULE_ALIAS("snd-hda-codec-id:10de0042"); |
| MODULE_ALIAS("snd-hda-codec-id:10de0043"); |
| MODULE_ALIAS("snd-hda-codec-id:10de0044"); |
| MODULE_ALIAS("snd-hda-codec-id:10de0067"); |
| MODULE_ALIAS("snd-hda-codec-id:10de8001"); |
| MODULE_ALIAS("snd-hda-codec-id:17e80047"); |
| MODULE_ALIAS("snd-hda-codec-id:80860054"); |
| MODULE_ALIAS("snd-hda-codec-id:80862801"); |
| MODULE_ALIAS("snd-hda-codec-id:80862802"); |
| MODULE_ALIAS("snd-hda-codec-id:80862803"); |
| MODULE_ALIAS("snd-hda-codec-id:80862804"); |
| MODULE_ALIAS("snd-hda-codec-id:80862805"); |
| MODULE_ALIAS("snd-hda-codec-id:808629fb"); |
| |
| MODULE_LICENSE("GPL"); |
| MODULE_DESCRIPTION("HDMI HD-audio codec"); |
| MODULE_ALIAS("snd-hda-codec-intelhdmi"); |
| MODULE_ALIAS("snd-hda-codec-nvhdmi"); |
| MODULE_ALIAS("snd-hda-codec-atihdmi"); |
| |
| static struct hda_codec_preset_list intel_list = { |
| .preset = snd_hda_preset_hdmi, |
| .owner = THIS_MODULE, |
| }; |
| |
| static int __init patch_hdmi_init(void) |
| { |
| return snd_hda_add_codec_preset(&intel_list); |
| } |
| |
| static void __exit patch_hdmi_exit(void) |
| { |
| snd_hda_delete_codec_preset(&intel_list); |
| } |
| |
| module_init(patch_hdmi_init) |
| module_exit(patch_hdmi_exit) |