ASoC: tas2770: Factor out set_ivsense_slots

Add a new explicit function for the setting of I/V sense TDM slots.

Reviewed-by: Neal Gompa <neal@gompa.dev>
Signed-off-by: Martin Povišer <povik+lin@cutebit.org>
Signed-off-by: James Calligeros <jcalligeros99@gmail.com>
Link: https://patch.msgid.link/20250227-apple-codec-changes-v3-5-cbb130030acf@gmail.com
Signed-off-by: Mark Brown <broonie@kernel.org>

diff --git a/sound/soc/codecs/tas2770.c b/sound/soc/codecs/tas2770.c
index 863c3f672ba98dd74a5ba1b15d650a90f91176a1..4a86fcec0c1ecab45b9ebcdfc90c78f3290c6fa6 100644 (file)
--- a/sound/soc/codecs/tas2770.c
+++ b/sound/soc/codecs/tas2770.c
@@ -189,6 +189,31 @@ static int tas2770_mute(struct snd_soc_dai *dai, int mute, int direction)
        return tas2770_update_pwr_ctrl(tas2770);
 }
 
+static int tas2770_set_ivsense_transmit(struct tas2770_priv *tas2770,
+                                       int i_slot, int v_slot)
+{
+       struct snd_soc_component *component = tas2770->component;
+       int ret;
+
+       ret = snd_soc_component_update_bits(component, TAS2770_TDM_CFG_REG5,
+                                           TAS2770_TDM_CFG_REG5_VSNS_MASK |
+                                           TAS2770_TDM_CFG_REG5_50_MASK,
+                                           TAS2770_TDM_CFG_REG5_VSNS_ENABLE |
+                                           v_slot);
+       if (ret < 0)
+               return ret;
+
+       ret = snd_soc_component_update_bits(component, TAS2770_TDM_CFG_REG6,
+                                           TAS2770_TDM_CFG_REG6_ISNS_MASK |
+                                           TAS2770_TDM_CFG_REG6_50_MASK,
+                                           TAS2770_TDM_CFG_REG6_ISNS_ENABLE |
+                                           i_slot);
+       if (ret < 0)
+               return ret;
+
+       return 0;
+}
+
 static int tas2770_set_bitwidth(struct tas2770_priv *tas2770, int bitwidth)
 {
        int ret;
@@ -221,19 +246,8 @@ static int tas2770_set_bitwidth(struct tas2770_priv *tas2770, int bitwidth)
        if (ret < 0)
                return ret;
 
-       ret = snd_soc_component_update_bits(component, TAS2770_TDM_CFG_REG5,
-                                           TAS2770_TDM_CFG_REG5_VSNS_MASK |
-                                           TAS2770_TDM_CFG_REG5_50_MASK,
-                                           TAS2770_TDM_CFG_REG5_VSNS_ENABLE |
-               tas2770->v_sense_slot);
-       if (ret < 0)
-               return ret;
-
-       ret = snd_soc_component_update_bits(component, TAS2770_TDM_CFG_REG6,
-                                           TAS2770_TDM_CFG_REG6_ISNS_MASK |
-                                           TAS2770_TDM_CFG_REG6_50_MASK,
-                                           TAS2770_TDM_CFG_REG6_ISNS_ENABLE |
-                                           tas2770->i_sense_slot);
+       ret = tas2770_set_ivsense_transmit(tas2770, tas2770->i_sense_slot,
+                                          tas2770->v_sense_slot);
        if (ret < 0)
                return ret;