pinctrl: mediatek: Implement wake handler and suspend resume

This patch implement irq_set_wake to get who is wakeup source and
setup on suspend resume.

Signed-off-by: Maoguang Meng <maoguang.meng@mediatek.com>
Reviewed-by: Daniel Kurtz <djkurtz@chromium.org>
Acked-by: Yingjoe Chen <yingjoe.chen@mediatek.com>
Acked-by: Hongzhou Yang <hongzhou.yang@mediatek.com>
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>

diff --git a/drivers/pinctrl/mediatek/pinctrl-mt8173.c b/drivers/pinctrl/mediatek/pinctrl-mt8173.c
index d0c811d5f07b73303475ba6015e32d652bea6e84..ad271840d8652f783a4e8700e25fe8fe8d3d2dc5 100644 (file)
--- a/drivers/pinctrl/mediatek/pinctrl-mt8173.c
+++ b/drivers/pinctrl/mediatek/pinctrl-mt8173.c
@@ -385,6 +385,7 @@ static struct platform_driver mtk_pinctrl_driver = {
        .driver = {
                .name = "mediatek-mt8173-pinctrl",
                .of_match_table = mt8173_pctrl_match,
+               .pm = &mtk_eint_pm_ops,
        },
 };
 

diff --git a/drivers/pinctrl/mediatek/pinctrl-mtk-common.c b/drivers/pinctrl/mediatek/pinctrl-mtk-common.c
index f6cdeee6e63bd6b6ee7a8e2be7059ddb0981650c..7726c6caaf8350f7832ecb81ff26c074022b77a9 100644 (file)
--- a/drivers/pinctrl/mediatek/pinctrl-mtk-common.c
+++ b/drivers/pinctrl/mediatek/pinctrl-mtk-common.c
@@ -33,6 +33,7 @@
 #include <linux/mfd/syscon.h>
 #include <linux/delay.h>
 #include <linux/interrupt.h>
+#include <linux/pm.h>
 #include <dt-bindings/pinctrl/mt65xx.h>
 
 #include "../core.h"
@@ -1062,6 +1063,77 @@ static int mtk_eint_set_type(struct irq_data *d,
        return 0;
 }
 
