216 lines · c
1/*2 * Copyright 2020 Advanced Micro Devices, Inc.3 *4 * Permission is hereby granted, free of charge, to any person obtaining a5 * copy of this software and associated documentation files (the "Software"),6 * to deal in the Software without restriction, including without limitation7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,8 * and/or sell copies of the Software, and to permit persons to whom the9 * Software is furnished to do so, subject to the following conditions:10 *11 * The above copyright notice and this permission notice shall be included in12 * all copies or substantial portions of the Software.13 *14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL17 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR18 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR20 * OTHER DEALINGS IN THE SOFTWARE.21 *22 * Authors: AMD23 *24 */25 26 27#include "dc_bios_types.h"28#include "hw_shared.h"29#include "dcn30_afmt.h"30#include "reg_helper.h"31 32#define DC_LOGGER \33 afmt3->base.ctx->logger34 35#define REG(reg)\36 (afmt3->regs->reg)37 38#undef FN39#define FN(reg_name, field_name) \40 afmt3->afmt_shift->field_name, afmt3->afmt_mask->field_name41 42 43#define CTX \44 afmt3->base.ctx45 46 47void afmt3_setup_hdmi_audio(48 struct afmt *afmt)49{50 struct dcn30_afmt *afmt3 = DCN30_AFMT_FROM_AFMT(afmt);51 52 if (afmt->funcs->afmt_poweron)53 afmt->funcs->afmt_poweron(afmt);54 55 /* AFMT_AUDIO_PACKET_CONTROL */56 REG_UPDATE(AFMT_AUDIO_PACKET_CONTROL, AFMT_60958_CS_UPDATE, 1);57 58 /* AFMT_AUDIO_PACKET_CONTROL2 */59 REG_UPDATE_2(AFMT_AUDIO_PACKET_CONTROL2,60 AFMT_AUDIO_LAYOUT_OVRD, 0,61 AFMT_60958_OSF_OVRD, 0);62 63 /* AFMT_60958_0__AFMT_60958_CS_CHANNEL_NUMBER_L_MASK &64 * AFMT_60958_0__AFMT_60958_CS_CLOCK_ACCURACY_MASK65 */66 REG_UPDATE_2(AFMT_60958_0,67 AFMT_60958_CS_CHANNEL_NUMBER_L, 1,68 AFMT_60958_CS_CLOCK_ACCURACY, 0);69 70 /* AFMT_60958_1 AFMT_60958_CS_CHALNNEL_NUMBER_R */71 REG_UPDATE(AFMT_60958_1, AFMT_60958_CS_CHANNEL_NUMBER_R, 2);72 73 /* AFMT_60958_2 now keep this settings until74 * Programming guide comes out75 */76 REG_UPDATE_6(AFMT_60958_2,77 AFMT_60958_CS_CHANNEL_NUMBER_2, 3,78 AFMT_60958_CS_CHANNEL_NUMBER_3, 4,79 AFMT_60958_CS_CHANNEL_NUMBER_4, 5,80 AFMT_60958_CS_CHANNEL_NUMBER_5, 6,81 AFMT_60958_CS_CHANNEL_NUMBER_6, 7,82 AFMT_60958_CS_CHANNEL_NUMBER_7, 8);83}84 85static union audio_cea_channels speakers_to_channels(86 struct audio_speaker_flags speaker_flags)87{88 union audio_cea_channels cea_channels = {0};89 90 /* these are one to one */91 cea_channels.channels.FL = speaker_flags.FL_FR;92 cea_channels.channels.FR = speaker_flags.FL_FR;93 cea_channels.channels.LFE = speaker_flags.LFE;94 cea_channels.channels.FC = speaker_flags.FC;95 96 /* if Rear Left and Right exist move RC speaker to channel 797 * otherwise to channel 598 */99 if (speaker_flags.RL_RR) {100 cea_channels.channels.RL_RC = speaker_flags.RL_RR;101 cea_channels.channels.RR = speaker_flags.RL_RR;102 cea_channels.channels.RC_RLC_FLC = speaker_flags.RC;103 } else {104 cea_channels.channels.RL_RC = speaker_flags.RC;105 }106 107 /* FRONT Left Right Center and REAR Left Right Center are exclusive */108 if (speaker_flags.FLC_FRC) {109 cea_channels.channels.RC_RLC_FLC = speaker_flags.FLC_FRC;110 cea_channels.channels.RRC_FRC = speaker_flags.FLC_FRC;111 } else {112 cea_channels.channels.RC_RLC_FLC = speaker_flags.RLC_RRC;113 cea_channels.channels.RRC_FRC = speaker_flags.RLC_RRC;114 }115 116 return cea_channels;117}118 119void afmt3_se_audio_setup(120 struct afmt *afmt,121 unsigned int az_inst,122 struct audio_info *audio_info)123{124 struct dcn30_afmt *afmt3 = DCN30_AFMT_FROM_AFMT(afmt);125 126 uint32_t channels = 0;127 128 ASSERT(audio_info);129 /* This should not happen.it does so we don't get BSOD*/130 if (audio_info == NULL)131 return;132 133 channels = speakers_to_channels(audio_info->flags.speaker_flags).all;134 135 /* setup the audio stream source select (audio -> dig mapping) */136 REG_SET(AFMT_AUDIO_SRC_CONTROL, 0, AFMT_AUDIO_SRC_SELECT, az_inst);137 138 /* Channel allocation */139 REG_UPDATE(AFMT_AUDIO_PACKET_CONTROL2, AFMT_AUDIO_CHANNEL_ENABLE, channels);140 141 /* Disable forced mem power off */142 if (afmt->funcs->afmt_poweron == NULL)143 REG_UPDATE(AFMT_MEM_PWR, AFMT_MEM_PWR_FORCE, 0);144}145 146void afmt3_audio_mute_control(147 struct afmt *afmt,148 bool mute)149{150 struct dcn30_afmt *afmt3 = DCN30_AFMT_FROM_AFMT(afmt);151 if (mute && afmt->funcs->afmt_powerdown)152 afmt->funcs->afmt_powerdown(afmt);153 if (!mute && afmt->funcs->afmt_poweron)154 afmt->funcs->afmt_poweron(afmt);155 /* enable/disable transmission of audio packets */156 REG_UPDATE(AFMT_AUDIO_PACKET_CONTROL, AFMT_AUDIO_SAMPLE_SEND, !mute);157}158 159void afmt3_audio_info_immediate_update(160 struct afmt *afmt)161{162 struct dcn30_afmt *afmt3 = DCN30_AFMT_FROM_AFMT(afmt);163 164 /* update double-buffered AUDIO_INFO registers immediately */165 REG_UPDATE(AFMT_INFOFRAME_CONTROL0, AFMT_AUDIO_INFO_UPDATE, 1);166}167 168void afmt3_setup_dp_audio(169 struct afmt *afmt)170{171 struct dcn30_afmt *afmt3 = DCN30_AFMT_FROM_AFMT(afmt);172 173 if (afmt->funcs->afmt_poweron)174 afmt->funcs->afmt_poweron(afmt);175 176 /* AFMT_AUDIO_PACKET_CONTROL */177 REG_UPDATE(AFMT_AUDIO_PACKET_CONTROL, AFMT_60958_CS_UPDATE, 1);178 179 /* AFMT_AUDIO_PACKET_CONTROL2 */180 /* Program the ATP and AIP next */181 REG_UPDATE_2(AFMT_AUDIO_PACKET_CONTROL2,182 AFMT_AUDIO_LAYOUT_OVRD, 0,183 AFMT_60958_OSF_OVRD, 0);184 185 /* AFMT_INFOFRAME_CONTROL0 */186 REG_UPDATE(AFMT_INFOFRAME_CONTROL0, AFMT_AUDIO_INFO_UPDATE, 1);187 188 /* AFMT_60958_0__AFMT_60958_CS_CLOCK_ACCURACY_MASK */189 REG_UPDATE(AFMT_60958_0, AFMT_60958_CS_CLOCK_ACCURACY, 0);190}191 192static struct afmt_funcs dcn30_afmt_funcs = {193 .setup_hdmi_audio = afmt3_setup_hdmi_audio,194 .se_audio_setup = afmt3_se_audio_setup,195 .audio_mute_control = afmt3_audio_mute_control,196 .audio_info_immediate_update = afmt3_audio_info_immediate_update,197 .setup_dp_audio = afmt3_setup_dp_audio,198};199 200void afmt3_construct(struct dcn30_afmt *afmt3,201 struct dc_context *ctx,202 uint32_t inst,203 const struct dcn30_afmt_registers *afmt_regs,204 const struct dcn30_afmt_shift *afmt_shift,205 const struct dcn30_afmt_mask *afmt_mask)206{207 afmt3->base.ctx = ctx;208 209 afmt3->base.inst = inst;210 afmt3->base.funcs = &dcn30_afmt_funcs;211 212 afmt3->regs = afmt_regs;213 afmt3->afmt_shift = afmt_shift;214 afmt3->afmt_mask = afmt_mask;215}216