ASoC: rt5677: Refactor GPIO support code

After compiler complains:

  sound/soc/codecs/rt5677.c:4748:30: warning: dubious: x | !y

I looked into the code and realized that we can refactor it
for better reading and fixing above issue at the same time.
Hence this change. It does not imply any functional changes.

Signed-off-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com>
Link: https://lore.kernel.org/r/20230630172155.83754-2-andriy.shevchenko@linux.intel.com
Signed-off-by: Mark Brown <broonie@kernel.org>

diff --git a/sound/soc/codecs/rt5677.c b/sound/soc/codecs/rt5677.c
index ad14d18860fc3b92d64d4e5f67405f4891e28f4c..3a2a6b150cdad1920530fbdad71e38255ac38057 100644 (file)
--- a/sound/soc/codecs/rt5677.c
+++ b/sound/soc/codecs/rt5677.c
@@ -4717,50 +4717,34 @@ static int rt5677_set_bias_level(struct snd_soc_component *component,
        return 0;
 }
 
+static int rt5677_update_gpio_bits(struct rt5677_priv *rt5677, unsigned offset, int m, int v)
+{
+       unsigned int bank = offset / 5;
+       unsigned int shift = (offset % 5) * 3;
+       unsigned int reg = bank ? RT5677_GPIO_CTRL3 : RT5677_GPIO_CTRL2;
+
+       return regmap_update_bits(rt5677->regmap, reg, m << shift, v << shift);
+}
+
 #ifdef CONFIG_GPIOLIB
 static void rt5677_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
 {
        struct rt5677_priv *rt5677 = gpiochip_get_data(chip);
+       int level = value ? RT5677_GPIOx_OUT_HI : RT5677_GPIOx_OUT_LO;
+       int m = RT5677_GPIOx_OUT_MASK;
 
-       switch (offset) {
-       case RT5677_GPIO1 ... RT5677_GPIO5:
-               regmap_update_bits(rt5677->regmap, RT5677_GPIO_CTRL2,
-                       0x1 << (offset * 3 + 1), !!value << (offset * 3 + 1));
-               break;
-
-       case RT5677_GPIO6:
-               regmap_update_bits(rt5677->regmap, RT5677_GPIO_CTRL3,
-                       RT5677_GPIO6_OUT_MASK, !!value << RT5677_GPIO6_OUT_SFT);
-               break;
-
-       default:
-               break;
-       }
+       rt5677_update_gpio_bits(rt5677, offset, m, level);
 }
 
 static int rt5677_gpio_direction_out(struct gpio_chip *chip,
                                     unsigned offset, int value)
 {
        struct rt5677_priv *rt5677 = gpiochip_get_data(chip);
+       int level = value ? RT5677_GPIOx_OUT_HI : RT5677_GPIOx_OUT_LO;
+       int m = RT5677_GPIOx_DIR_MASK | RT5677_GPIOx_OUT_MASK;
+       int v = RT5677_GPIOx_DIR_OUT | level;
 
-       switch (offset) {
-       case RT5677_GPIO1 ... RT5677_GPIO5:
-               regmap_update_bits(rt5677->regmap, RT5677_GPIO_CTRL2,
-                       0x3 << (offset * 3 + 1),
-                       (0x2 | !!value) << (offset * 3 + 1));
-               break;
-
-       case RT5677_GPIO6:
-               regmap_update_bits(rt5677->regmap, RT5677_GPIO_CTRL3,
-                       RT5677_GPIO6_DIR_MASK | RT5677_GPIO6_OUT_MASK,
-                       RT5677_GPIO6_DIR_OUT | !!value << RT5677_GPIO6_OUT_SFT);
-               break;
-
-       default:
-               break;
-       }
-
-       return 0;
+       return rt5677_update_gpio_bits(rt5677, offset, m, v);
 }
 
 static int rt5677_gpio_get(struct gpio_chip *chip, unsigned offset)