+static int mtk_eint_irq_set_wake(struct irq_data *d, unsigned int on)
+{
+       struct mtk_pinctrl *pctl = irq_data_get_irq_chip_data(d);
+       int shift = d->hwirq & 0x1f;
+       int reg = d->hwirq >> 5;
+
+       if (on)
+               pctl->wake_mask[reg] |= BIT(shift);
+       else
+               pctl->wake_mask[reg] &= ~BIT(shift);
+
+       return 0;
+}
+
+static void mtk_eint_chip_write_mask(const struct mtk_eint_offsets *chip,
+               void __iomem *eint_reg_base, u32 *buf)
+{
+       int port;
+       void __iomem *reg;
+
+       for (port = 0; port < chip->ports; port++) {
+               reg = eint_reg_base + (port << 2);
+               writel_relaxed(~buf[port], reg + chip->mask_set);
+               writel_relaxed(buf[port], reg + chip->mask_clr);
+       }
+}
+
+static void mtk_eint_chip_read_mask(const struct mtk_eint_offsets *chip,
+               void __iomem *eint_reg_base, u32 *buf)
+{
+       int port;
+       void __iomem *reg;
+
+       for (port = 0; port < chip->ports; port++) {
+               reg = eint_reg_base + chip->mask + (port << 2);
+               buf[port] = ~readl_relaxed(reg);
+               /* Mask is 0 when irq is enabled, and 1 when disabled. */
+       }
+}
+
+static int mtk_eint_suspend(struct device *device)
+{
+       void __iomem *reg;
+       struct mtk_pinctrl *pctl = dev_get_drvdata(device);
+       const struct mtk_eint_offsets *eint_offsets =
+                       &pctl->devdata->eint_offsets;
+
+       reg = pctl->eint_reg_base;
+       mtk_eint_chip_read_mask(eint_offsets, reg, pctl->cur_mask);
+       mtk_eint_chip_write_mask(eint_offsets, reg, pctl->wake_mask);
+
+       return 0;
+}
+
+static int mtk_eint_resume(struct device *device)
+{
+       struct mtk_pinctrl *pctl = dev_get_drvdata(device);
+       const struct mtk_eint_offsets *eint_offsets =
+                       &pctl->devdata->eint_offsets;
+
+       mtk_eint_chip_write_mask(eint_offsets,
+                       pctl->eint_reg_base, pctl->cur_mask);
+
+       return 0;
+}
+
+const struct dev_pm_ops mtk_eint_pm_ops = {
+       .suspend = mtk_eint_suspend,
+       .resume = mtk_eint_resume,
+};
+
 static void mtk_eint_ack(struct irq_data *d)
 {
        struct mtk_pinctrl *pctl = irq_data_get_irq_chip_data(d);
@@ -1076,10 +1148,12 @@ static void mtk_eint_ack(struct irq_data *d)
 
 static struct irq_chip mtk_pinctrl_irq_chip = {
        .name = "mt-eint",
+       .irq_disable = mtk_eint_mask,
        .irq_mask = mtk_eint_mask,
        .irq_unmask = mtk_eint_unmask,
        .irq_ack = mtk_eint_ack,
        .irq_set_type = mtk_eint_set_type,
+       .irq_set_wake = mtk_eint_irq_set_wake,
        .irq_request_resources = mtk_pinctrl_irq_request_resources,
        .irq_release_resources = mtk_pinctrl_irq_release_resources,
 };
@@ -1211,7 +1285,7 @@ int mtk_pctrl_init(struct platform_device *pdev,
        struct device_node *np = pdev->dev.of_node, *node;
        struct property *prop;
        struct resource *res;
-       int i, ret, irq;
+       int i, ret, irq, ports_buf;
 
        pctl = devm_kzalloc(&pdev->dev, sizeof(*pctl), GFP_KERNEL);
        if (!pctl)
@@ -1318,6 +1392,21 @@ int mtk_pctrl_init(struct platform_device *pdev,
                goto chip_error;
        }
 
+       ports_buf = pctl->devdata->eint_offsets.ports;
+       pctl->wake_mask = devm_kcalloc(&pdev->dev, ports_buf,
+                                       sizeof(*pctl->wake_mask), GFP_KERNEL);
+       if (!pctl->wake_mask) {
+               ret = -ENOMEM;
+               goto chip_error;
+       }
+
+       pctl->cur_mask = devm_kcalloc(&pdev->dev, ports_buf,
+                                       sizeof(*pctl->cur_mask), GFP_KERNEL);
+       if (!pctl->cur_mask) {
+               ret = -ENOMEM;
+               goto chip_error;
+       }
+
        pctl->eint_dual_edges = devm_kcalloc(&pdev->dev, pctl->devdata->ap_num,
                                             sizeof(int), GFP_KERNEL);
        if (!pctl->eint_dual_edges) {

diff --git a/drivers/pinctrl/mediatek/pinctrl-mtk-common.h b/drivers/pinctrl/mediatek/pinctrl-mtk-common.h
index c532c23c70b471ac68e030b7c61be8929152c89d..55a5343389315e1c4213b18bc9ff2875d40704d4 100644 (file)
--- a/drivers/pinctrl/mediatek/pinctrl-mtk-common.h
+++ b/drivers/pinctrl/mediatek/pinctrl-mtk-common.h
@@ -267,6 +267,8 @@ struct mtk_pinctrl {
        void __iomem            *eint_reg_base;
        struct irq_domain       *domain;
        int                     *eint_dual_edges;
+       u32 *wake_mask;
+       u32 *cur_mask;
 };
 
 int mtk_pctrl_init(struct platform_device *pdev,
@@ -282,4 +284,6 @@ int mtk_pconf_spec_set_ies_smt_range(struct regmap *regmap,
                const struct mtk_pin_ies_smt_set *ies_smt_infos, unsigned int info_num,
                unsigned int pin, unsigned char align, int value);
 
+extern const struct dev_pm_ops mtk_eint_pm_ops;
+
 #endif /* __PINCTRL_MTK_COMMON_H */