[Feature]Upload Modem source code
Change-Id: Id4294f30faced84d3e6fd6d5e61e1111bf287a37
diff --git a/mcu/driver/audio/src/v1/sp_gain.c b/mcu/driver/audio/src/v1/sp_gain.c
new file mode 100644
index 0000000..d00bab7
--- /dev/null
+++ b/mcu/driver/audio/src/v1/sp_gain.c
@@ -0,0 +1,285 @@
+/*****************************************************************************
+* Copyright Statement:
+* --------------------
+* This software is protected by Copyright and the information contained
+* herein is confidential. The software may not be copied and the information
+* contained herein may not be used or disclosed except with the written
+* permission of MediaTek Inc. (C) 2017
+*
+* BY OPENING THIS FILE, BUYER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
+* THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
+* RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO BUYER ON
+* AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL WARRANTIES,
+* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED WARRANTIES OF
+* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR NONINFRINGEMENT.
+* NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH RESPECT TO THE
+* SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY, INCORPORATED IN, OR
+* SUPPLIED WITH THE MEDIATEK SOFTWARE, AND BUYER AGREES TO LOOK ONLY TO SUCH
+* THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO. MEDIATEK SHALL ALSO
+* NOT BE RESPONSIBLE FOR ANY MEDIATEK SOFTWARE RELEASES MADE TO BUYER'S
+* SPECIFICATION OR TO CONFORM TO A PARTICULAR STANDARD OR OPEN FORUM.
+*
+* BUYER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S ENTIRE AND CUMULATIVE
+* LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE RELEASED HEREUNDER WILL BE,
+* AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE MEDIATEK SOFTWARE AT ISSUE,
+* OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE CHARGE PAID BY BUYER TO
+* MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
+*
+* THE TRANSACTION CONTEMPLATED HEREUNDER SHALL BE CONSTRUED IN ACCORDANCE
+* WITH THE LAWS OF THE STATE OF CALIFORNIA, USA, EXCLUDING ITS CONFLICT OF
+* LAWS PRINCIPLES. ANY DISPUTES, CONTROVERSIES OR CLAIMS ARISING THEREOF AND
+* RELATED THERETO SHALL BE SETTLED BY ARBITRATION IN SAN FRANCISCO, CA, UNDER
+* THE RULES OF THE INTERNATIONAL CHAMBER OF COMMERCE (ICC).
+*
+*****************************************************************************/
+
+/*******************************************************************************
+ *
+ * Filename:
+ * ---------
+ * sp_gain.c
+ *
+ * Project:
+ * --------
+ * MAUI
+ *
+ * Description:
+ * ------------
+ *
+ *
+ * Author:
+ * -------
+ *
+ *==============================================================================
+ * HISTORY
+ * Below this line, this part is controlled by PVCS VM. DO NOT MODIFY!!
+ *------------------------------------------------------------------------------
+ * removed!
+ * removed!
+ * removed!
+ *
+ *------------------------------------------------------------------------------
+ * Upper this line, this part is controlled by PVCS VM. DO NOT MODIFY!!
+ *==============================================================================
+ *******************************************************************************/
+
+#include "kal_public_api.h"
+#include "kal_general_types.h"
+#include "kal_trace.h"
+
+#include "l1sp_trc.h"
+
+#include "l1audio.h"
+#include "am.h"
+
+static struct {
+
+ kal_int16 digitOnly_digital_gain;
+ kal_int16 digitOnly_sphEnhRef_digital_gain;
+ kal_int16 digitOnly_mic_volume;
+
+}spGain;
+
+
+const kal_uint16 digitOnly_quater_dB_tableForSpeech[296] =
+{
+ 10289, 9997, 9713, 9438, /* 8 ~ 7.25 dB*/
+ 9170, 8910, 8657, 8411, /* 7 ~ 6.25 dB*/
+ 8173, 7941, 7715, 7497, /* 6 ~ 5.25 dB*/
+ 7284, 7077, 6876, 6681, /* 5 ~ 4.25 dB*/
+ 6492, 6308, 6129, 5955, /* 4 ~ 3.25 dB*/
+ 5786, 5622, 5462, 5307, /* 3 ~ 2.25 dB*/
+ 5120, 5010, 4868, 4730, /* 2 ~ 1.25 dB*/ // uplink begin (2 db == 5120 == 0x1400)
+ 4596, 4465, 4339, 4216, /* 1 ~ 0.25 dB*/
+ 4096, 3980, 3867, 3757, /* 0 ~ -0.75 dB*/ // downlink begin (0 db == 4096 == 0x1000) ==> chip newer then MT6572
+ 3645, 3547, 3446, 3349, /* -1 ~ -1.75 dB*/ // downlink begin (-1db == 3645 == 0xE3D) ==> Old chip MT6280 & MT6589
+ 3254, 3161, 3072, 2984, /* -2 ~ -2.75 dB*/
+ 2900, 2817, 2738, 2660, /* -3 ~ -3.75 dB*/
+ 2584, 2511, 2440, 2371, /* -4 ~ -4.75 dB*/
+ 2303, 2238, 2175, 2113, /* -5 ~ -5.75 dB*/
+ 2053, 1995, 1938, 1883, /* -6 ~ -6.75 dB*/
+ 1830, 1778, 1727, 1678, /* -7 ~ -7.75 dB*/
+ 1631, 1584, 1539, 1496, /* -8 ~ -8.75 dB*/
+ 1453, 1412, 1372, 1333, /* -9 ~ -9.75 dB*/
+ 1295, 1259, 1223, 1188, /* -10 ~ -10.75 dB*/
+ 1154, 1122, 1090, 1059, /* -11 ~ -11.75 dB*/
+ 1029, 1000, 971 , 944 , /* -12 ~ -12.75 dB*/
+ 917 , 891 , 866 , 841 , /* -13 ~ -13.75 dB*/
+ 817 , 794 , 772 , 750 , /* -14 ~ -14.75 dB*/
+ 728 , 708 , 688 , 668 , /* -15 ~ -15.75 dB*/
+ 649 , 631 , 613 , 595 , /* -16 ~ -16.75 dB*/
+ 579 , 562 , 546 , 531 , /* -17 ~ -17.75 dB*/
+ 516 , 501 , 487 , 473 , /* -18 ~ -18.75 dB*/
+ 460 , 447 , 434 , 422 , /* -19 ~ -19.75 dB*/
+ 410 , 398 , 387 , 376 , /* -20 ~ -20.75 dB*/
+ 365 , 355 , 345 , 335 , /* -21 ~ -21.75 dB*/
+ 325 , 316 , 307 , 298 , /* -22 ~ -22.75 dB*/
+ 290 , 282 , 274 , 266 , /* -23 ~ -23.75 dB*/
+ 258 , 251 , 244 , 237 , /* -24 ~ -24.75 dB*/
+ 230 , 224 , 217 , 211 , /* -25 ~ -25.75 dB*/
+ 205 , 199 , 194 , 188 , /* -26 ~ -26.75 dB*/
+ 183 , 178 , 173 , 168 , /* -27 ~ -27.75 dB*/
+ 163 , 158 , 154 , 150 , /* -28 ~ -28.75 dB*/
+ 145 , 141 , 137 , 133 , /* -29 ~ -29.75 dB*/
+ 130 , 126 , 122 , 119 , /* -30 ~ -30.75 dB*/
+ 115 , 112 , 109 , 106 , /* -31 ~ -31.75 dB*/
+ 103 , 100 , 97 , 94 , /* -32 ~ -32.75 dB*/
+ 92 , 89 , 87 , 84 , /* -33 ~ -33.75 dB*/
+ 82 , 79 , 77 , 75 , /* -34 ~ -34.75 dB*/
+ 73 , 71 , 69 , 67 , /* -35 ~ -35.75 dB*/
+ 65 , 63 , 61 , 60 , /* -36 ~ -36.75 dB*/
+ 58 , 56 , 55 , 53 , /* -37 ~ -37.75 dB*/
+ 52 , 50 , 49 , 47 , /* -38 ~ -38.75 dB*/
+ 46 , 45 , 43 , 42 , /* -39 ~ -39.75 dB*/
+ 41 , 40 , 39 , 38 , /* -40 ~ -40.75 dB*/
+ 37 , 35 , 34 , 33 , /* -41 ~ -41.75 dB*/
+ 33 , 32 , 31 , 30 , /* -42 ~ -42.75 dB*/
+ 29 , 28 , 27 , 27 , /* -43 ~ -43.75 dB*/
+ 26 , 25 , 24 , 24 , /* -44 ~ -44.75 dB*/
+ 23 , 22 , 22 , 21 , /* -45 ~ -45.75 dB*/
+ 21 , 20 , 19 , 19 , /* -46 ~ -46.75 dB*/
+ 18 , 18 , 17 , 17 , /* -47 ~ -47.75 dB*/
+ 16 , 16 , 15 , 15 , /* -48 ~ -48.75 dB*/
+ 15 , 14 , 14 , 13 , /* -49 ~ -49.75 dB*/
+ 13 , 13 , 12 , 12 , /* -50 ~ -50.75 dB*/
+ 12 , 11 , 11 , 11 , /* -51 ~ -51.75 dB*/
+ 10 , 10 , 10 , 9 , /* -52 ~ -52.75 dB*/
+ 9 , 9 , 9 , 8 , /* -53 ~ -53.75 dB*/
+ 8 , 8 , 8 , 7 , /* -54 ~ -54.75 dB*/
+ 7 , 7 , 7 , 7 , /* -55 ~ -55.75 dB*/
+ 6 , 6 , 6 , 6 , /* -56 ~ -56.75 dB*/
+ 6 , 6 , 5 , 5 , /* -57 ~ -57.75 dB*/
+ 5 , 5 , 5 , 5 , /* -58 ~ -58.75 dB*/
+ 5 , 4 , 4 , 4 , /* -59 ~ -59.75 dB*/
+ 4 , 4 , 4 , 4 , /* -60 ~ -60.75 dB*/
+ 4 , 4 , 3 , 3 , /* -61 ~ -61.75 dB*/
+ 3 , 3 , 3 , 3 , /* -62 ~ -62.75 dB*/
+ 3 , 3 , 3 , 3 , /* -63 ~ -63.75 dB*/
+ 3 , 3 , 2 , 2 , /* -64 ~ -64.75 dB*/
+ 2 , 2 , 2 , 2 , /* -65 ~ -65.75 dB*/
+};
+
+/**
+ Only use when MODEM do not have analog device, ie. ANALOG_AFE_PATH_EXIST is NOT defined
+
+ @digitalGainQDb: input digital gain value in dB. 4 step/1db.
+ for example: digitalGainDb=1 --> 0.25 dB; digitalGainDb=FFF4(-12) --> -3dB
+ @isDL: true for downlink, false for uplink
+ @return: value set to dsp
+
+*/
+kal_uint16 _digitOnly_convert_digital_gain_forSpeech(kal_int16 digitalGainQDb, kal_bool isDl)
+{
+ kal_int16 idx = (-digitalGainQDb);
+
+ if(isDl){
+#if 0
+/* under construction !*/
+/* under construction !*/
+#else // data card chip should begin from 0
+ idx += 32; // begin from 0 db
+#endif
+ } else {
+ // for UL. useless now
+ }
+
+ return digitOnly_quater_dB_tableForSpeech[idx];
+
+}
+
+//=============================================================================
+/**
+ @digitalGainQdB: input digital gain value in quarter dB, i.e. 4 step/1db.
+ for example: digitalGainDb=1 --> 0.25 dB; digitalGainDb=FFF4(-12) --> -3dB
+*/
+// void AFE_DigitalOnly_SetDigitalGain(kal_uint8 aud_func, kal_int16 digitalGainQdB, kal_bool isForceSet)
+void spGain_SetDigitalGain(kal_int16 digitalGainQdB, kal_bool isForceSet)
+{
+ MD_TRC_AFE_SET_GIDI_GAIN(digitalGainQdB, isForceSet);
+ ASSERT((digitalGainQdB)<=0 && (digitalGainQdB>=-256)); // value frome -64 db to 0 db
+
+ spGain.digitOnly_digital_gain = _digitOnly_convert_digital_gain_forSpeech(digitalGainQdB, true);
+
+ if(AM_IsAmInSpeechState()) {
+ AM_DSP_SetSpeechDigitalGain(spGain.digitOnly_digital_gain );
+ } else if (isForceSet) {
+ uint16 aid = L1Audio_GetAudioID();
+ L1Audio_SetFlag( aid );
+
+ AM_DSP_SetSpeechDigitalGain(spGain.digitOnly_digital_gain );
+
+ L1Audio_ClearFlag( aid );
+ L1Audio_FreeAudioID( aid );
+ }
+}
+
+
+
+/**
+
+ @digitalGainQdB: input digital gain value in quarter dB, i.e. 4 step/1db.
+ for example: digitalGainDb=1 --> 0.25 dB; digitalGainDb=FFF4(-12) --> -3dB
+*/
+void spGain_SetEnhRefDigitalGain(kal_int16 refDigitalGainQdB, kal_bool isForceSet)
+{
+ MD_TRC_AFE_SET_SPH_REF_GIDI_GAIN(refDigitalGainQdB);
+ ASSERT((refDigitalGainQdB)<=0 && (refDigitalGainQdB>=-28)); // value from -7 db to 0 db
+
+ spGain.digitOnly_sphEnhRef_digital_gain = _digitOnly_convert_digital_gain_forSpeech(refDigitalGainQdB, true);
+
+ if(AM_IsAmInSpeechState()) {
+ AM_DSP_SetSpeechEnhRefDigitalGain(spGain.digitOnly_sphEnhRef_digital_gain);
+ } else if (isForceSet) {
+ uint16 aid = L1Audio_GetAudioID();
+ L1Audio_SetFlag( aid );
+
+ AM_DSP_SetSpeechEnhRefDigitalGain(spGain.digitOnly_sphEnhRef_digital_gain );
+
+ L1Audio_ClearFlag( aid );
+ L1Audio_FreeAudioID( aid );
+ }
+}
+
+void spGain_SetMicrophoneVolume( kal_int16 mic_volume, kal_bool isForceSet )
+{
+ MD_TRC_AFE_SET_MIC_VOLUME(mic_volume);
+ ASSERT((mic_volume)>=0 && (mic_volume<=120)); // range is 0~ 30 dB
+
+ spGain.digitOnly_mic_volume = (mic_volume>>2); // 4 is 1 db
+ if(AM_IsAmInSpeechState()) {
+ AM_DSP_SetSpeechUplinkSwAgcGain(spGain.digitOnly_mic_volume);
+ } else if (isForceSet) {
+ uint16 aid = L1Audio_GetAudioID();
+ L1Audio_SetFlag( aid );
+
+ AM_DSP_SetSpeechUplinkSwAgcGain(spGain.digitOnly_mic_volume);
+
+ L1Audio_ClearFlag( aid );
+ L1Audio_FreeAudioID( aid );
+ }
+}
+
+
+// ============================================================================
+void spGain_Refresh2DSP(void)
+{
+ uint16 aid = L1Audio_GetAudioID();
+ L1Audio_SetFlag( aid );
+
+ AM_DSP_SetSpeechDigitalGain(spGain.digitOnly_digital_gain );
+ AM_DSP_SetSpeechEnhRefDigitalGain(spGain.digitOnly_sphEnhRef_digital_gain );
+ AM_DSP_SetSpeechUplinkSwAgcGain(spGain.digitOnly_mic_volume);
+
+ L1Audio_ClearFlag( aid );
+ L1Audio_FreeAudioID( aid );
+}
+
+void spGain_Init(void)
+{
+ spGain.digitOnly_digital_gain = 0x1000; // 0 dB in DSP
+ spGain.digitOnly_sphEnhRef_digital_gain = 0x1000; // 0 dB in DSP
+ spGain.digitOnly_mic_volume = 0;
+
+ spGain_Refresh2DSP();
+}
+