From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-9.0 required=3.0 tests=HEADER_FROM_DIFFERENT_DOMAINS, INCLUDES_PATCH,MAILING_LIST_MULTI,SIGNED_OFF_BY,SPF_PASS,USER_AGENT_GIT autolearn=ham autolearn_force=no version=3.4.0 Received: from mail.kernel.org (mail.kernel.org [198.145.29.99]) by smtp.lore.kernel.org (Postfix) with ESMTP id C2862C10F05 for ; Fri, 29 Mar 2019 04:14:46 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.kernel.org (Postfix) with ESMTP id 8409721773 for ; Fri, 29 Mar 2019 04:14:46 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1728738AbfC2EOo (ORCPT ); Fri, 29 Mar 2019 00:14:44 -0400 Received: from szxga04-in.huawei.com ([45.249.212.190]:5204 "EHLO huawei.com" rhost-flags-OK-OK-OK-FAIL) by vger.kernel.org with ESMTP id S1728660AbfC2EOi (ORCPT ); Fri, 29 Mar 2019 00:14:38 -0400 Received: from DGGEMS411-HUB.china.huawei.com (unknown [172.30.72.59]) by Forcepoint Email with ESMTP id 2489B3022D72F885C4F3; Fri, 29 Mar 2019 12:14:30 +0800 (CST) Received: from vm100-107-113-134.huawei.com (100.107.113.134) by DGGEMS411-HUB.china.huawei.com (10.3.19.211) with Microsoft SMTP Server id 14.3.408.0; Fri, 29 Mar 2019 12:14:22 +0800 From: Yu Chen To: , , CC: , , , , , , , , , , , , , , Yu Chen , Andy Shevchenko , Kishon Vijay Abraham I , "David S. Miller" , Greg Kroah-Hartman , Mauro Carvalho Chehab , Andrew Morton , "Arnd Bergmann" , Shawn Guo , Pengcheng Li , Jianguo Sun , Masahiro Yamada , Jiancheng Xue , Binghui Wang Subject: [PATCH v5 07/13] phy: Add usb phy support for hi3660 Soc of Hisilicon Date: Fri, 29 Mar 2019 12:14:03 +0800 Message-ID: <20190329041409.70138-8-chenyu56@huawei.com> X-Mailer: git-send-email 2.15.0-rc2 In-Reply-To: <20190329041409.70138-1-chenyu56@huawei.com> References: <20190329041409.70138-1-chenyu56@huawei.com> MIME-Version: 1.0 Content-Type: text/plain X-Originating-IP: [100.107.113.134] X-CFilter-Loop: Reflected Sender: linux-kernel-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org This driver handles usb phy power on and shutdown for hi3660 Soc of Hisilicon. Cc: Andy Shevchenko Cc: Kishon Vijay Abraham I Cc: "David S. Miller" Cc: Greg Kroah-Hartman Cc: Mauro Carvalho Chehab Cc: Andrew Morton Cc: Arnd Bergmann Cc: Shawn Guo Cc: Pengcheng Li Cc: Jianguo Sun Cc: Masahiro Yamada Cc: Jiancheng Xue Cc: John Stultz Cc: Binghui Wang Reviewed-by: Andy Shevchenko Signed-off-by: Yu Chen --- v1: * Remove unused code and add comment for time delay as suggested by Kishon Vijay Abraham I. v2: * Fix license declaration. * Remove redundant parens. * Remove unused member variables in struct hi3660_priv. v4: * Add comments for HI3660_USB_DEFAULT_PHY_PARAM. * Add margin for usleep_range. * Get regmap of otg_bc from parent's of_node. --- --- MAINTAINERS | 8 ++ drivers/phy/hisilicon/Kconfig | 10 ++ drivers/phy/hisilicon/Makefile | 1 + drivers/phy/hisilicon/phy-hi3660-usb3.c | 233 ++++++++++++++++++++++++++++++++ 4 files changed, 252 insertions(+) create mode 100644 drivers/phy/hisilicon/phy-hi3660-usb3.c diff --git a/MAINTAINERS b/MAINTAINERS index 3e5a5d263f29..c0057dd82dbd 100644 --- a/MAINTAINERS +++ b/MAINTAINERS @@ -16084,6 +16084,14 @@ L: linux-usb@vger.kernel.org S: Maintained F: drivers/usb/roles/intel-xhci-usb-role-switch.c +USB IP DRIVER FOR HISILICON KIRIN +M: Yu Chen +M: Binghui Wang +L: linux-usb@vger.kernel.org +S: Maintained +F: Documentation/devicetree/bindings/phy/phy-hi3660-usb3.txt +F: drivers/phy/hisilicon/phy-hi3660-usb3.c + USB ISP116X DRIVER M: Olav Kongas L: linux-usb@vger.kernel.org diff --git a/drivers/phy/hisilicon/Kconfig b/drivers/phy/hisilicon/Kconfig index b40ee54a1a50..3c142f08987c 100644 --- a/drivers/phy/hisilicon/Kconfig +++ b/drivers/phy/hisilicon/Kconfig @@ -12,6 +12,16 @@ config PHY_HI6220_USB To compile this driver as a module, choose M here. +config PHY_HI3660_USB + tristate "hi3660 USB PHY support" + depends on (ARCH_HISI && ARM64) || COMPILE_TEST + select GENERIC_PHY + select MFD_SYSCON + help + Enable this to support the HISILICON HI3660 USB PHY. + + To compile this driver as a module, choose M here. + config PHY_HISTB_COMBPHY tristate "HiSilicon STB SoCs COMBPHY support" depends on (ARCH_HISI && ARM64) || COMPILE_TEST diff --git a/drivers/phy/hisilicon/Makefile b/drivers/phy/hisilicon/Makefile index f662a4fe18d8..75ba64e2faf8 100644 --- a/drivers/phy/hisilicon/Makefile +++ b/drivers/phy/hisilicon/Makefile @@ -1,4 +1,5 @@ obj-$(CONFIG_PHY_HI6220_USB) += phy-hi6220-usb.o +obj-$(CONFIG_PHY_HI3660_USB) += phy-hi3660-usb3.o obj-$(CONFIG_PHY_HISTB_COMBPHY) += phy-histb-combphy.o obj-$(CONFIG_PHY_HISI_INNO_USB2) += phy-hisi-inno-usb2.o obj-$(CONFIG_PHY_HIX5HD2_SATA) += phy-hix5hd2-sata.o diff --git a/drivers/phy/hisilicon/phy-hi3660-usb3.c b/drivers/phy/hisilicon/phy-hi3660-usb3.c new file mode 100644 index 000000000000..cc0af2c044d0 --- /dev/null +++ b/drivers/phy/hisilicon/phy-hi3660-usb3.c @@ -0,0 +1,233 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phy provider for USB 3.0 controller on HiSilicon 3660 platform + * + * Copyright (C) 2017-2018 Hilisicon Electronics Co., Ltd. + * http://www.huawei.com + * + * Authors: Yu Chen + */ + +#include +#include +#include +#include +#include +#include + +#define PERI_CRG_CLK_EN4 0x40 +#define PERI_CRG_CLK_DIS4 0x44 +#define GT_CLK_USB3OTG_REF BIT(0) +#define GT_ACLK_USB3OTG BIT(1) + +#define PERI_CRG_RSTEN4 0x90 +#define PERI_CRG_RSTDIS4 0x94 +#define IP_RST_USB3OTGPHY_POR BIT(3) +#define IP_RST_USB3OTG BIT(5) + +#define PERI_CRG_ISODIS 0x148 +#define USB_REFCLK_ISO_EN BIT(25) + +#define PCTRL_PERI_CTRL3 0x10 +#define PCTRL_PERI_CTRL3_MSK_START 16 +#define USB_TCXO_EN BIT(1) + +#define PCTRL_PERI_CTRL24 0x64 +#define SC_CLK_USB3PHY_3MUX1_SEL BIT(25) + +#define USBOTG3_CTRL0 0x00 +#define SC_USB3PHY_ABB_GT_EN BIT(15) + +#define USBOTG3_CTRL2 0x08 +#define USBOTG3CTRL2_POWERDOWN_HSP BIT(0) +#define USBOTG3CTRL2_POWERDOWN_SSP BIT(1) + +#define USBOTG3_CTRL3 0x0C +#define USBOTG3_CTRL3_VBUSVLDEXT BIT(6) +#define USBOTG3_CTRL3_VBUSVLDEXTSEL BIT(5) + +#define USBOTG3_CTRL4 0x10 + +#define USBOTG3_CTRL7 0x1c +#define REF_SSP_EN BIT(16) + +/* This value config the default txtune parameter of the usb 2.0 phy */ +#define HI3660_USB_DEFAULT_PHY_PARAM 0x1c466e3 + +struct hi3660_priv { + struct device *dev; + struct regmap *peri_crg; + struct regmap *pctrl; + struct regmap *otg_bc; + u32 eye_diagram_param; +}; + +static int hi3660_phy_init(struct phy *phy) +{ + struct hi3660_priv *priv = phy_get_drvdata(phy); + u32 val, mask; + int ret; + + /* usb refclk iso disable */ + ret = regmap_write(priv->peri_crg, PERI_CRG_ISODIS, USB_REFCLK_ISO_EN); + if (ret) + goto out; + + /* enable usb_tcxo_en */ + val = USB_TCXO_EN | (USB_TCXO_EN << PCTRL_PERI_CTRL3_MSK_START); + ret = regmap_write(priv->pctrl, PCTRL_PERI_CTRL3, val); + if (ret) + goto out; + + /* assert phy */ + val = IP_RST_USB3OTGPHY_POR | IP_RST_USB3OTG; + ret = regmap_write(priv->peri_crg, PERI_CRG_RSTEN4, val); + if (ret) + goto out; + + /* enable phy ref clk */ + val = SC_USB3PHY_ABB_GT_EN; + mask = val; + ret = regmap_update_bits(priv->otg_bc, USBOTG3_CTRL0, mask, val); + if (ret) + goto out; + + val = REF_SSP_EN; + mask = val; + ret = regmap_update_bits(priv->otg_bc, USBOTG3_CTRL7, mask, val); + if (ret) + goto out; + + /* exit from IDDQ mode */ + mask = USBOTG3CTRL2_POWERDOWN_HSP | USBOTG3CTRL2_POWERDOWN_SSP; + ret = regmap_update_bits(priv->otg_bc, USBOTG3_CTRL2, mask, 0); + if (ret) + goto out; + + /* delay for exit from IDDQ mode */ + usleep_range(100, 120); + + /* deassert phy */ + val = IP_RST_USB3OTGPHY_POR | IP_RST_USB3OTG; + ret = regmap_write(priv->peri_crg, PERI_CRG_RSTDIS4, val); + if (ret) + goto out; + + /* delay for phy deasserted */ + usleep_range(10000, 15000); + + /* fake vbus valid signal */ + val = USBOTG3_CTRL3_VBUSVLDEXT | USBOTG3_CTRL3_VBUSVLDEXTSEL; + mask = val; + ret = regmap_update_bits(priv->otg_bc, USBOTG3_CTRL3, mask, val); + if (ret) + goto out; + + /* delay for vbus valid */ + usleep_range(100, 120); + + ret = regmap_write(priv->otg_bc, USBOTG3_CTRL4, + priv->eye_diagram_param); + if (ret) + goto out; + + return 0; +out: + dev_err(priv->dev, "failed to init phy ret: %d\n", ret); + return ret; +} + +static int hi3660_phy_exit(struct phy *phy) +{ + struct hi3660_priv *priv = phy_get_drvdata(phy); + u32 val; + int ret; + + /* assert phy */ + val = IP_RST_USB3OTGPHY_POR; + ret = regmap_write(priv->peri_crg, PERI_CRG_RSTEN4, val); + if (ret) + goto out; + + /* disable usb_tcxo_en */ + val = USB_TCXO_EN << PCTRL_PERI_CTRL3_MSK_START; + ret = regmap_write(priv->pctrl, PCTRL_PERI_CTRL3, val); + if (ret) + goto out; + + return 0; +out: + dev_err(priv->dev, "failed to exit phy ret: %d\n", ret); + return ret; +} + +static struct phy_ops hi3660_phy_ops = { + .init = hi3660_phy_init, + .exit = hi3660_phy_exit, + .owner = THIS_MODULE, +}; + +static int hi3660_phy_probe(struct platform_device *pdev) +{ + struct phy_provider *phy_provider; + struct device *dev = &pdev->dev; + struct phy *phy; + struct hi3660_priv *priv; + + priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); + if (!priv) + return -ENOMEM; + + priv->dev = dev; + priv->peri_crg = syscon_regmap_lookup_by_phandle(dev->of_node, + "hisilicon,pericrg-syscon"); + if (IS_ERR(priv->peri_crg)) { + dev_err(dev, "no hisilicon,pericrg-syscon\n"); + return PTR_ERR(priv->peri_crg); + } + + priv->pctrl = syscon_regmap_lookup_by_phandle(dev->of_node, + "hisilicon,pctrl-syscon"); + if (IS_ERR(priv->pctrl)) { + dev_err(dev, "no hisilicon,pctrl-syscon\n"); + return PTR_ERR(priv->pctrl); + } + + /* node of hi3660 phy is a sub-node of usb3_otg_bc */ + priv->otg_bc = syscon_node_to_regmap(dev->parent->of_node); + if (IS_ERR(priv->otg_bc)) { + dev_err(dev, "no hisilicon,usb3-otg-bc-syscon\n"); + return PTR_ERR(priv->otg_bc); + } + + if (of_property_read_u32(dev->of_node, "hisilicon,eye-diagram-param", + &(priv->eye_diagram_param))) + priv->eye_diagram_param = HI3660_USB_DEFAULT_PHY_PARAM; + + phy = devm_phy_create(dev, NULL, &hi3660_phy_ops); + if (IS_ERR(phy)) + return PTR_ERR(phy); + + phy_set_drvdata(phy, priv); + phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate); + return PTR_ERR_OR_ZERO(phy_provider); +} + +static const struct of_device_id hi3660_phy_of_match[] = { + {.compatible = "hisilicon,hi3660-usb-phy",}, + { } +}; +MODULE_DEVICE_TABLE(of, hi3660_phy_of_match); + +static struct platform_driver hi3660_phy_driver = { + .probe = hi3660_phy_probe, + .driver = { + .name = "hi3660-usb-phy", + .of_match_table = hi3660_phy_of_match, + } +}; +module_platform_driver(hi3660_phy_driver); + +MODULE_AUTHOR("Yu Chen "); +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("Hilisicon Hi3660 USB3 PHY Driver"); -- 2.15.0-rc2 From mboxrd@z Thu Jan 1 00:00:00 1970 From: Yu Chen Subject: [PATCH v5 07/13] phy: Add usb phy support for hi3660 Soc of Hisilicon Date: Fri, 29 Mar 2019 12:14:03 +0800 Message-ID: <20190329041409.70138-8-chenyu56@huawei.com> References: <20190329041409.70138-1-chenyu56@huawei.com> Mime-Version: 1.0 Content-Type: text/plain Return-path: In-Reply-To: <20190329041409.70138-1-chenyu56@huawei.com> Sender: linux-kernel-owner@vger.kernel.org To: linux-usb@vger.kernel.org, devicetree@vger.kernel.org, linux-kernel@vger.kernel.org Cc: john.stultz@linaro.org, suzhuangluan@hisilicon.com, kongfei@hisilicon.com, liuyu712@hisilicon.com, wanghu17@hisilicon.com, butao@hisilicon.com, chenyao11@huawei.com, fangshengzhou@hisilicon.com, lipengcheng8@huawei.com, songxiaowei@hisilicon.com, xuyiping@hisilicon.com, xuyoujun4@huawei.com, yudongbin@hisilicon.com, zangleigang@hisilicon.com, Yu Chen , Andy Shevchenko , Kishon Vijay Abraham I , "David S. Miller" , Greg Kroah-Hartman , Mauro Carvalho Chehab , Andrew Morton , Arnd Bergmann , Shawn Guo , Pengcheng Li List-Id: devicetree@vger.kernel.org This driver handles usb phy power on and shutdown for hi3660 Soc of Hisilicon. Cc: Andy Shevchenko Cc: Kishon Vijay Abraham I Cc: "David S. Miller" Cc: Greg Kroah-Hartman Cc: Mauro Carvalho Chehab Cc: Andrew Morton Cc: Arnd Bergmann Cc: Shawn Guo Cc: Pengcheng Li Cc: Jianguo Sun Cc: Masahiro Yamada Cc: Jiancheng Xue Cc: John Stultz Cc: Binghui Wang Reviewed-by: Andy Shevchenko Signed-off-by: Yu Chen --- v1: * Remove unused code and add comment for time delay as suggested by Kishon Vijay Abraham I. v2: * Fix license declaration. * Remove redundant parens. * Remove unused member variables in struct hi3660_priv. v4: * Add comments for HI3660_USB_DEFAULT_PHY_PARAM. * Add margin for usleep_range. * Get regmap of otg_bc from parent's of_node. --- --- MAINTAINERS | 8 ++ drivers/phy/hisilicon/Kconfig | 10 ++ drivers/phy/hisilicon/Makefile | 1 + drivers/phy/hisilicon/phy-hi3660-usb3.c | 233 ++++++++++++++++++++++++++++++++ 4 files changed, 252 insertions(+) create mode 100644 drivers/phy/hisilicon/phy-hi3660-usb3.c diff --git a/MAINTAINERS b/MAINTAINERS index 3e5a5d263f29..c0057dd82dbd 100644 --- a/MAINTAINERS +++ b/MAINTAINERS @@ -16084,6 +16084,14 @@ L: linux-usb@vger.kernel.org S: Maintained F: drivers/usb/roles/intel-xhci-usb-role-switch.c +USB IP DRIVER FOR HISILICON KIRIN +M: Yu Chen +M: Binghui Wang +L: linux-usb@vger.kernel.org +S: Maintained +F: Documentation/devicetree/bindings/phy/phy-hi3660-usb3.txt +F: drivers/phy/hisilicon/phy-hi3660-usb3.c + USB ISP116X DRIVER M: Olav Kongas L: linux-usb@vger.kernel.org diff --git a/drivers/phy/hisilicon/Kconfig b/drivers/phy/hisilicon/Kconfig index b40ee54a1a50..3c142f08987c 100644 --- a/drivers/phy/hisilicon/Kconfig +++ b/drivers/phy/hisilicon/Kconfig @@ -12,6 +12,16 @@ config PHY_HI6220_USB To compile this driver as a module, choose M here. +config PHY_HI3660_USB + tristate "hi3660 USB PHY support" + depends on (ARCH_HISI && ARM64) || COMPILE_TEST + select GENERIC_PHY + select MFD_SYSCON + help + Enable this to support the HISILICON HI3660 USB PHY. + + To compile this driver as a module, choose M here. + config PHY_HISTB_COMBPHY tristate "HiSilicon STB SoCs COMBPHY support" depends on (ARCH_HISI && ARM64) || COMPILE_TEST diff --git a/drivers/phy/hisilicon/Makefile b/drivers/phy/hisilicon/Makefile index f662a4fe18d8..75ba64e2faf8 100644 --- a/drivers/phy/hisilicon/Makefile +++ b/drivers/phy/hisilicon/Makefile @@ -1,4 +1,5 @@ obj-$(CONFIG_PHY_HI6220_USB) += phy-hi6220-usb.o +obj-$(CONFIG_PHY_HI3660_USB) += phy-hi3660-usb3.o obj-$(CONFIG_PHY_HISTB_COMBPHY) += phy-histb-combphy.o obj-$(CONFIG_PHY_HISI_INNO_USB2) += phy-hisi-inno-usb2.o obj-$(CONFIG_PHY_HIX5HD2_SATA) += phy-hix5hd2-sata.o diff --git a/drivers/phy/hisilicon/phy-hi3660-usb3.c b/drivers/phy/hisilicon/phy-hi3660-usb3.c new file mode 100644 index 000000000000..cc0af2c044d0 --- /dev/null +++ b/drivers/phy/hisilicon/phy-hi3660-usb3.c @@ -0,0 +1,233 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Phy provider for USB 3.0 controller on HiSilicon 3660 platform + * + * Copyright (C) 2017-2018 Hilisicon Electronics Co., Ltd. + * http://www.huawei.com + * + * Authors: Yu Chen + */ + +#include +#include +#include +#include +#include +#include + +#define PERI_CRG_CLK_EN4 0x40 +#define PERI_CRG_CLK_DIS4 0x44 +#define GT_CLK_USB3OTG_REF BIT(0) +#define GT_ACLK_USB3OTG BIT(1) + +#define PERI_CRG_RSTEN4 0x90 +#define PERI_CRG_RSTDIS4 0x94 +#define IP_RST_USB3OTGPHY_POR BIT(3) +#define IP_RST_USB3OTG BIT(5) + +#define PERI_CRG_ISODIS 0x148 +#define USB_REFCLK_ISO_EN BIT(25) + +#define PCTRL_PERI_CTRL3 0x10 +#define PCTRL_PERI_CTRL3_MSK_START 16 +#define USB_TCXO_EN BIT(1) + +#define PCTRL_PERI_CTRL24 0x64 +#define SC_CLK_USB3PHY_3MUX1_SEL BIT(25) + +#define USBOTG3_CTRL0 0x00 +#define SC_USB3PHY_ABB_GT_EN BIT(15) + +#define USBOTG3_CTRL2 0x08 +#define USBOTG3CTRL2_POWERDOWN_HSP BIT(0) +#define USBOTG3CTRL2_POWERDOWN_SSP BIT(1) + +#define USBOTG3_CTRL3 0x0C +#define USBOTG3_CTRL3_VBUSVLDEXT BIT(6) +#define USBOTG3_CTRL3_VBUSVLDEXTSEL BIT(5) + +#define USBOTG3_CTRL4 0x10 + +#define USBOTG3_CTRL7 0x1c +#define REF_SSP_EN BIT(16) + +/* This value config the default txtune parameter of the usb 2.0 phy */ +#define HI3660_USB_DEFAULT_PHY_PARAM 0x1c466e3 + +struct hi3660_priv { + struct device *dev; + struct regmap *peri_crg; + struct regmap *pctrl; + struct regmap *otg_bc; + u32 eye_diagram_param; +}; + +static int hi3660_phy_init(struct phy *phy) +{ + struct hi3660_priv *priv = phy_get_drvdata(phy); + u32 val, mask; + int ret; + + /* usb refclk iso disable */ + ret = regmap_write(priv->peri_crg, PERI_CRG_ISODIS, USB_REFCLK_ISO_EN); + if (ret) + goto out; + + /* enable usb_tcxo_en */ + val = USB_TCXO_EN | (USB_TCXO_EN << PCTRL_PERI_CTRL3_MSK_START); + ret = regmap_write(priv->pctrl, PCTRL_PERI_CTRL3, val); + if (ret) + goto out; + + /* assert phy */ + val = IP_RST_USB3OTGPHY_POR | IP_RST_USB3OTG; + ret = regmap_write(priv->peri_crg, PERI_CRG_RSTEN4, val); + if (ret) + goto out; + + /* enable phy ref clk */ + val = SC_USB3PHY_ABB_GT_EN; + mask = val; + ret = regmap_update_bits(priv->otg_bc, USBOTG3_CTRL0, mask, val); + if (ret) + goto out; + + val = REF_SSP_EN; + mask = val; + ret = regmap_update_bits(priv->otg_bc, USBOTG3_CTRL7, mask, val); + if (ret) + goto out; + + /* exit from IDDQ mode */ + mask = USBOTG3CTRL2_POWERDOWN_HSP | USBOTG3CTRL2_POWERDOWN_SSP; + ret = regmap_update_bits(priv->otg_bc, USBOTG3_CTRL2, mask, 0); + if (ret) + goto out; + + /* delay for exit from IDDQ mode */ + usleep_range(100, 120); + + /* deassert phy */ + val = IP_RST_USB3OTGPHY_POR | IP_RST_USB3OTG; + ret = regmap_write(priv->peri_crg, PERI_CRG_RSTDIS4, val); + if (ret) + goto out; + + /* delay for phy deasserted */ + usleep_range(10000, 15000); + + /* fake vbus valid signal */ + val = USBOTG3_CTRL3_VBUSVLDEXT | USBOTG3_CTRL3_VBUSVLDEXTSEL; + mask = val; + ret = regmap_update_bits(priv->otg_bc, USBOTG3_CTRL3, mask, val); + if (ret) + goto out; + + /* delay for vbus valid */ + usleep_range(100, 120); + + ret = regmap_write(priv->otg_bc, USBOTG3_CTRL4, + priv->eye_diagram_param); + if (ret) + goto out; + + return 0; +out: + dev_err(priv->dev, "failed to init phy ret: %d\n", ret); + return ret; +} + +static int hi3660_phy_exit(struct phy *phy) +{ + struct hi3660_priv *priv = phy_get_drvdata(phy); + u32 val; + int ret; + + /* assert phy */ + val = IP_RST_USB3OTGPHY_POR; + ret = regmap_write(priv->peri_crg, PERI_CRG_RSTEN4, val); + if (ret) + goto out; + + /* disable usb_tcxo_en */ + val = USB_TCXO_EN << PCTRL_PERI_CTRL3_MSK_START; + ret = regmap_write(priv->pctrl, PCTRL_PERI_CTRL3, val); + if (ret) + goto out; + + return 0; +out: + dev_err(priv->dev, "failed to exit phy ret: %d\n", ret); + return ret; +} + +static struct phy_ops hi3660_phy_ops = { + .init = hi3660_phy_init, + .exit = hi3660_phy_exit, + .owner = THIS_MODULE, +}; + +static int hi3660_phy_probe(struct platform_device *pdev) +{ + struct phy_provider *phy_provider; + struct device *dev = &pdev->dev; + struct phy *phy; + struct hi3660_priv *priv; + + priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); + if (!priv) + return -ENOMEM; + + priv->dev = dev; + priv->peri_crg = syscon_regmap_lookup_by_phandle(dev->of_node, + "hisilicon,pericrg-syscon"); + if (IS_ERR(priv->peri_crg)) { + dev_err(dev, "no hisilicon,pericrg-syscon\n"); + return PTR_ERR(priv->peri_crg); + } + + priv->pctrl = syscon_regmap_lookup_by_phandle(dev->of_node, + "hisilicon,pctrl-syscon"); + if (IS_ERR(priv->pctrl)) { + dev_err(dev, "no hisilicon,pctrl-syscon\n"); + return PTR_ERR(priv->pctrl); + } + + /* node of hi3660 phy is a sub-node of usb3_otg_bc */ + priv->otg_bc = syscon_node_to_regmap(dev->parent->of_node); + if (IS_ERR(priv->otg_bc)) { + dev_err(dev, "no hisilicon,usb3-otg-bc-syscon\n"); + return PTR_ERR(priv->otg_bc); + } + + if (of_property_read_u32(dev->of_node, "hisilicon,eye-diagram-param", + &(priv->eye_diagram_param))) + priv->eye_diagram_param = HI3660_USB_DEFAULT_PHY_PARAM; + + phy = devm_phy_create(dev, NULL, &hi3660_phy_ops); + if (IS_ERR(phy)) + return PTR_ERR(phy); + + phy_set_drvdata(phy, priv); + phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate); + return PTR_ERR_OR_ZERO(phy_provider); +} + +static const struct of_device_id hi3660_phy_of_match[] = { + {.compatible = "hisilicon,hi3660-usb-phy",}, + { } +}; +MODULE_DEVICE_TABLE(of, hi3660_phy_of_match); + +static struct platform_driver hi3660_phy_driver = { + .probe = hi3660_phy_probe, + .driver = { + .name = "hi3660-usb-phy", + .of_match_table = hi3660_phy_of_match, + } +}; +module_platform_driver(hi3660_phy_driver); + +MODULE_AUTHOR("Yu Chen "); +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("Hilisicon Hi3660 USB3 PHY Driver"); -- 2.15.0-rc2 From mboxrd@z Thu Jan 1 00:00:00 1970 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: base64 Subject: [v5,07/13] phy: Add usb phy support for hi3660 Soc of Hisilicon From: Yu Chen Message-Id: <20190329041409.70138-8-chenyu56@huawei.com> Date: Fri, 29 Mar 2019 12:14:03 +0800 To: linux-usb@vger.kernel.org, devicetree@vger.kernel.org, linux-kernel@vger.kernel.org Cc: john.stultz@linaro.org, suzhuangluan@hisilicon.com, kongfei@hisilicon.com, liuyu712@hisilicon.com, wanghu17@hisilicon.com, butao@hisilicon.com, chenyao11@huawei.com, fangshengzhou@hisilicon.com, lipengcheng8@huawei.com, songxiaowei@hisilicon.com, xuyiping@hisilicon.com, xuyoujun4@huawei.com, yudongbin@hisilicon.com, zangleigang@hisilicon.com, Yu Chen , Andy Shevchenko , Kishon Vijay Abraham I , "David S. Miller" , Greg Kroah-Hartman , Mauro Carvalho Chehab , Andrew Morton , Arnd Bergmann , Shawn Guo , Pengcheng Li , Jianguo Sun , Masahiro Yamada , Jiancheng Xue , Binghui Wang List-ID: VGhpcyBkcml2ZXIgaGFuZGxlcyB1c2IgcGh5IHBvd2VyIG9uIGFuZCBzaHV0ZG93biBmb3IgaGkz NjYwIFNvYyBvZgpIaXNpbGljb24uCgpDYzogQW5keSBTaGV2Y2hlbmtvIDxhbmR5LnNoZXZjaGVu a29AZ21haWwuY29tPgpDYzogS2lzaG9uIFZpamF5IEFicmFoYW0gSSA8a2lzaG9uQHRpLmNvbT4K Q2M6ICJEYXZpZCBTLiBNaWxsZXIiIDxkYXZlbUBkYXZlbWxvZnQubmV0PgpDYzogR3JlZyBLcm9h aC1IYXJ0bWFuIDxncmVna2hAbGludXhmb3VuZGF0aW9uLm9yZz4KQ2M6IE1hdXJvIENhcnZhbGhv IENoZWhhYiA8bWNoZWhhYitzYW1zdW5nQGtlcm5lbC5vcmc+CkNjOiBBbmRyZXcgTW9ydG9uIDxh a3BtQGxpbnV4LWZvdW5kYXRpb24ub3JnPgpDYzogQXJuZCBCZXJnbWFubiA8YXJuZEBhcm5kYi5k ZT4KQ2M6IFNoYXduIEd1byA8c2hhd25ndW9Aa2VybmVsLm9yZz4KQ2M6IFBlbmdjaGVuZyBMaSA8 bHBjLmxpQGhpc2lsaWNvbi5jb20+CkNjOiBKaWFuZ3VvIFN1biA8c3Vuamlhbmd1bzFAaHVhd2Vp LmNvbT4KQ2M6IE1hc2FoaXJvIFlhbWFkYSA8eWFtYWRhLm1hc2FoaXJvQHNvY2lvbmV4dC5jb20+ CkNjOiBKaWFuY2hlbmcgWHVlIDx4dWVqaWFuY2hlbmdAaGlzaWxpY29uLmNvbT4KQ2M6IEpvaG4g U3R1bHR6IDxqb2huLnN0dWx0ekBsaW5hcm8ub3JnPgpDYzogQmluZ2h1aSBXYW5nIDx3YW5nYmlu Z2h1aUBoaXNpbGljb24uY29tPgpSZXZpZXdlZC1ieTogQW5keSBTaGV2Y2hlbmtvIDxhbmR5LnNo ZXZjaGVua29AZ21haWwuY29tPgpTaWduZWQtb2ZmLWJ5OiBZdSBDaGVuIDxjaGVueXU1NkBodWF3 ZWkuY29tPgotLS0KdjE6CiogUmVtb3ZlIHVudXNlZCBjb2RlIGFuZCBhZGQgY29tbWVudCBmb3Ig dGltZSBkZWxheSBhcyBzdWdnZXN0ZWQgYnkKS2lzaG9uIFZpamF5IEFicmFoYW0gSS4KdjI6Ciog Rml4IGxpY2Vuc2UgZGVjbGFyYXRpb24uCiogUmVtb3ZlIHJlZHVuZGFudCBwYXJlbnMuCiogUmVt b3ZlIHVudXNlZCBtZW1iZXIgdmFyaWFibGVzIGluIHN0cnVjdCBoaTM2NjBfcHJpdi4KdjQ6Ciog QWRkIGNvbW1lbnRzIGZvciBISTM2NjBfVVNCX0RFRkFVTFRfUEhZX1BBUkFNLgoqIEFkZCBtYXJn aW4gZm9yIHVzbGVlcF9yYW5nZS4KKiBHZXQgcmVnbWFwIG9mIG90Z19iYyBmcm9tIHBhcmVudCdz IG9mX25vZGUuCi0tLQotLS0KIE1BSU5UQUlORVJTICAgICAgICAgICAgICAgICAgICAgICAgICAg ICB8ICAgOCArKwogZHJpdmVycy9waHkvaGlzaWxpY29uL0tjb25maWcgICAgICAgICAgIHwgIDEw ICsrCiBkcml2ZXJzL3BoeS9oaXNpbGljb24vTWFrZWZpbGUgICAgICAgICAgfCAgIDEgKwogZHJp dmVycy9waHkvaGlzaWxpY29uL3BoeS1oaTM2NjAtdXNiMy5jIHwgMjMzICsrKysrKysrKysrKysr KysrKysrKysrKysrKysrKysrCiA0IGZpbGVzIGNoYW5nZWQsIDI1MiBpbnNlcnRpb25zKCspCiBj cmVhdGUgbW9kZSAxMDA2NDQgZHJpdmVycy9waHkvaGlzaWxpY29uL3BoeS1oaTM2NjAtdXNiMy5j CgpkaWZmIC0tZ2l0IGEvTUFJTlRBSU5FUlMgYi9NQUlOVEFJTkVSUwppbmRleCAzZTVhNWQyNjNm MjkuLmMwMDU3ZGQ4MmRiZCAxMDA2NDQKLS0tIGEvTUFJTlRBSU5FUlMKKysrIGIvTUFJTlRBSU5F UlMKQEAgLTE2MDg0LDYgKzE2MDg0LDE0IEBAIEw6CWxpbnV4LXVzYkB2Z2VyLmtlcm5lbC5vcmcK IFM6CU1haW50YWluZWQKIEY6CWRyaXZlcnMvdXNiL3JvbGVzL2ludGVsLXhoY2ktdXNiLXJvbGUt c3dpdGNoLmMKIAorVVNCIElQIERSSVZFUiBGT1IgSElTSUxJQ09OIEtJUklOCitNOglZdSBDaGVu IDxjaGVueXU1NkBodWF3ZWkuY29tPgorTToJQmluZ2h1aSBXYW5nIDx3YW5nYmluZ2h1aUBoaXNp bGljb24uY29tPgorTDoJbGludXgtdXNiQHZnZXIua2VybmVsLm9yZworUzoJTWFpbnRhaW5lZAor RjoJRG9jdW1lbnRhdGlvbi9kZXZpY2V0cmVlL2JpbmRpbmdzL3BoeS9waHktaGkzNjYwLXVzYjMu dHh0CitGOglkcml2ZXJzL3BoeS9oaXNpbGljb24vcGh5LWhpMzY2MC11c2IzLmMKKwogVVNCIElT UDExNlggRFJJVkVSCiBNOglPbGF2IEtvbmdhcyA8b2tAYXJ0ZWNkZXNpZ24uZWU+CiBMOglsaW51 eC11c2JAdmdlci5rZXJuZWwub3JnCmRpZmYgLS1naXQgYS9kcml2ZXJzL3BoeS9oaXNpbGljb24v S2NvbmZpZyBiL2RyaXZlcnMvcGh5L2hpc2lsaWNvbi9LY29uZmlnCmluZGV4IGI0MGVlNTRhMWE1 MC4uM2MxNDJmMDg5ODdjIDEwMDY0NAotLS0gYS9kcml2ZXJzL3BoeS9oaXNpbGljb24vS2NvbmZp ZworKysgYi9kcml2ZXJzL3BoeS9oaXNpbGljb24vS2NvbmZpZwpAQCAtMTIsNiArMTIsMTYgQEAg Y29uZmlnIFBIWV9ISTYyMjBfVVNCCiAKIAkgIFRvIGNvbXBpbGUgdGhpcyBkcml2ZXIgYXMgYSBt b2R1bGUsIGNob29zZSBNIGhlcmUuCiAKK2NvbmZpZyBQSFlfSEkzNjYwX1VTQgorCXRyaXN0YXRl ICJoaTM2NjAgVVNCIFBIWSBzdXBwb3J0IgorCWRlcGVuZHMgb24gKEFSQ0hfSElTSSAmJiBBUk02 NCkgfHwgQ09NUElMRV9URVNUCisJc2VsZWN0IEdFTkVSSUNfUEhZCisJc2VsZWN0IE1GRF9TWVND T04KKwloZWxwCisJICBFbmFibGUgdGhpcyB0byBzdXBwb3J0IHRoZSBISVNJTElDT04gSEkzNjYw IFVTQiBQSFkuCisKKwkgIFRvIGNvbXBpbGUgdGhpcyBkcml2ZXIgYXMgYSBtb2R1bGUsIGNob29z ZSBNIGhlcmUuCisKIGNvbmZpZyBQSFlfSElTVEJfQ09NQlBIWQogCXRyaXN0YXRlICJIaVNpbGlj b24gU1RCIFNvQ3MgQ09NQlBIWSBzdXBwb3J0IgogCWRlcGVuZHMgb24gKEFSQ0hfSElTSSAmJiBB Uk02NCkgfHwgQ09NUElMRV9URVNUCmRpZmYgLS1naXQgYS9kcml2ZXJzL3BoeS9oaXNpbGljb24v TWFrZWZpbGUgYi9kcml2ZXJzL3BoeS9oaXNpbGljb24vTWFrZWZpbGUKaW5kZXggZjY2MmE0ZmUx OGQ4Li43NWJhNjRlMmZhZjggMTAwNjQ0Ci0tLSBhL2RyaXZlcnMvcGh5L2hpc2lsaWNvbi9NYWtl ZmlsZQorKysgYi9kcml2ZXJzL3BoeS9oaXNpbGljb24vTWFrZWZpbGUKQEAgLTEsNCArMSw1IEBA CiBvYmotJChDT05GSUdfUEhZX0hJNjIyMF9VU0IpCQkrPSBwaHktaGk2MjIwLXVzYi5vCitvYmot JChDT05GSUdfUEhZX0hJMzY2MF9VU0IpCQkrPSBwaHktaGkzNjYwLXVzYjMubwogb2JqLSQoQ09O RklHX1BIWV9ISVNUQl9DT01CUEhZKQkJKz0gcGh5LWhpc3RiLWNvbWJwaHkubwogb2JqLSQoQ09O RklHX1BIWV9ISVNJX0lOTk9fVVNCMikJKz0gcGh5LWhpc2ktaW5uby11c2IyLm8KIG9iai0kKENP TkZJR19QSFlfSElYNUhEMl9TQVRBKQkJKz0gcGh5LWhpeDVoZDItc2F0YS5vCmRpZmYgLS1naXQg YS9kcml2ZXJzL3BoeS9oaXNpbGljb24vcGh5LWhpMzY2MC11c2IzLmMgYi9kcml2ZXJzL3BoeS9o aXNpbGljb24vcGh5LWhpMzY2MC11c2IzLmMKbmV3IGZpbGUgbW9kZSAxMDA2NDQKaW5kZXggMDAw MDAwMDAwMDAwLi5jYzBhZjJjMDQ0ZDAKLS0tIC9kZXYvbnVsbAorKysgYi9kcml2ZXJzL3BoeS9o aXNpbGljb24vcGh5LWhpMzY2MC11c2IzLmMKQEAgLTAsMCArMSwyMzMgQEAKKy8vIFNQRFgtTGlj ZW5zZS1JZGVudGlmaWVyOiBHUEwtMi4wCisvKgorICogUGh5IHByb3ZpZGVyIGZvciBVU0IgMy4w IGNvbnRyb2xsZXIgb24gSGlTaWxpY29uIDM2NjAgcGxhdGZvcm0KKyAqCisgKiBDb3B5cmlnaHQg KEMpIDIwMTctMjAxOCBIaWxpc2ljb24gRWxlY3Ryb25pY3MgQ28uLCBMdGQuCisgKgkJaHR0cDov L3d3dy5odWF3ZWkuY29tCisgKgorICogQXV0aG9yczogWXUgQ2hlbiA8Y2hlbnl1NTZAaHVhd2Vp LmNvbT4KKyAqLworCisjaW5jbHVkZSA8bGludXgva2VybmVsLmg+CisjaW5jbHVkZSA8bGludXgv bWZkL3N5c2Nvbi5oPgorI2luY2x1ZGUgPGxpbnV4L21vZHVsZS5oPgorI2luY2x1ZGUgPGxpbnV4 L3BoeS9waHkuaD4KKyNpbmNsdWRlIDxsaW51eC9wbGF0Zm9ybV9kZXZpY2UuaD4KKyNpbmNsdWRl IDxsaW51eC9yZWdtYXAuaD4KKworI2RlZmluZSBQRVJJX0NSR19DTEtfRU40CQkJMHg0MAorI2Rl ZmluZSBQRVJJX0NSR19DTEtfRElTNAkJCTB4NDQKKyNkZWZpbmUgR1RfQ0xLX1VTQjNPVEdfUkVG CQkJQklUKDApCisjZGVmaW5lIEdUX0FDTEtfVVNCM09URwkJCQlCSVQoMSkKKworI2RlZmluZSBQ RVJJX0NSR19SU1RFTjQJCQkJMHg5MAorI2RlZmluZSBQRVJJX0NSR19SU1RESVM0CQkJMHg5NAor I2RlZmluZSBJUF9SU1RfVVNCM09UR1BIWV9QT1IJCQlCSVQoMykKKyNkZWZpbmUgSVBfUlNUX1VT QjNPVEcJCQkJQklUKDUpCisKKyNkZWZpbmUgUEVSSV9DUkdfSVNPRElTCQkJCTB4MTQ4CisjZGVm aW5lIFVTQl9SRUZDTEtfSVNPX0VOCQkJQklUKDI1KQorCisjZGVmaW5lIFBDVFJMX1BFUklfQ1RS TDMJCQkweDEwCisjZGVmaW5lIFBDVFJMX1BFUklfQ1RSTDNfTVNLX1NUQVJUCQkxNgorI2RlZmlu ZSBVU0JfVENYT19FTgkJCQlCSVQoMSkKKworI2RlZmluZSBQQ1RSTF9QRVJJX0NUUkwyNAkJCTB4 NjQKKyNkZWZpbmUgU0NfQ0xLX1VTQjNQSFlfM01VWDFfU0VMCQlCSVQoMjUpCisKKyNkZWZpbmUg VVNCT1RHM19DVFJMMAkJCQkweDAwCisjZGVmaW5lIFNDX1VTQjNQSFlfQUJCX0dUX0VOCQkJQklU KDE1KQorCisjZGVmaW5lIFVTQk9URzNfQ1RSTDIJCQkJMHgwOAorI2RlZmluZSBVU0JPVEczQ1RS TDJfUE9XRVJET1dOX0hTUAkJQklUKDApCisjZGVmaW5lIFVTQk9URzNDVFJMMl9QT1dFUkRPV05f U1NQCQlCSVQoMSkKKworI2RlZmluZSBVU0JPVEczX0NUUkwzCQkJCTB4MEMKKyNkZWZpbmUgVVNC T1RHM19DVFJMM19WQlVTVkxERVhUCQlCSVQoNikKKyNkZWZpbmUgVVNCT1RHM19DVFJMM19WQlVT VkxERVhUU0VMCQlCSVQoNSkKKworI2RlZmluZSBVU0JPVEczX0NUUkw0CQkJCTB4MTAKKworI2Rl ZmluZSBVU0JPVEczX0NUUkw3CQkJCTB4MWMKKyNkZWZpbmUgUkVGX1NTUF9FTgkJCQlCSVQoMTYp CisKKy8qIFRoaXMgdmFsdWUgY29uZmlnIHRoZSBkZWZhdWx0IHR4dHVuZSBwYXJhbWV0ZXIgb2Yg dGhlIHVzYiAyLjAgcGh5ICovCisjZGVmaW5lIEhJMzY2MF9VU0JfREVGQVVMVF9QSFlfUEFSQU0J CTB4MWM0NjZlMworCitzdHJ1Y3QgaGkzNjYwX3ByaXYgeworCXN0cnVjdCBkZXZpY2UgKmRldjsK KwlzdHJ1Y3QgcmVnbWFwICpwZXJpX2NyZzsKKwlzdHJ1Y3QgcmVnbWFwICpwY3RybDsKKwlzdHJ1 Y3QgcmVnbWFwICpvdGdfYmM7CisJdTMyIGV5ZV9kaWFncmFtX3BhcmFtOworfTsKKworc3RhdGlj IGludCBoaTM2NjBfcGh5X2luaXQoc3RydWN0IHBoeSAqcGh5KQoreworCXN0cnVjdCBoaTM2NjBf cHJpdiAqcHJpdiA9IHBoeV9nZXRfZHJ2ZGF0YShwaHkpOworCXUzMiB2YWwsIG1hc2s7CisJaW50 IHJldDsKKworCS8qIHVzYiByZWZjbGsgaXNvIGRpc2FibGUgKi8KKwlyZXQgPSByZWdtYXBfd3Jp dGUocHJpdi0+cGVyaV9jcmcsIFBFUklfQ1JHX0lTT0RJUywgVVNCX1JFRkNMS19JU09fRU4pOwor CWlmIChyZXQpCisJCWdvdG8gb3V0OworCisJLyogZW5hYmxlIHVzYl90Y3hvX2VuICovCisJdmFs ID0gVVNCX1RDWE9fRU4gfCAoVVNCX1RDWE9fRU4gPDwgUENUUkxfUEVSSV9DVFJMM19NU0tfU1RB UlQpOworCXJldCA9IHJlZ21hcF93cml0ZShwcml2LT5wY3RybCwgUENUUkxfUEVSSV9DVFJMMywg dmFsKTsKKwlpZiAocmV0KQorCQlnb3RvIG91dDsKKworCS8qIGFzc2VydCBwaHkgKi8KKwl2YWwg PSBJUF9SU1RfVVNCM09UR1BIWV9QT1IgfCBJUF9SU1RfVVNCM09URzsKKwlyZXQgPSByZWdtYXBf d3JpdGUocHJpdi0+cGVyaV9jcmcsIFBFUklfQ1JHX1JTVEVONCwgdmFsKTsKKwlpZiAocmV0KQor CQlnb3RvIG91dDsKKworCS8qIGVuYWJsZSBwaHkgcmVmIGNsayAqLworCXZhbCA9IFNDX1VTQjNQ SFlfQUJCX0dUX0VOOworCW1hc2sgPSB2YWw7CisJcmV0ID0gcmVnbWFwX3VwZGF0ZV9iaXRzKHBy aXYtPm90Z19iYywgVVNCT1RHM19DVFJMMCwgbWFzaywgdmFsKTsKKwlpZiAocmV0KQorCQlnb3Rv IG91dDsKKworCXZhbCA9IFJFRl9TU1BfRU47CisJbWFzayA9IHZhbDsKKwlyZXQgPSByZWdtYXBf dXBkYXRlX2JpdHMocHJpdi0+b3RnX2JjLCBVU0JPVEczX0NUUkw3LCBtYXNrLCB2YWwpOworCWlm IChyZXQpCisJCWdvdG8gb3V0OworCisJLyogZXhpdCBmcm9tIElERFEgbW9kZSAqLworCW1hc2sg PSBVU0JPVEczQ1RSTDJfUE9XRVJET1dOX0hTUCB8IFVTQk9URzNDVFJMMl9QT1dFUkRPV05fU1NQ OworCXJldCA9IHJlZ21hcF91cGRhdGVfYml0cyhwcml2LT5vdGdfYmMsIFVTQk9URzNfQ1RSTDIs IG1hc2ssIDApOworCWlmIChyZXQpCisJCWdvdG8gb3V0OworCisJLyogZGVsYXkgZm9yIGV4aXQg ZnJvbSBJRERRIG1vZGUgKi8KKwl1c2xlZXBfcmFuZ2UoMTAwLCAxMjApOworCisJLyogZGVhc3Nl cnQgcGh5ICovCisJdmFsID0gSVBfUlNUX1VTQjNPVEdQSFlfUE9SIHwgSVBfUlNUX1VTQjNPVEc7 CisJcmV0ID0gcmVnbWFwX3dyaXRlKHByaXYtPnBlcmlfY3JnLCBQRVJJX0NSR19SU1RESVM0LCB2 YWwpOworCWlmIChyZXQpCisJCWdvdG8gb3V0OworCisJLyogZGVsYXkgZm9yIHBoeSBkZWFzc2Vy dGVkICovCisJdXNsZWVwX3JhbmdlKDEwMDAwLCAxNTAwMCk7CisKKwkvKiBmYWtlIHZidXMgdmFs aWQgc2lnbmFsICovCisJdmFsID0gVVNCT1RHM19DVFJMM19WQlVTVkxERVhUIHwgVVNCT1RHM19D VFJMM19WQlVTVkxERVhUU0VMOworCW1hc2sgPSB2YWw7CisJcmV0ID0gcmVnbWFwX3VwZGF0ZV9i aXRzKHByaXYtPm90Z19iYywgVVNCT1RHM19DVFJMMywgbWFzaywgdmFsKTsKKwlpZiAocmV0KQor CQlnb3RvIG91dDsKKworCS8qIGRlbGF5IGZvciB2YnVzIHZhbGlkICovCisJdXNsZWVwX3Jhbmdl KDEwMCwgMTIwKTsKKworCXJldCA9IHJlZ21hcF93cml0ZShwcml2LT5vdGdfYmMsIFVTQk9URzNf Q1RSTDQsCisJCQlwcml2LT5leWVfZGlhZ3JhbV9wYXJhbSk7CisJaWYgKHJldCkKKwkJZ290byBv dXQ7CisKKwlyZXR1cm4gMDsKK291dDoKKwlkZXZfZXJyKHByaXYtPmRldiwgImZhaWxlZCB0byBp bml0IHBoeSByZXQ6ICVkXG4iLCByZXQpOworCXJldHVybiByZXQ7Cit9CisKK3N0YXRpYyBpbnQg aGkzNjYwX3BoeV9leGl0KHN0cnVjdCBwaHkgKnBoeSkKK3sKKwlzdHJ1Y3QgaGkzNjYwX3ByaXYg KnByaXYgPSBwaHlfZ2V0X2RydmRhdGEocGh5KTsKKwl1MzIgdmFsOworCWludCByZXQ7CisKKwkv KiBhc3NlcnQgcGh5ICovCisJdmFsID0gSVBfUlNUX1VTQjNPVEdQSFlfUE9SOworCXJldCA9IHJl Z21hcF93cml0ZShwcml2LT5wZXJpX2NyZywgUEVSSV9DUkdfUlNURU40LCB2YWwpOworCWlmIChy ZXQpCisJCWdvdG8gb3V0OworCisJLyogZGlzYWJsZSB1c2JfdGN4b19lbiAqLworCXZhbCA9IFVT Ql9UQ1hPX0VOIDw8IFBDVFJMX1BFUklfQ1RSTDNfTVNLX1NUQVJUOworCXJldCA9IHJlZ21hcF93 cml0ZShwcml2LT5wY3RybCwgUENUUkxfUEVSSV9DVFJMMywgdmFsKTsKKwlpZiAocmV0KQorCQln b3RvIG91dDsKKworCXJldHVybiAwOworb3V0OgorCWRldl9lcnIocHJpdi0+ZGV2LCAiZmFpbGVk IHRvIGV4aXQgcGh5IHJldDogJWRcbiIsIHJldCk7CisJcmV0dXJuIHJldDsKK30KKworc3RhdGlj IHN0cnVjdCBwaHlfb3BzIGhpMzY2MF9waHlfb3BzID0geworCS5pbml0CQk9IGhpMzY2MF9waHlf aW5pdCwKKwkuZXhpdAkJPSBoaTM2NjBfcGh5X2V4aXQsCisJLm93bmVyCQk9IFRISVNfTU9EVUxF LAorfTsKKworc3RhdGljIGludCBoaTM2NjBfcGh5X3Byb2JlKHN0cnVjdCBwbGF0Zm9ybV9kZXZp Y2UgKnBkZXYpCit7CisJc3RydWN0IHBoeV9wcm92aWRlciAqcGh5X3Byb3ZpZGVyOworCXN0cnVj dCBkZXZpY2UgKmRldiA9ICZwZGV2LT5kZXY7CisJc3RydWN0IHBoeSAqcGh5OworCXN0cnVjdCBo aTM2NjBfcHJpdiAqcHJpdjsKKworCXByaXYgPSBkZXZtX2t6YWxsb2MoZGV2LCBzaXplb2YoKnBy aXYpLCBHRlBfS0VSTkVMKTsKKwlpZiAoIXByaXYpCisJCXJldHVybiAtRU5PTUVNOworCisJcHJp di0+ZGV2ID0gZGV2OworCXByaXYtPnBlcmlfY3JnID0gc3lzY29uX3JlZ21hcF9sb29rdXBfYnlf cGhhbmRsZShkZXYtPm9mX25vZGUsCisJCQkJCSJoaXNpbGljb24scGVyaWNyZy1zeXNjb24iKTsK KwlpZiAoSVNfRVJSKHByaXYtPnBlcmlfY3JnKSkgeworCQlkZXZfZXJyKGRldiwgIm5vIGhpc2ls aWNvbixwZXJpY3JnLXN5c2NvblxuIik7CisJCXJldHVybiBQVFJfRVJSKHByaXYtPnBlcmlfY3Jn KTsKKwl9CisKKwlwcml2LT5wY3RybCA9IHN5c2Nvbl9yZWdtYXBfbG9va3VwX2J5X3BoYW5kbGUo ZGV2LT5vZl9ub2RlLAorCQkJCQkiaGlzaWxpY29uLHBjdHJsLXN5c2NvbiIpOworCWlmIChJU19F UlIocHJpdi0+cGN0cmwpKSB7CisJCWRldl9lcnIoZGV2LCAibm8gaGlzaWxpY29uLHBjdHJsLXN5 c2NvblxuIik7CisJCXJldHVybiBQVFJfRVJSKHByaXYtPnBjdHJsKTsKKwl9CisKKwkvKiBub2Rl IG9mIGhpMzY2MCBwaHkgaXMgYSBzdWItbm9kZSBvZiB1c2IzX290Z19iYyAqLworCXByaXYtPm90 Z19iYyA9IHN5c2Nvbl9ub2RlX3RvX3JlZ21hcChkZXYtPnBhcmVudC0+b2Zfbm9kZSk7CisJaWYg KElTX0VSUihwcml2LT5vdGdfYmMpKSB7CisJCWRldl9lcnIoZGV2LCAibm8gaGlzaWxpY29uLHVz YjMtb3RnLWJjLXN5c2NvblxuIik7CisJCXJldHVybiBQVFJfRVJSKHByaXYtPm90Z19iYyk7CisJ fQorCisJaWYgKG9mX3Byb3BlcnR5X3JlYWRfdTMyKGRldi0+b2Zfbm9kZSwgImhpc2lsaWNvbixl eWUtZGlhZ3JhbS1wYXJhbSIsCisJCSYocHJpdi0+ZXllX2RpYWdyYW1fcGFyYW0pKSkKKwkJcHJp di0+ZXllX2RpYWdyYW1fcGFyYW0gPSBISTM2NjBfVVNCX0RFRkFVTFRfUEhZX1BBUkFNOworCisJ cGh5ID0gZGV2bV9waHlfY3JlYXRlKGRldiwgTlVMTCwgJmhpMzY2MF9waHlfb3BzKTsKKwlpZiAo SVNfRVJSKHBoeSkpCisJCXJldHVybiBQVFJfRVJSKHBoeSk7CisKKwlwaHlfc2V0X2RydmRhdGEo cGh5LCBwcml2KTsKKwlwaHlfcHJvdmlkZXIgPSBkZXZtX29mX3BoeV9wcm92aWRlcl9yZWdpc3Rl cihkZXYsIG9mX3BoeV9zaW1wbGVfeGxhdGUpOworCXJldHVybiBQVFJfRVJSX09SX1pFUk8ocGh5 X3Byb3ZpZGVyKTsKK30KKworc3RhdGljIGNvbnN0IHN0cnVjdCBvZl9kZXZpY2VfaWQgaGkzNjYw X3BoeV9vZl9tYXRjaFtdID0geworCXsuY29tcGF0aWJsZSA9ICJoaXNpbGljb24saGkzNjYwLXVz Yi1waHkiLH0sCisJeyB9Cit9OworTU9EVUxFX0RFVklDRV9UQUJMRShvZiwgaGkzNjYwX3BoeV9v Zl9tYXRjaCk7CisKK3N0YXRpYyBzdHJ1Y3QgcGxhdGZvcm1fZHJpdmVyIGhpMzY2MF9waHlfZHJp dmVyID0geworCS5wcm9iZQk9IGhpMzY2MF9waHlfcHJvYmUsCisJLmRyaXZlciA9IHsKKwkJLm5h bWUJPSAiaGkzNjYwLXVzYi1waHkiLAorCQkub2ZfbWF0Y2hfdGFibGUJPSBoaTM2NjBfcGh5X29m X21hdGNoLAorCX0KK307Cittb2R1bGVfcGxhdGZvcm1fZHJpdmVyKGhpMzY2MF9waHlfZHJpdmVy KTsKKworTU9EVUxFX0FVVEhPUigiWXUgQ2hlbiA8Y2hlbnl1NTZAaHVhd2VpLmNvbT4iKTsKK01P RFVMRV9MSUNFTlNFKCJHUEwgdjIiKTsKK01PRFVMRV9ERVNDUklQVElPTigiSGlsaXNpY29uIEhp MzY2MCBVU0IzIFBIWSBEcml2ZXIiKTsK