[U-Boot] [PATCH v3 7/9] pinctrl: stm32: Add get_pin_muxing() ops

[Patrice Chotard]

Add get_pin_muxing() ops to obtain the pin muxing description
a given pin index.

Signed-off-by: Patrice Chotard <patrice.chot...@st.com>
---

Changes in v3: None
Changes in v2: None

 drivers/pinctrl/pinctrl_stm32.c | 77 +++++++++++++++++++++++++++++++++++++++++
 1 file changed, 77 insertions(+)

diff --git a/drivers/pinctrl/pinctrl_stm32.c b/drivers/pinctrl/pinctrl_stm32.c
index e0bee4b97bd5..588efda8df4b 100644
--- a/drivers/pinctrl/pinctrl_stm32.c
+++ b/drivers/pinctrl/pinctrl_stm32.c
@@ -27,8 +27,34 @@ struct stm32_gpio_bank {
 
 #define MAX_PIN_PER_BANK               16
 
+#define MAX_PIN_MUX_LEN                        40
+static char pin_mux[MAX_PIN_MUX_LEN];
+
 #define MAX_PIN_NAME_LEN               12
 static char pin_name[MAX_PIN_NAME_LEN];
+#define PINMUX_MODE_COUNT              5
+static const char * const pinmux_mode[PINMUX_MODE_COUNT] = {
+       "gpio input",
+       "gpio output",
+       "analog",
+       "unknown",
+       "alt function",
+};
+
+static int stm32_pinctrl_get_af(struct udevice *dev, unsigned int offset)
+{
+       struct stm32_gpio_priv *priv = dev_get_priv(dev);
+       struct stm32_gpio_regs *regs = priv->regs;
+       u32 af;
+       u32 alt_shift = (offset % 8) * 4;
+       u32 alt_index =  offset / 8;
+
+       af = (readl(&regs->afr[alt_index]) &
+             GENMASK(alt_shift + 3, alt_shift)) >> alt_shift;
+
+       return af;
+}
+
 static int stm32_pinctrl_get_pins_count(struct udevice *dev)
 {
        struct stm32_pinctrl_priv *priv = dev_get_priv(dev);
@@ -97,6 +123,56 @@ static const char *stm32_pinctrl_get_pin_name(struct 
udevice *dev,
 
        return pin_name;
 }
+
+static const char *stm32_pinctrl_get_pin_muxing(struct udevice *dev,
+                                               unsigned int selector)
+{
+       struct udevice *gpio_dev;
+       const char *label;
+       int gpio_pin;
+       int mode;
+       int af_num;
+
+       /* look up for the bank which owns the requested pin */
+       gpio_dev = stm32_pinctrl_get_gpio_dev(dev, selector);
+
+       if (!gpio_dev) {
+               snprintf(pin_mux, MAX_PIN_MUX_LEN, "Error");
+               return pin_mux;
+       }
+
+       /* translate pin-controller pin number to gpio pin number */
+       gpio_pin = selector % MAX_PIN_PER_BANK;
+
+       mode = gpio_get_raw_function(gpio_dev, gpio_pin, &label);
+
+       dev_dbg(dev, "selector = %d gpio_pin = %d mode = %d\n",
+               selector, gpio_pin, mode);
+
+       switch (mode) {
+       case GPIOF_UNKNOWN:
+               /* should never happen */
+               snprintf(pin_mux, MAX_PIN_MUX_LEN, "Error !!");
+               break;
+       case GPIOF_UNUSED:
+               snprintf(pin_mux, MAX_PIN_MUX_LEN, "%s",
+                        pinmux_mode[mode]);
+               break;
+       case GPIOF_FUNC:
+               af_num = stm32_pinctrl_get_af(gpio_dev, gpio_pin);
+               snprintf(pin_mux, MAX_PIN_MUX_LEN, "%s %d",
+                        pinmux_mode[mode], af_num);
+               break;
+       case GPIOF_OUTPUT:
+       case GPIOF_INPUT:
+               snprintf(pin_mux, MAX_PIN_MUX_LEN, "%s %s",
+                        pinmux_mode[mode], label ? label : "");
+               break;
+       }
+
+       return pin_mux;
+}
+
 int stm32_pinctrl_probe(struct udevice *dev)
 {
        struct stm32_pinctrl_priv *priv = dev_get_priv(dev);
@@ -308,6 +384,7 @@ static struct pinctrl_ops stm32_pinctrl_ops = {
 #ifndef CONFIG_SPL_BUILD
        .get_pin_name           = stm32_pinctrl_get_pin_name,
        .get_pins_count         = stm32_pinctrl_get_pins_count,
+       .get_pin_muxing         = stm32_pinctrl_get_pin_muxing,
 #endif
 };
 
-- 
1.9.1

_______________________________________________
U-Boot mailing list
U-Boot@lists.denx.de
https://lists.denx.de/listinfo/u-boot