Re: [PATCH v6 5/5] pinctrl: mediatek: Add support for pin configuration dump via debugfs.

2019-09-27 Thread Sean Wang
Hi,

On Thu, Sep 26, 2019 at 10:02 PM Light Hsieh  wrote:
>
> Add support for pin configuration dump via catting
> /sys/kernel/debug/pinctrl/$platform_dependent_path/pinconf-pins.
> pinctrl framework had already support such dump. This patch implement the
> operation function pointer to fullfill this dump.
>

Here are missing tags too.

> ---
>  drivers/pinctrl/mediatek/pinctrl-paris.c | 88 
> 
>  drivers/pinctrl/mediatek/pinctrl-paris.h | 30 +++
>  2 files changed, 118 insertions(+)
>
> diff --git a/drivers/pinctrl/mediatek/pinctrl-paris.c 
> b/drivers/pinctrl/mediatek/pinctrl-paris.c
> index 2a47c45..f531908 100644
> --- a/drivers/pinctrl/mediatek/pinctrl-paris.c
> +++ b/drivers/pinctrl/mediatek/pinctrl-paris.c
> @@ -538,12 +538,99 @@ static int mtk_pctrl_get_group_pins(struct pinctrl_dev 
> *pctldev,
> return 0;
>  }
>
> +int mtk_hw_get_value_wrap(struct mtk_pinctrl *hw, unsigned int gpio, int 
> field)
> +{
> +   const struct mtk_pin_desc *desc;
> +   int value, err;
> +
> +   if (gpio > hw->soc->npins)
> +   return -EINVAL;
> +
> +   desc = (const struct mtk_pin_desc *)>soc->pins[gpio];
> +
> +   err = mtk_hw_get_value(hw, desc, field, );
> +   if (err)
> +   return err;
> +
> +   return value;
> +}
> +
> +ssize_t mtk_pctrl_show_one_pin(struct mtk_pinctrl *hw,
> +   unsigned int gpio, char *buf, unsigned int bufLen)
> +{
> +   const struct mtk_pin_desc *desc;
> +   int pinmux, pullup, pullen, r1 = -1, r0 = -1, len = 0;

Sort the variable declarations in reverse xmas tree order.

> +
> +   if (gpio > hw->soc->npins)
> +   return -EINVAL;
> +
> +   desc = (const struct mtk_pin_desc *)>soc->pins[gpio];
> +   pinmux = mtk_pctrl_get_pinmux(hw, gpio);
> +   if (pinmux >= hw->soc->nfuncs)
> +   pinmux -= hw->soc->nfuncs;
> +
> +   mtk_pinconf_bias_get_combo(hw, desc, , );
> +   if (pullen == MTK_PUPD_SET_R1R0_00) {
> +   pullen = 0;
> +   r1 = 0;
> +   r0 = 0;
> +   } else if (pullen == MTK_PUPD_SET_R1R0_01) {
> +   pullen = 1;
> +   r1 = 0;
> +   r0 = 1;
> +   } else if (pullen == MTK_PUPD_SET_R1R0_10) {
> +   pullen = 1;
> +   r1 = 1;
> +   r0 = 0;
> +   } else if (pullen == MTK_PUPD_SET_R1R0_11) {
> +   pullen = 1;
> +   r1 = 1;
> +   r0 = 1;
> +   } else if (pullen != MTK_DISABLE && pullen != MTK_ENABLE) {
> +   pullen = 0;
> +   }
> +   len += snprintf(buf + len, bufLen - len,
> +   "%03d: %1d%1d%1d%1d%02d%1d%1d%1d%1d",
> +   gpio,
> +   pinmux,
> +   mtk_pctrl_get_direction(hw, gpio),
> +   mtk_pctrl_get_out(hw, gpio),
> +   mtk_pctrl_get_in(hw, gpio),
> +   mtk_pctrl_get_driving(hw, gpio),
> +   mtk_pctrl_get_smt(hw, gpio),
> +   mtk_pctrl_get_ies(hw, gpio),
> +   pullen,
> +   pullup);
> +
> +   if (r1 != -1) {
> +   len += snprintf(buf + len, bufLen - len, " (%1d %1d)\n",
> +   r1, r0);
> +   } else {
> +   len += snprintf(buf + len, bufLen - len, "\n");
> +   }
> +
> +   return len;
> +}
> +
> +#define PIN_DBG_BUF_SZ 96
> +static void mtk_pctrl_dbg_show(struct pinctrl_dev *pctldev, struct seq_file 
> *s,
> + unsigned int gpio)
> +{
> +   struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev);
> +   char buf[PIN_DBG_BUF_SZ];
> +
> +   (void)mtk_pctrl_show_one_pin(hw, gpio, buf, PIN_DBG_BUF_SZ);
> +
> +   seq_printf(s, "%s", buf);
> +}
> +
>  static const struct pinctrl_ops mtk_pctlops = {
> .dt_node_to_map = mtk_pctrl_dt_node_to_map,
> .dt_free_map= pinctrl_utils_free_map,
> .get_groups_count   = mtk_pctrl_get_groups_count,
> .get_group_name = mtk_pctrl_get_group_name,
> .get_group_pins = mtk_pctrl_get_group_pins,
> +   .pin_dbg_show   = mtk_pctrl_dbg_show,
>  };
>
>  static int mtk_pmx_get_funcs_cnt(struct pinctrl_dev *pctldev)
> @@ -640,6 +727,7 @@ static int mtk_pconf_group_set(struct pinctrl_dev 
> *pctldev, unsigned group,
> .pin_config_get = mtk_pinconf_get,
> .pin_config_group_get   = mtk_pconf_group_get,
> .pin_config_group_set   = mtk_pconf_group_set,
> +   .is_generic = true,
>  };
>
>  static struct pinctrl_desc mtk_desc = {
> diff --git a/drivers/pinctrl/mediatek/pinctrl-paris.h 
> b/drivers/pinctrl/mediatek/pinctrl-paris.h
> index 3d43771..d73f4b6 100644
> --- a/drivers/pinctrl/mediatek/pinctrl-paris.h
> +++ b/drivers/pinctrl/mediatek/pinctrl-paris.h
> @@ -60,6 +60,36 @@
>  int mtk_paris_pinctrl_probe(struct 

[PATCH v6 5/5] pinctrl: mediatek: Add support for pin configuration dump via debugfs.

2019-09-26 Thread Light Hsieh
Add support for pin configuration dump via catting
/sys/kernel/debug/pinctrl/$platform_dependent_path/pinconf-pins.
pinctrl framework had already support such dump. This patch implement the
operation function pointer to fullfill this dump.

---
 drivers/pinctrl/mediatek/pinctrl-paris.c | 88 
 drivers/pinctrl/mediatek/pinctrl-paris.h | 30 +++
 2 files changed, 118 insertions(+)

diff --git a/drivers/pinctrl/mediatek/pinctrl-paris.c 
b/drivers/pinctrl/mediatek/pinctrl-paris.c
index 2a47c45..f531908 100644
--- a/drivers/pinctrl/mediatek/pinctrl-paris.c
+++ b/drivers/pinctrl/mediatek/pinctrl-paris.c
@@ -538,12 +538,99 @@ static int mtk_pctrl_get_group_pins(struct pinctrl_dev 
*pctldev,
return 0;
 }
 
+int mtk_hw_get_value_wrap(struct mtk_pinctrl *hw, unsigned int gpio, int field)
+{
+   const struct mtk_pin_desc *desc;
+   int value, err;
+
+   if (gpio > hw->soc->npins)
+   return -EINVAL;
+
+   desc = (const struct mtk_pin_desc *)>soc->pins[gpio];
+
+   err = mtk_hw_get_value(hw, desc, field, );
+   if (err)
+   return err;
+
+   return value;
+}
+
+ssize_t mtk_pctrl_show_one_pin(struct mtk_pinctrl *hw,
+   unsigned int gpio, char *buf, unsigned int bufLen)
+{
+   const struct mtk_pin_desc *desc;
+   int pinmux, pullup, pullen, r1 = -1, r0 = -1, len = 0;
+
+   if (gpio > hw->soc->npins)
+   return -EINVAL;
+
+   desc = (const struct mtk_pin_desc *)>soc->pins[gpio];
+   pinmux = mtk_pctrl_get_pinmux(hw, gpio);
+   if (pinmux >= hw->soc->nfuncs)
+   pinmux -= hw->soc->nfuncs;
+
+   mtk_pinconf_bias_get_combo(hw, desc, , );
+   if (pullen == MTK_PUPD_SET_R1R0_00) {
+   pullen = 0;
+   r1 = 0;
+   r0 = 0;
+   } else if (pullen == MTK_PUPD_SET_R1R0_01) {
+   pullen = 1;
+   r1 = 0;
+   r0 = 1;
+   } else if (pullen == MTK_PUPD_SET_R1R0_10) {
+   pullen = 1;
+   r1 = 1;
+   r0 = 0;
+   } else if (pullen == MTK_PUPD_SET_R1R0_11) {
+   pullen = 1;
+   r1 = 1;
+   r0 = 1;
+   } else if (pullen != MTK_DISABLE && pullen != MTK_ENABLE) {
+   pullen = 0;
+   }
+   len += snprintf(buf + len, bufLen - len,
+   "%03d: %1d%1d%1d%1d%02d%1d%1d%1d%1d",
+   gpio,
+   pinmux,
+   mtk_pctrl_get_direction(hw, gpio),
+   mtk_pctrl_get_out(hw, gpio),
+   mtk_pctrl_get_in(hw, gpio),
+   mtk_pctrl_get_driving(hw, gpio),
+   mtk_pctrl_get_smt(hw, gpio),
+   mtk_pctrl_get_ies(hw, gpio),
+   pullen,
+   pullup);
+
+   if (r1 != -1) {
+   len += snprintf(buf + len, bufLen - len, " (%1d %1d)\n",
+   r1, r0);
+   } else {
+   len += snprintf(buf + len, bufLen - len, "\n");
+   }
+
+   return len;
+}
+
+#define PIN_DBG_BUF_SZ 96
+static void mtk_pctrl_dbg_show(struct pinctrl_dev *pctldev, struct seq_file *s,
+ unsigned int gpio)
+{
+   struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev);
+   char buf[PIN_DBG_BUF_SZ];
+
+   (void)mtk_pctrl_show_one_pin(hw, gpio, buf, PIN_DBG_BUF_SZ);
+
+   seq_printf(s, "%s", buf);
+}
+
 static const struct pinctrl_ops mtk_pctlops = {
.dt_node_to_map = mtk_pctrl_dt_node_to_map,
.dt_free_map= pinctrl_utils_free_map,
.get_groups_count   = mtk_pctrl_get_groups_count,
.get_group_name = mtk_pctrl_get_group_name,
.get_group_pins = mtk_pctrl_get_group_pins,
+   .pin_dbg_show   = mtk_pctrl_dbg_show,
 };
 
 static int mtk_pmx_get_funcs_cnt(struct pinctrl_dev *pctldev)
@@ -640,6 +727,7 @@ static int mtk_pconf_group_set(struct pinctrl_dev *pctldev, 
unsigned group,
.pin_config_get = mtk_pinconf_get,
.pin_config_group_get   = mtk_pconf_group_get,
.pin_config_group_set   = mtk_pconf_group_set,
+   .is_generic = true,
 };
 
 static struct pinctrl_desc mtk_desc = {
diff --git a/drivers/pinctrl/mediatek/pinctrl-paris.h 
b/drivers/pinctrl/mediatek/pinctrl-paris.h
index 3d43771..d73f4b6 100644
--- a/drivers/pinctrl/mediatek/pinctrl-paris.h
+++ b/drivers/pinctrl/mediatek/pinctrl-paris.h
@@ -60,6 +60,36 @@
 int mtk_paris_pinctrl_probe(struct platform_device *pdev,
const struct mtk_pin_soc *soc);
 
+int mtk_hw_get_value_wrap(struct mtk_pinctrl *hw, unsigned int gpio, int 
field);
+
+#define mtk_pctrl_get_pinmux(hw, gpio) \
+   mtk_hw_get_value_wrap(hw, gpio, PINCTRL_PIN_REG_MODE)
+
+/* MTK HW use 0 as input, 1 for output
+ * This interface is for get direct register value,
+ * so don't reverse
+ */
+#define