Add Digital Gain Mixer Control Interface to Algorithm(Receiver Mode)SAMSUNG_A72_1.3.6.2

3 files changed, 111 insertions, 3 deletions

diff --git a/tas256x_driver/algo/inc/tas_smart_amp_v2.h b/tas256x_driver/algo/inc/tas_smart_amp_v2.h
index 35b3f57..950e66b 100644
--- a/tas256x_driver/algo/inc/tas_smart_amp_v2.h
+++ b/tas256x_driver/algo/inc/tas_smart_amp_v2.h
@@ -98,6 +98,7 @@ typedef enum {
 #define TAS_SA_SET_INTERFACE_MODE 3836
 #define TAS_PCM_CHANNEL_MAPPING 3837
 #define TAS_SA_GET_RE_RANGE   3838
+#define TAS_SA_DIGITAL_GAIN   3839
 
 /*Added for DC Detection*/
 #define CAPI_V2_TAS_SA_DC_DETECT 0x40404040
@@ -152,6 +153,7 @@ bool tas25xx_set_iv_bit_fomat(int iv_data_with, int vbat, int update_now);
 int get_iv_vbat_format(void);
 
 void tas25xx_send_channel_mapping(void);
+void tas25xx_algo_enable_common_controls(int value);
 
 #if IS_ENABLED(CONFIG_TISA_KBIN_INTF)
 void tas25xx_algo_set_active(void);
@@ -159,8 +161,11 @@ void tas25xx_algo_set_inactive(void);
 void tas_smartamp_kbin_deinitalize(void);
 #endif /* CONFIG_TISA_KBIN_INTF */
 
-#if IS_ENABLED(CONFIG_TAS25XX_CALIB_VAL_BIG)
+#if IS_ENABLED(CONFIG_TAS25XX_CALIB_VAL_BIG) || IS_ENABLED(CONFIG_TISA_DEBUGFS_INTF)
 void tas25xx_send_algo_calibration(void);
+#endif
+
+#if IS_ENABLED(CONFIG_TAS25XX_CALIB_VAL_BIG)
 void tas25xx_update_big_data(void);
 #endif
 
diff --git a/tas256x_driver/algo/src/tas25xx-algo-common.c b/tas256x_driver/algo/src/tas25xx-algo-common.c
index 0ca2bb0..9639694 100644
--- a/tas256x_driver/algo/src/tas25xx-algo-common.c
+++ b/tas256x_driver/algo/src/tas25xx-algo-common.c
@@ -55,6 +55,12 @@ void tas_smartamp_remove_algo_controls_debugfs(struct snd_soc_codec *codec);
 static int32_t g_fmt;
 static struct device *s_device;
 static char s_channel_map[TDM_MAX_CHANNELS] = {0, 1, 2, 3};
+static int s_allow_algo_controls;
+
+void tas25xx_algo_enable_common_controls(int value)
+{
+        s_allow_algo_controls = value;
+}
 
 struct soc_multi_control_ch_map {
         int min, max, platform_max, count;
@@ -181,6 +187,93 @@ int tas25xx_algo_channel_map_info(struct snd_kcontrol *kcontrol,
         return 0;
 }
 
+static int tas25xx_get_digital_gain_common(int channel)
+{
+        int ret = 0;
+        int digital_gain = 0;
+        int param_id = 0;
+
+        if (s_allow_algo_controls) {
+                param_id = TAS_CALC_PARAM_IDX(TAS_SA_DIGITAL_GAIN, 1, channel);
+                ret = tas25xx_smartamp_algo_ctrl((u8 *)&digital_gain, param_id,
+                                TAS_GET_PARAM, sizeof(uint32_t),
+                                TISA_MOD_RX);
+                if (ret < 0)
+                        pr_err("TI-SmartPA: %s: failed to get digital gain\n",
+                                __func__);
+                else
+                        ret = digital_gain;
+        } else {
+                pr_info("TI-SmartPA: %s: Not calling algo. Playback inactive\n",
+                                __func__);
+                ret = 0;
+        }
+
+        return ret;
+}
+
+static int tas25xx_get_digital_gain_left(struct snd_kcontrol *pKcontrol,
+                struct snd_ctl_elem_value *pUcontrol)
+{
+        int ret = tas25xx_get_digital_gain_common(CHANNEL0);
+
+        pUcontrol->value.integer.value[0] = ret;
+        pr_info("TI-SmartPA: %s: got digital gain for left ch %d\n",
+                __func__, ret);
+
+        return 0;
+}
+
+static int tas25xx_get_digital_gain_right(struct snd_kcontrol *pKcontrol,
+                struct snd_ctl_elem_value *pUcontrol)
+{
+        int ret = tas25xx_get_digital_gain_common(CHANNEL1);
+
+        pUcontrol->value.integer.value[0] = ret;
+        pr_info("TI-SmartPA: %s: Getting digital gain right ch %d\n",
+                __func__, ret);
+
+        return 0;
+}
+
+static int tas25xx_set_digital_gain_common(int digital_gain, int channel)
+{
+        int ret;
+        int param_id = 0;
+        int gain = digital_gain;
+
+        pr_info("TI-SmartPA: %s: set gain =%d =>(gain - 108)dB=%d, ch=%d\n",
+                __func__, gain, (gain - 108), channel);
+
+        if (s_allow_algo_controls) {
+                param_id = TAS_CALC_PARAM_IDX(TAS_SA_DIGITAL_GAIN, 1, channel);
+                ret = tas25xx_smartamp_algo_ctrl((u8 *)&gain, param_id,
+                                TAS_SET_PARAM, sizeof(uint32_t), TISA_MOD_RX);
+        } else {
+                pr_info("TI-SmartPA: %s: Not calling algo.Playback inactive\n",
+                                __func__);
+                ret = -EAGAIN;
+        }
+
+        return ret;
+}
+
+static int tas25xx_set_digital_gain_left(struct snd_kcontrol *kcontrol,
+                struct snd_ctl_elem_value *pUcontrol)
+{
+        int digital_gain = pUcontrol->value.integer.value[0];
+
+        return tas25xx_set_digital_gain_common(digital_gain, CHANNEL0);
+}
+
+static int tas25xx_set_digital_gain_right(struct snd_kcontrol *kcontrol,
+                struct snd_ctl_elem_value *pUcontrol)
+{
+        int digital_gain = pUcontrol->value.integer.value[0];
+
+        return tas25xx_set_digital_gain_common(digital_gain, CHANNEL1);
+}
+
 static const struct snd_kcontrol_new tas25xx_algo_common_controls[] = {
         {
                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
@@ -198,7 +291,11 @@ static const struct snd_kcontrol_new tas25xx_algo_common_controls[] = {
                                 .platform_max = 16,
                                 .invert = 0,
                         }
-        }
+        },
+        SOC_SINGLE_EXT("TAS25XX_ALGO_DIGITAL_GAIN_A", SND_SOC_NOPM, 0, 126, 0,
+                        tas25xx_get_digital_gain_left, tas25xx_set_digital_gain_left),
+        SOC_SINGLE_EXT("TAS25XX_ALGO_DIGITAL_GAIN_B", SND_SOC_NOPM, 0, 126, 0,
+                        tas25xx_get_digital_gain_right, tas25xx_set_digital_gain_right),
 };
 
 void tas25xx_parse_algo_dt(struct device_node *np)
diff --git a/tas256x_driver/logical_layer/src/tas256x-logic.c b/tas256x_driver/logical_layer/src/tas256x-logic.c
index e428a4c..7eedbde 100644
--- a/tas256x_driver/logical_layer/src/tas256x-logic.c
+++ b/tas256x_driver/logical_layer/src/tas256x-logic.c
@@ -1046,12 +1046,15 @@ int tas256x_set_power_state(struct tas256x_priv *p_tas256x,
         switch (state) {
         case TAS256X_POWER_ACTIVE:
                 n_result = tas256x_iv_sense_enable_set(p_tas256x, 1, chn);
-#if IS_ENABLED(CONFIG_TAS25XX_CALIB_VAL_BIG)
+#if IS_ENABLED(CONFIG_TAS25XX_CALIB_VAL_BIG) || IS_ENABLED(CONFIG_TISA_DEBUGFS_INTF)
                 tas25xx_send_channel_mapping();
                 tas25xx_send_algo_calibration();
                 tas25xx_set_iv_bit_fomat(p_tas256x->mn_iv_width,
                         p_tas256x->mn_vbat, 1);
 #endif
+#if IS_ENABLED(CONFIG_TAS25XX_ALGO)
+                tas25xx_algo_enable_common_controls(1);
+#endif
                 /* Clear latched IRQ before power on */
                 tas256x_interrupt_clear(p_tas256x, chn);
 
@@ -1130,6 +1133,9 @@ int tas256x_set_power_state(struct tas256x_priv *p_tas256x,
 #if IS_ENABLED(CONFIG_TISA_KBIN_INTF)
                 tas25xx_algo_set_inactive();
 #endif
+#if IS_ENABLED(CONFIG_TAS25XX_ALGO)
+                tas25xx_algo_enable_common_controls(0);
+#endif
                 break;
         default:
                 pr_err("wrong power state setting %d\n",