@@ -4778,26 +4762,14 @@ static int rt5677_gpio_get(struct gpio_chip *chip, unsigned offset)
 static int rt5677_gpio_direction_in(struct gpio_chip *chip, unsigned offset)
 {
        struct rt5677_priv *rt5677 = gpiochip_get_data(chip);
+       int m = RT5677_GPIOx_DIR_MASK;
+       int v = RT5677_GPIOx_DIR_IN;
 
-       switch (offset) {
-       case RT5677_GPIO1 ... RT5677_GPIO5:
-               regmap_update_bits(rt5677->regmap, RT5677_GPIO_CTRL2,
-                       0x1 << (offset * 3 + 2), 0x0);
-               break;
-
-       case RT5677_GPIO6:
-               regmap_update_bits(rt5677->regmap, RT5677_GPIO_CTRL3,
-                       RT5677_GPIO6_DIR_MASK, RT5677_GPIO6_DIR_IN);
-               break;
-
-       default:
-               break;
-       }
-
-       return 0;
+       return rt5677_update_gpio_bits(rt5677, offset, m, v);
 }
 
-/** Configures the gpio as
+/*
+ * Configures the GPIO as
  *   0 - floating
  *   1 - pull down
  *   2 - pull up
@@ -5673,9 +5645,9 @@ static int rt5677_i2c_probe(struct i2c_client *i2c)
                regmap_update_bits(rt5677->regmap, RT5677_GEN_CTRL2,
                                        RT5677_GPIO5_FUNC_MASK,
                                        RT5677_GPIO5_FUNC_DMIC);
-               regmap_update_bits(rt5677->regmap, RT5677_GPIO_CTRL2,
-                                       RT5677_GPIO5_DIR_MASK,
-                                       RT5677_GPIO5_DIR_OUT);
+               rt5677_update_gpio_bits(rt5677, RT5677_GPIO5,
+                                       RT5677_GPIOx_DIR_MASK,
+                                       RT5677_GPIOx_DIR_OUT);
        }
 
        if (rt5677->pdata.micbias1_vdd_3v3)

diff --git a/sound/soc/codecs/rt5677.h b/sound/soc/codecs/rt5677.h
index 944ae02aafc2f122b695e9be2716674b87991bc0..5932b04cf85e67e56c11ec547afd64cb71748b9c 100644 (file)
--- a/sound/soc/codecs/rt5677.h
+++ b/sound/soc/codecs/rt5677.h
@@ -1587,81 +1587,19 @@
 #define RT5677_FUNC_MODE_DMIC_GPIO             (0x0 << 13)
 #define RT5677_FUNC_MODE_JTAG                  (0x1 << 13)
 
-/* GPIO Control 2 (0xc1) */
-#define RT5677_GPIO5_DIR_MASK                  (0x1 << 14)
-#define RT5677_GPIO5_DIR_SFT                   14
-#define RT5677_GPIO5_DIR_IN                    (0x0 << 14)
-#define RT5677_GPIO5_DIR_OUT                   (0x1 << 14)
-#define RT5677_GPIO5_OUT_MASK                  (0x1 << 13)
-#define RT5677_GPIO5_OUT_SFT                   13
-#define RT5677_GPIO5_OUT_LO                    (0x0 << 13)
-#define RT5677_GPIO5_OUT_HI                    (0x1 << 13)
-#define RT5677_GPIO5_P_MASK                    (0x1 << 12)
-#define RT5677_GPIO5_P_SFT                     12
-#define RT5677_GPIO5_P_NOR                     (0x0 << 12)
-#define RT5677_GPIO5_P_INV                     (0x1 << 12)
-#define RT5677_GPIO4_DIR_MASK                  (0x1 << 11)
-#define RT5677_GPIO4_DIR_SFT                   11
-#define RT5677_GPIO4_DIR_IN                    (0x0 << 11)
-#define RT5677_GPIO4_DIR_OUT                   (0x1 << 11)
-#define RT5677_GPIO4_OUT_MASK                  (0x1 << 10)
-#define RT5677_GPIO4_OUT_SFT                   10
-#define RT5677_GPIO4_OUT_LO                    (0x0 << 10)
-#define RT5677_GPIO4_OUT_HI                    (0x1 << 10)
-#define RT5677_GPIO4_P_MASK                    (0x1 << 9)
-#define RT5677_GPIO4_P_SFT                     9
-#define RT5677_GPIO4_P_NOR                     (0x0 << 9)
-#define RT5677_GPIO4_P_INV                     (0x1 << 9)
-#define RT5677_GPIO3_DIR_MASK                  (0x1 << 8)
-#define RT5677_GPIO3_DIR_SFT                   8
-#define RT5677_GPIO3_DIR_IN                    (0x0 << 8)
-#define RT5677_GPIO3_DIR_OUT                   (0x1 << 8)
-#define RT5677_GPIO3_OUT_MASK                  (0x1 << 7)
-#define RT5677_GPIO3_OUT_SFT                   7
-#define RT5677_GPIO3_OUT_LO                    (0x0 << 7)
-#define RT5677_GPIO3_OUT_HI                    (0x1 << 7)
-#define RT5677_GPIO3_P_MASK                    (0x1 << 6)
-#define RT5677_GPIO3_P_SFT                     6
-#define RT5677_GPIO3_P_NOR                     (0x0 << 6)
-#define RT5677_GPIO3_P_INV                     (0x1 << 6)
-#define RT5677_GPIO2_DIR_MASK                  (0x1 << 5)
-#define RT5677_GPIO2_DIR_SFT                   5
-#define RT5677_GPIO2_DIR_IN                    (0x0 << 5)
-#define RT5677_GPIO2_DIR_OUT                   (0x1 << 5)
-#define RT5677_GPIO2_OUT_MASK                  (0x1 << 4)
-#define RT5677_GPIO2_OUT_SFT                   4
-#define RT5677_GPIO2_OUT_LO                    (0x0 << 4)
-#define RT5677_GPIO2_OUT_HI                    (0x1 << 4)
-#define RT5677_GPIO2_P_MASK                    (0x1 << 3)
-#define RT5677_GPIO2_P_SFT                     3
-#define RT5677_GPIO2_P_NOR                     (0x0 << 3)
-#define RT5677_GPIO2_P_INV                     (0x1 << 3)
-#define RT5677_GPIO1_DIR_MASK                  (0x1 << 2)
-#define RT5677_GPIO1_DIR_SFT                   2
-#define RT5677_GPIO1_DIR_IN                    (0x0 << 2)
-#define RT5677_GPIO1_DIR_OUT                   (0x1 << 2)
-#define RT5677_GPIO1_OUT_MASK                  (0x1 << 1)
-#define RT5677_GPIO1_OUT_SFT                   1
-#define RT5677_GPIO1_OUT_LO                    (0x0 << 1)
-#define RT5677_GPIO1_OUT_HI                    (0x1 << 1)
-#define RT5677_GPIO1_P_MASK                    (0x1 << 0)
-#define RT5677_GPIO1_P_SFT                     0
-#define RT5677_GPIO1_P_NOR                     (0x0 << 0)
-#define RT5677_GPIO1_P_INV                     (0x1 << 0)
-
-/* GPIO Control 3 (0xc2) */
-#define RT5677_GPIO6_DIR_MASK                  (0x1 << 2)
-#define RT5677_GPIO6_DIR_SFT                   2
-#define RT5677_GPIO6_DIR_IN                    (0x0 << 2)
-#define RT5677_GPIO6_DIR_OUT                   (0x1 << 2)
-#define RT5677_GPIO6_OUT_MASK                  (0x1 << 1)
-#define RT5677_GPIO6_OUT_SFT                   1
-#define RT5677_GPIO6_OUT_LO                    (0x0 << 1)
-#define RT5677_GPIO6_OUT_HI                    (0x1 << 1)
-#define RT5677_GPIO6_P_MASK                    (0x1 << 0)
-#define RT5677_GPIO6_P_SFT                     0
-#define RT5677_GPIO6_P_NOR                     (0x0 << 0)
-#define RT5677_GPIO6_P_INV                     (0x1 << 0)
+/* GPIO Control 2 (0xc1) & 3 (0xc2) common bits */
+#define RT5677_GPIOx_DIR_MASK                  (0x1 << 2)
+#define RT5677_GPIOx_DIR_SFT                   2
+#define RT5677_GPIOx_DIR_IN                    (0x0 << 2)
+#define RT5677_GPIOx_DIR_OUT                   (0x1 << 2)
+#define RT5677_GPIOx_OUT_MASK                  (0x1 << 1)
+#define RT5677_GPIOx_OUT_SFT                   1
+#define RT5677_GPIOx_OUT_LO                    (0x0 << 1)
+#define RT5677_GPIOx_OUT_HI                    (0x1 << 1)
+#define RT5677_GPIOx_P_MASK                    (0x1 << 0)
+#define RT5677_GPIOx_P_SFT                     0
+#define RT5677_GPIOx_P_NOR                     (0x0 << 0)
+#define RT5677_GPIOx_P_INV                     (0x1 << 0)
 
 /* General Control (0xfa) */
 #define RT5677_IRQ_DEBOUNCE_SEL_MASK           (0x3 << 3)