On some platforms, there are two SSUSB IPs, but the old way of usb wakeup doesn't support it, so use the new APIs of mtu_wakeup to support it.
Signed-off-by: Chunfeng Yun <chunfeng....@mediatek.com> --- drivers/usb/mtu3/mtu3.h | 2 ++ drivers/usb/mtu3/mtu3_host.c | 39 +++++++++++++++++++++++---------------- 2 files changed, 25 insertions(+), 16 deletions(-) diff --git a/drivers/usb/mtu3/mtu3.h b/drivers/usb/mtu3/mtu3.h index 3c888d9..9f3eb79 100644 --- a/drivers/usb/mtu3/mtu3.h +++ b/drivers/usb/mtu3/mtu3.h @@ -255,6 +255,8 @@ struct ssusb_mtk { /* usb wakeup for host mode */ bool wakeup_en; struct regmap *pericfg; + struct mtu_wakeup *uwk; + bool new_wakeup; }; /** diff --git a/drivers/usb/mtu3/mtu3_host.c b/drivers/usb/mtu3/mtu3_host.c index 7e948c0..f769b65 100644 --- a/drivers/usb/mtu3/mtu3_host.c +++ b/drivers/usb/mtu3/mtu3_host.c @@ -14,6 +14,7 @@ #include <linux/mfd/syscon.h> #include <linux/of_device.h> #include <linux/regmap.h> +#include <linux/soc/mediatek/usb-wakeup.h> #include "mtu3.h" #include "mtu3_dr.h" @@ -56,24 +57,26 @@ static void ssusb_wakeup_ip_sleep_dis(struct ssusb_mtk *ssusb) int ssusb_wakeup_of_property_parse(struct ssusb_mtk *ssusb, struct device_node *dn) { - struct device *dev = ssusb->dev; + /* try the new way first */ + ssusb->new_wakeup = of_property_read_bool(dn, "wakeup-source"); + if (ssusb->new_wakeup) { + ssusb->uwk = devm_of_uwk_get_by_index(ssusb->dev, dn, 0); + if (IS_ERR(ssusb->uwk)) + dev_err(ssusb->dev, "fail to get mtu_wakeup\n"); + + return PTR_ERR_OR_ZERO(ssusb->uwk); + } - /* - * Wakeup function is optional, so it is not an error if this property - * does not exist, and in such case, no need to get relative - * properties anymore. - */ + /* Wakeup function is optional. (deprecated, use the new way instead) */ ssusb->wakeup_en = of_property_read_bool(dn, "mediatek,enable-wakeup"); - if (!ssusb->wakeup_en) - return 0; - - ssusb->pericfg = syscon_regmap_lookup_by_phandle(dn, + if (ssusb->wakeup_en) { + ssusb->pericfg = syscon_regmap_lookup_by_phandle(dn, "mediatek,syscon-wakeup"); - if (IS_ERR(ssusb->pericfg)) { - dev_err(dev, "fail to get pericfg regs\n"); - return PTR_ERR(ssusb->pericfg); + if (IS_ERR(ssusb->pericfg)) { + dev_err(ssusb->dev, "fail to get pericfg regs\n"); + return PTR_ERR(ssusb->pericfg); + } } - return 0; } @@ -235,7 +238,9 @@ void ssusb_host_exit(struct ssusb_mtk *ssusb) int ssusb_wakeup_enable(struct ssusb_mtk *ssusb) { - if (ssusb->wakeup_en) + if (ssusb->new_wakeup) + mtu_wakeup_enable(ssusb->uwk); + else if (ssusb->wakeup_en) ssusb_wakeup_ip_sleep_en(ssusb); return 0; @@ -243,6 +248,8 @@ int ssusb_wakeup_enable(struct ssusb_mtk *ssusb) void ssusb_wakeup_disable(struct ssusb_mtk *ssusb) { - if (ssusb->wakeup_en) + if (ssusb->new_wakeup) + mtu_wakeup_disable(ssusb->uwk); + else if (ssusb->wakeup_en) ssusb_wakeup_ip_sleep_dis(ssusb); } -- 1.9.1