Commit 58a5e1b6 authored by Maoguang Meng's avatar Maoguang Meng Committed by Linus Walleij

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: default avatarMaoguang Meng <maoguang.meng@mediatek.com>
Reviewed-by: default avatarDaniel Kurtz <djkurtz@chromium.org>
Acked-by: default avatarYingjoe Chen <yingjoe.chen@mediatek.com>
Acked-by: default avatarHongzhou Yang <hongzhou.yang@mediatek.com>
Signed-off-by: default avatarLinus Walleij <linus.walleij@linaro.org>
parent d48c2c02
...@@ -385,6 +385,7 @@ static struct platform_driver mtk_pinctrl_driver = { ...@@ -385,6 +385,7 @@ static struct platform_driver mtk_pinctrl_driver = {
.driver = { .driver = {
.name = "mediatek-mt8173-pinctrl", .name = "mediatek-mt8173-pinctrl",
.of_match_table = mt8173_pctrl_match, .of_match_table = mt8173_pctrl_match,
.pm = &mtk_eint_pm_ops,
}, },
}; };
......
...@@ -33,6 +33,7 @@ ...@@ -33,6 +33,7 @@
#include <linux/mfd/syscon.h> #include <linux/mfd/syscon.h>
#include <linux/delay.h> #include <linux/delay.h>
#include <linux/interrupt.h> #include <linux/interrupt.h>
#include <linux/pm.h>
#include <dt-bindings/pinctrl/mt65xx.h> #include <dt-bindings/pinctrl/mt65xx.h>
#include "../core.h" #include "../core.h"
...@@ -1062,6 +1063,77 @@ static int mtk_eint_set_type(struct irq_data *d, ...@@ -1062,6 +1063,77 @@ static int mtk_eint_set_type(struct irq_data *d,
return 0; 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) static void mtk_eint_ack(struct irq_data *d)
{ {
struct mtk_pinctrl *pctl = irq_data_get_irq_chip_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) ...@@ -1076,10 +1148,12 @@ static void mtk_eint_ack(struct irq_data *d)
static struct irq_chip mtk_pinctrl_irq_chip = { static struct irq_chip mtk_pinctrl_irq_chip = {
.name = "mt-eint", .name = "mt-eint",
.irq_disable = mtk_eint_mask,
.irq_mask = mtk_eint_mask, .irq_mask = mtk_eint_mask,
.irq_unmask = mtk_eint_unmask, .irq_unmask = mtk_eint_unmask,
.irq_ack = mtk_eint_ack, .irq_ack = mtk_eint_ack,
.irq_set_type = mtk_eint_set_type, .irq_set_type = mtk_eint_set_type,
.irq_set_wake = mtk_eint_irq_set_wake,
.irq_request_resources = mtk_pinctrl_irq_request_resources, .irq_request_resources = mtk_pinctrl_irq_request_resources,
.irq_release_resources = mtk_pinctrl_irq_release_resources, .irq_release_resources = mtk_pinctrl_irq_release_resources,
}; };
...@@ -1211,7 +1285,7 @@ int mtk_pctrl_init(struct platform_device *pdev, ...@@ -1211,7 +1285,7 @@ int mtk_pctrl_init(struct platform_device *pdev,
struct device_node *np = pdev->dev.of_node, *node; struct device_node *np = pdev->dev.of_node, *node;
struct property *prop; struct property *prop;
struct resource *res; struct resource *res;
int i, ret, irq; int i, ret, irq, ports_buf;
pctl = devm_kzalloc(&pdev->dev, sizeof(*pctl), GFP_KERNEL); pctl = devm_kzalloc(&pdev->dev, sizeof(*pctl), GFP_KERNEL);
if (!pctl) if (!pctl)
...@@ -1318,6 +1392,21 @@ int mtk_pctrl_init(struct platform_device *pdev, ...@@ -1318,6 +1392,21 @@ int mtk_pctrl_init(struct platform_device *pdev,
goto chip_error; 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, pctl->eint_dual_edges = devm_kcalloc(&pdev->dev, pctl->devdata->ap_num,
sizeof(int), GFP_KERNEL); sizeof(int), GFP_KERNEL);
if (!pctl->eint_dual_edges) { if (!pctl->eint_dual_edges) {
......
...@@ -267,6 +267,8 @@ struct mtk_pinctrl { ...@@ -267,6 +267,8 @@ struct mtk_pinctrl {
void __iomem *eint_reg_base; void __iomem *eint_reg_base;
struct irq_domain *domain; struct irq_domain *domain;
int *eint_dual_edges; int *eint_dual_edges;
u32 *wake_mask;
u32 *cur_mask;
}; };
int mtk_pctrl_init(struct platform_device *pdev, int mtk_pctrl_init(struct platform_device *pdev,
...@@ -282,4 +284,6 @@ int mtk_pconf_spec_set_ies_smt_range(struct regmap *regmap, ...@@ -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, const struct mtk_pin_ies_smt_set *ies_smt_infos, unsigned int info_num,
unsigned int pin, unsigned char align, int value); unsigned int pin, unsigned char align, int value);
extern const struct dev_pm_ops mtk_eint_pm_ops;
#endif /* __PINCTRL_MTK_COMMON_H */ #endif /* __PINCTRL_MTK_COMMON_H */
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment