From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1751519AbdAPKvr (ORCPT ); Mon, 16 Jan 2017 05:51:47 -0500 Received: from mail-ot0-f169.google.com ([74.125.82.169]:33220 "EHLO mail-ot0-f169.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1751391AbdAPKvp (ORCPT ); Mon, 16 Jan 2017 05:51:45 -0500 MIME-Version: 1.0 In-Reply-To: <587C90E2.5020105@ti.com> References: <1480485338-23451-1-git-send-email-raviteja.garimella@broadcom.com> <1480485338-23451-3-git-send-email-raviteja.garimella@broadcom.com> <587C90E2.5020105@ti.com> From: Raviteja Garimella Date: Mon, 16 Jan 2017 16:21:43 +0530 Message-ID: Subject: Re: [PATCH 2/3] Broadcom USB DRD Phy driver for Northstar2 To: Kishon Vijay Abraham I Cc: Rob Herring , Mark Rutland , Ray Jui , Scott Branden , Jon Mason , Catalin Marinas , Will Deacon , devicetree@vger.kernel.org, linux-kernel@vger.kernel.org, BCM Kernel Feedback , linux-arm-kernel@lists.infradead.org Content-Type: text/plain; charset=UTF-8 Sender: linux-kernel-owner@vger.kernel.org List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Hi Kishon, On Mon, Jan 16, 2017 at 2:52 PM, Kishon Vijay Abraham I wrote: > Hi, > > On Wednesday 30 November 2016 11:25 AM, Raviteja Garimella wrote: >> This is driver for USB DRD Phy used in Broadcom's Northstar2 >> SoC. The phy can be configured to be in Device mode or Host >> mode based on the type of cable connected to the port. The >> driver registers to extcon framework to get appropriate >> connect events for Host/Device cables connect/disconnect >> states based on VBUS and ID interrupts. >> >> Signed-off-by: Raviteja Garimella >> --- >> drivers/phy/Kconfig | 13 + >> drivers/phy/Makefile | 1 + >> drivers/phy/phy-bcm-ns2-usbdrd.c | 587 +++++++++++++++++++++++++++++++++++++++ >> 3 files changed, 601 insertions(+) >> create mode 100644 drivers/phy/phy-bcm-ns2-usbdrd.c >> >> diff --git a/drivers/phy/Kconfig b/drivers/phy/Kconfig >> index fe00f91..b3b6a73 100644 >> --- a/drivers/phy/Kconfig >> +++ b/drivers/phy/Kconfig >> @@ -479,6 +479,19 @@ config PHY_CYGNUS_PCIE >> Enable this to support the Broadcom Cygnus PCIe PHY. >> If unsure, say N. >> >> +config PHY_NS2_USB_DRD >> + tristate "Broadcom Northstar2 USB DRD PHY support" >> + depends on OF && (ARCH_BCM_IPROC || COMPILE_TEST) >> + select GENERIC_PHY >> + select EXTCON >> + default ARCH_BCM_IPROC >> + help >> + Enable this to support the Broadcom Northstar2 USB DRD PHY. >> + This driver initializes the PHY in either HOST or DEVICE mode. >> + The host or device configuration is read from device tree. >> + >> + If unsure, say N. >> + >> source "drivers/phy/tegra/Kconfig" >> >> config PHY_NS2_PCIE >> diff --git a/drivers/phy/Makefile b/drivers/phy/Makefile >> index a534cf5..b733ba2 100644 >> --- a/drivers/phy/Makefile >> +++ b/drivers/phy/Makefile >> @@ -58,5 +58,6 @@ obj-$(CONFIG_PHY_TUSB1210) += phy-tusb1210.o >> obj-$(CONFIG_PHY_BRCM_SATA) += phy-brcm-sata.o >> obj-$(CONFIG_PHY_PISTACHIO_USB) += phy-pistachio-usb.o >> obj-$(CONFIG_PHY_CYGNUS_PCIE) += phy-bcm-cygnus-pcie.o >> +obj-$(CONFIG_PHY_NS2_USB_DRD) += phy-bcm-ns2-usbdrd.o >> obj-$(CONFIG_ARCH_TEGRA) += tegra/ >> obj-$(CONFIG_PHY_NS2_PCIE) += phy-bcm-ns2-pcie.o >> diff --git a/drivers/phy/phy-bcm-ns2-usbdrd.c b/drivers/phy/phy-bcm-ns2-usbdrd.c >> new file mode 100644 >> index 0000000..460040d >> --- /dev/null >> +++ b/drivers/phy/phy-bcm-ns2-usbdrd.c >> @@ -0,0 +1,587 @@ >> +/* >> + * Copyright (C) 2016 Broadcom >> + * >> + * This program is free software; you can redistribute it and/or >> + * modify it under the terms of the GNU General Public License as >> + * published by the Free Software Foundation version 2. >> + * >> + * This program is distributed "as is" WITHOUT ANY WARRANTY of any >> + * kind, whether express or implied; without even the implied warranty >> + * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the >> + * GNU General Public License for more details. >> + */ >> + >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> + >> +#define ICFG_DRD_AFE 0x0 >> +#define ICFG_MISC_STAT 0x18 >> +#define ICFG_DRD_P0CTL 0x1C >> +#define ICFG_STRAP_CTRL 0x20 >> +#define ICFG_FSM_CTRL 0x24 >> + >> +#define IDM_RST_BIT BIT(0) >> +#define AFE_CORERDY_VDDC BIT(18) >> +#define PHY_PLL_RESETB BIT(15) >> +#define PHY_RESETB BIT(14) >> +#define PHY_PLL_LOCK BIT(0) >> + >> +#define DRD_DEV_MODE BIT(20) >> +#define OHCI_OVRCUR_POL BIT(11) >> +#define ICFG_OFF_MODE BIT(6) >> +#define PLL_LOCK_RETRY 1000 >> + >> +#define EVT_DEVICE 0 >> +#define EVT_HOST 1 >> +#define EVT_IDLE 2 >> + >> +#define DRD_HOST_MODE (BIT(2) | BIT(3)) >> +#define DRD_DEVICE_MODE (BIT(4) | BIT(5)) >> +#define DRD_HOST_VAL 0x803 >> +#define DRD_DEV_VAL 0x807 >> +#define GPIO_DELAY 20 >> +#define PHY_WQ_DELAY msecs_to_jiffies(600) >> + >> +struct ns2_phy_data; >> +struct ns2_phy_driver { >> + void __iomem *icfgdrd_regs; >> + void __iomem *idmdrd_rst_ctrl; >> + void __iomem *crmu_usb2_ctrl; >> + void __iomem *usb2h_strap_reg; >> + spinlock_t lock; /* spin lock for phy driver */ >> + bool host_mode; >> + struct ns2_phy_data *data; >> + struct extcon_specific_cable_nb extcon_dev; >> + struct extcon_specific_cable_nb extcon_host; >> + struct notifier_block host_nb; >> + struct notifier_block dev_nb; >> + struct delayed_work conn_work; >> + struct extcon_dev *edev; >> + struct gpio_desc *vbus_gpiod; >> + struct gpio_desc *id_gpiod; >> + int id_irq; >> + int vbus_irq; >> + unsigned long debounce_jiffies; >> + struct delayed_work wq_extcon; >> +}; >> + >> +struct ns2_phy_data { >> + struct ns2_phy_driver *driver; >> + struct phy *phy; >> + int new_state; >> + bool poweron; >> +}; >> + >> +static const unsigned int usb_extcon_cable[] = { >> + EXTCON_USB, >> + EXTCON_USB_HOST, >> + EXTCON_NONE, >> +}; >> + >> +static inline int pll_lock_stat(u32 usb_reg, int reg_mask, >> + struct ns2_phy_driver *driver) >> +{ >> + int retry = PLL_LOCK_RETRY; >> + u32 val; >> + >> + do { >> + udelay(1); >> + val = readl(driver->icfgdrd_regs + usb_reg); >> + if (val & reg_mask) >> + return 0; >> + } while (--retry > 0); >> + >> + return -EBUSY; >> +} >> + >> +static int ns2_drd_phy_init(struct phy *phy) >> +{ >> + struct ns2_phy_data *data = phy_get_drvdata(phy); >> + struct ns2_phy_driver *driver = data->driver; >> + unsigned long flags; >> + u32 val; >> + >> + spin_lock_irqsave(&driver->lock, flags); >> + >> + val = readl(driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + >> + if (data->new_state == EVT_HOST) { >> + val &= ~DRD_DEVICE_MODE; >> + val |= DRD_HOST_MODE; >> + } else { >> + val &= ~DRD_HOST_MODE; >> + val |= DRD_DEVICE_MODE; >> + } >> + writel(val, driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + >> + spin_unlock_irqrestore(&driver->lock, flags); >> + return 0; >> +} >> + >> +static int ns2_drd_phy_shutdown(struct phy *phy) >> +{ >> + struct ns2_phy_data *data = phy_get_drvdata(phy); >> + struct ns2_phy_driver *driver = data->driver; >> + unsigned long flags; >> + u32 val; >> + >> + spin_lock_irqsave(&driver->lock, flags); >> + if (!data->poweron) >> + goto exit; >> + >> + val = readl(driver->crmu_usb2_ctrl); >> + val &= ~AFE_CORERDY_VDDC; >> + writel(val, driver->crmu_usb2_ctrl); >> + >> + driver->host_mode = 0; >> + val = readl(driver->crmu_usb2_ctrl); >> + val &= ~DRD_DEV_MODE; >> + writel(val, driver->crmu_usb2_ctrl); >> + >> + /* Disable Host and Device Mode */ >> + val = readl(driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + val &= ~(DRD_HOST_MODE | DRD_DEVICE_MODE | ICFG_OFF_MODE); >> + writel(val, driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + >> + data->poweron = 0; >> +exit: >> + spin_unlock_irqrestore(&driver->lock, flags); >> + return 0; >> +} >> + >> +static int ns2_drd_phy_poweron(struct phy *phy) >> +{ >> + struct ns2_phy_data *data = phy_get_drvdata(phy); >> + struct ns2_phy_driver *driver = data->driver; >> + u32 extcon_event = data->new_state; >> + unsigned long flags; >> + int ret; >> + u32 val; >> + >> + spin_lock_irqsave(&driver->lock, flags); >> + if (extcon_event == EVT_DEVICE) { >> + if (data->poweron) >> + goto exit; >> + >> + writel(DRD_DEV_VAL, driver->icfgdrd_regs + ICFG_DRD_P0CTL); >> + >> + val = readl(driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + val &= ~(DRD_HOST_MODE | ICFG_OFF_MODE); >> + val |= DRD_DEVICE_MODE; >> + writel(val, driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + >> + val = readl(driver->idmdrd_rst_ctrl); >> + val &= ~IDM_RST_BIT; >> + writel(val, driver->idmdrd_rst_ctrl); >> + >> + val = readl(driver->crmu_usb2_ctrl); >> + val |= (AFE_CORERDY_VDDC | DRD_DEV_MODE); >> + writel(val, driver->crmu_usb2_ctrl); >> + >> + /* Bring PHY and PHY_PLL out of Reset */ >> + val = readl(driver->crmu_usb2_ctrl); >> + val |= (PHY_PLL_RESETB | PHY_RESETB); >> + writel(val, driver->crmu_usb2_ctrl); >> + >> + ret = pll_lock_stat(ICFG_MISC_STAT, PHY_PLL_LOCK, driver); >> + if (ret < 0) { >> + dev_err(&phy->dev, "Phy PLL lock failed\n"); >> + goto err_shutdown; >> + } >> + } else { >> + if (data->poweron && driver->host_mode) >> + goto exit; >> + >> + writel(DRD_HOST_VAL, driver->icfgdrd_regs + ICFG_DRD_P0CTL); >> + >> + val = readl(driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + val &= ~(DRD_DEVICE_MODE | ICFG_OFF_MODE); >> + val |= DRD_HOST_MODE; >> + writel(val, driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + >> + val = readl(driver->crmu_usb2_ctrl); >> + val |= AFE_CORERDY_VDDC; >> + writel(val, driver->crmu_usb2_ctrl); >> + >> + ret = pll_lock_stat(ICFG_MISC_STAT, PHY_PLL_LOCK, driver); >> + if (ret < 0) { >> + dev_err(&phy->dev, "Phy PLL lock failed\n"); >> + goto err_shutdown; >> + } >> + >> + val = readl(driver->idmdrd_rst_ctrl); >> + val &= ~IDM_RST_BIT; >> + writel(val, driver->idmdrd_rst_ctrl); >> + >> + /* port over current Polarity */ >> + val = readl(driver->usb2h_strap_reg); >> + val |= OHCI_OVRCUR_POL; >> + writel(val, driver->usb2h_strap_reg); >> + >> + driver->host_mode = 1; >> + } >> + >> + data->poweron = 1; >> +exit: >> + spin_unlock_irqrestore(&driver->lock, flags); >> + return 0; >> + >> +err_shutdown: >> + data->poweron = 1; >> + spin_unlock_irqrestore(&driver->lock, flags); >> + ns2_drd_phy_shutdown(phy); >> + return ret; >> +} >> + >> +static void connect_work(struct work_struct *work) >> +{ >> + struct ns2_phy_driver *driver; >> + struct ns2_phy_data *data; >> + u32 extcon_event; >> + >> + driver = container_of(to_delayed_work(work), >> + struct ns2_phy_driver, conn_work); >> + data = driver->data; >> + extcon_event = data->new_state; >> + >> + if (extcon_event == EVT_DEVICE || extcon_event == EVT_HOST) { >> + ns2_drd_phy_init(data->phy); >> + ns2_drd_phy_poweron(data->phy); >> + } else if (extcon_event == EVT_IDLE) { >> + ns2_drd_phy_shutdown(data->phy); >> + } >> +} >> + >> +static int drd_device_notify(struct notifier_block *self, >> + unsigned long event, void *ptr) >> +{ >> + struct ns2_phy_driver *driver = container_of(self, >> + struct ns2_phy_driver, dev_nb); >> + >> + if (event) { >> + pr_debug("Device connected\n"); >> + driver->data->new_state = EVT_DEVICE; >> + schedule_delayed_work(&driver->conn_work, 0); >> + } else { >> + pr_debug("Device disconnected\n"); >> + driver->data->new_state = EVT_IDLE; >> + schedule_delayed_work(&driver->conn_work, PHY_WQ_DELAY); >> + } >> + >> + return NOTIFY_DONE; >> +} >> + >> +static int drd_host_notify(struct notifier_block *self, >> + unsigned long event, void *ptr) >> +{ >> + struct ns2_phy_driver *driver = container_of(self, >> + struct ns2_phy_driver, host_nb); >> + >> + if (event) { >> + pr_debug("Host connected\n"); >> + driver->data->new_state = EVT_HOST; >> + schedule_delayed_work(&driver->conn_work, 0); >> + } else { >> + pr_debug("Host disconnected\n"); >> + driver->data->new_state = EVT_IDLE; >> + schedule_delayed_work(&driver->conn_work, PHY_WQ_DELAY); >> + } >> + >> + return NOTIFY_DONE; >> +} >> + >> +static void extcon_work(struct work_struct *work) >> +{ >> + struct ns2_phy_driver *driver; >> + int vbus; >> + int id; >> + >> + driver = container_of(to_delayed_work(work), >> + struct ns2_phy_driver, wq_extcon); >> + >> + id = gpiod_get_value_cansleep(driver->id_gpiod); >> + vbus = gpiod_get_value_cansleep(driver->vbus_gpiod); >> + >> + if (!id && vbus) { >> + extcon_set_cable_state_(driver->edev, EXTCON_USB_HOST, true); >> + } else if (id && !vbus) { >> + extcon_set_cable_state_(driver->edev, EXTCON_USB_HOST, false); >> + extcon_set_cable_state_(driver->edev, EXTCON_USB, false); >> + } else if (id && vbus) { >> + extcon_set_cable_state_(driver->edev, EXTCON_USB, true); >> + } >> +} >> + >> +static irqreturn_t gpio_irq_handler(int irq, void *dev_id) >> +{ >> + struct ns2_phy_driver *driver = dev_id; >> + >> + queue_delayed_work(system_power_efficient_wq, &driver->wq_extcon, >> + driver->debounce_jiffies); >> + >> + return IRQ_HANDLED; >> +} >> + >> +static int register_extcon_notifier(struct ns2_phy_driver *phy_driver, >> + struct device *dev) >> +{ >> + struct extcon_dev *edev; >> + int ret; >> + >> + phy_driver->host_nb.notifier_call = drd_host_notify; >> + phy_driver->dev_nb.notifier_call = drd_device_notify; >> + >> + edev = phy_driver->edev; >> + >> + /* Register for device change notification */ >> + ret = extcon_register_notifier(edev, EXTCON_USB, >> + &phy_driver->dev_nb); >> + if (ret < 0) { >> + dev_err(dev, "can't register extcon_dev for %s\n", edev->name); >> + return ret; >> + } >> + >> + /* Register for host change notification */ >> + ret = extcon_register_notifier(edev, EXTCON_USB_HOST, >> + &phy_driver->host_nb); >> + if (ret < 0) { >> + dev_err(dev, "can't register extcon_dev for %s\n", edev->name); >> + goto err_dev; >> + } >> + >> + /* Check the device cable connect state */ >> + ret = extcon_get_cable_state_(edev, EXTCON_USB); >> + if (ret < 0) { >> + dev_err(dev, "can't get extcon_dev state for %s\n", edev->name); >> + goto err_host; >> + } else if (ret) { >> + phy_driver->data->new_state = EVT_DEVICE; >> + } >> + >> + /* Check the host cable connect state */ >> + ret = extcon_get_cable_state_(edev, EXTCON_USB_HOST); >> + if (ret < 0) { >> + dev_err(dev, "can't get extcon_dev state for %s\n", edev->name); >> + goto err_host; >> + } else if (ret) { >> + phy_driver->data->new_state = EVT_HOST; >> + } >> + >> + return 0; >> + >> +err_host: >> + ret = extcon_unregister_notifier(edev, EXTCON_USB_HOST, >> + &phy_driver->host_nb); >> +err_dev: >> + ret = extcon_unregister_notifier(edev, EXTCON_USB, >> + &phy_driver->dev_nb); >> + return ret; >> +} >> + >> +static struct phy_ops ops = { >> + .init = ns2_drd_phy_init, > > Is this really being used by any controller driver? Can you point me to the > controller driver that is using this driver? This will be used by Synopsys UDC that's integrated into Broadcom's Northstar2 and Cygnus SoC's. I am currently working on upstream review comments for the same in a different patch series. The "amd5536udc" driver is being modified for platform device support (as per the suggestions I received in reviews). > >> + .power_on = ns2_drd_phy_poweron, >> + .power_off = ns2_drd_phy_shutdown, > > missing .owner. Will fix this. Thanks, Ravi > > Thanks > Kishon From mboxrd@z Thu Jan 1 00:00:00 1970 From: Raviteja Garimella Subject: Re: [PATCH 2/3] Broadcom USB DRD Phy driver for Northstar2 Date: Mon, 16 Jan 2017 16:21:43 +0530 Message-ID: References: <1480485338-23451-1-git-send-email-raviteja.garimella@broadcom.com> <1480485338-23451-3-git-send-email-raviteja.garimella@broadcom.com> <587C90E2.5020105@ti.com> Mime-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Return-path: In-Reply-To: <587C90E2.5020105-l0cyMroinI0@public.gmane.org> Sender: devicetree-owner-u79uwXL29TY76Z2rM5mHXA@public.gmane.org To: Kishon Vijay Abraham I Cc: Rob Herring , Mark Rutland , Ray Jui , Scott Branden , Jon Mason , Catalin Marinas , Will Deacon , devicetree-u79uwXL29TY76Z2rM5mHXA@public.gmane.org, linux-kernel-u79uwXL29TY76Z2rM5mHXA@public.gmane.org, BCM Kernel Feedback , linux-arm-kernel-IAPFreCvJWM7uuMidbF8XUB+6BGkLq7r@public.gmane.org List-Id: devicetree@vger.kernel.org Hi Kishon, On Mon, Jan 16, 2017 at 2:52 PM, Kishon Vijay Abraham I wrote: > Hi, > > On Wednesday 30 November 2016 11:25 AM, Raviteja Garimella wrote: >> This is driver for USB DRD Phy used in Broadcom's Northstar2 >> SoC. The phy can be configured to be in Device mode or Host >> mode based on the type of cable connected to the port. The >> driver registers to extcon framework to get appropriate >> connect events for Host/Device cables connect/disconnect >> states based on VBUS and ID interrupts. >> >> Signed-off-by: Raviteja Garimella >> --- >> drivers/phy/Kconfig | 13 + >> drivers/phy/Makefile | 1 + >> drivers/phy/phy-bcm-ns2-usbdrd.c | 587 +++++++++++++++++++++++++++++++++++++++ >> 3 files changed, 601 insertions(+) >> create mode 100644 drivers/phy/phy-bcm-ns2-usbdrd.c >> >> diff --git a/drivers/phy/Kconfig b/drivers/phy/Kconfig >> index fe00f91..b3b6a73 100644 >> --- a/drivers/phy/Kconfig >> +++ b/drivers/phy/Kconfig >> @@ -479,6 +479,19 @@ config PHY_CYGNUS_PCIE >> Enable this to support the Broadcom Cygnus PCIe PHY. >> If unsure, say N. >> >> +config PHY_NS2_USB_DRD >> + tristate "Broadcom Northstar2 USB DRD PHY support" >> + depends on OF && (ARCH_BCM_IPROC || COMPILE_TEST) >> + select GENERIC_PHY >> + select EXTCON >> + default ARCH_BCM_IPROC >> + help >> + Enable this to support the Broadcom Northstar2 USB DRD PHY. >> + This driver initializes the PHY in either HOST or DEVICE mode. >> + The host or device configuration is read from device tree. >> + >> + If unsure, say N. >> + >> source "drivers/phy/tegra/Kconfig" >> >> config PHY_NS2_PCIE >> diff --git a/drivers/phy/Makefile b/drivers/phy/Makefile >> index a534cf5..b733ba2 100644 >> --- a/drivers/phy/Makefile >> +++ b/drivers/phy/Makefile >> @@ -58,5 +58,6 @@ obj-$(CONFIG_PHY_TUSB1210) += phy-tusb1210.o >> obj-$(CONFIG_PHY_BRCM_SATA) += phy-brcm-sata.o >> obj-$(CONFIG_PHY_PISTACHIO_USB) += phy-pistachio-usb.o >> obj-$(CONFIG_PHY_CYGNUS_PCIE) += phy-bcm-cygnus-pcie.o >> +obj-$(CONFIG_PHY_NS2_USB_DRD) += phy-bcm-ns2-usbdrd.o >> obj-$(CONFIG_ARCH_TEGRA) += tegra/ >> obj-$(CONFIG_PHY_NS2_PCIE) += phy-bcm-ns2-pcie.o >> diff --git a/drivers/phy/phy-bcm-ns2-usbdrd.c b/drivers/phy/phy-bcm-ns2-usbdrd.c >> new file mode 100644 >> index 0000000..460040d >> --- /dev/null >> +++ b/drivers/phy/phy-bcm-ns2-usbdrd.c >> @@ -0,0 +1,587 @@ >> +/* >> + * Copyright (C) 2016 Broadcom >> + * >> + * This program is free software; you can redistribute it and/or >> + * modify it under the terms of the GNU General Public License as >> + * published by the Free Software Foundation version 2. >> + * >> + * This program is distributed "as is" WITHOUT ANY WARRANTY of any >> + * kind, whether express or implied; without even the implied warranty >> + * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the >> + * GNU General Public License for more details. >> + */ >> + >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> + >> +#define ICFG_DRD_AFE 0x0 >> +#define ICFG_MISC_STAT 0x18 >> +#define ICFG_DRD_P0CTL 0x1C >> +#define ICFG_STRAP_CTRL 0x20 >> +#define ICFG_FSM_CTRL 0x24 >> + >> +#define IDM_RST_BIT BIT(0) >> +#define AFE_CORERDY_VDDC BIT(18) >> +#define PHY_PLL_RESETB BIT(15) >> +#define PHY_RESETB BIT(14) >> +#define PHY_PLL_LOCK BIT(0) >> + >> +#define DRD_DEV_MODE BIT(20) >> +#define OHCI_OVRCUR_POL BIT(11) >> +#define ICFG_OFF_MODE BIT(6) >> +#define PLL_LOCK_RETRY 1000 >> + >> +#define EVT_DEVICE 0 >> +#define EVT_HOST 1 >> +#define EVT_IDLE 2 >> + >> +#define DRD_HOST_MODE (BIT(2) | BIT(3)) >> +#define DRD_DEVICE_MODE (BIT(4) | BIT(5)) >> +#define DRD_HOST_VAL 0x803 >> +#define DRD_DEV_VAL 0x807 >> +#define GPIO_DELAY 20 >> +#define PHY_WQ_DELAY msecs_to_jiffies(600) >> + >> +struct ns2_phy_data; >> +struct ns2_phy_driver { >> + void __iomem *icfgdrd_regs; >> + void __iomem *idmdrd_rst_ctrl; >> + void __iomem *crmu_usb2_ctrl; >> + void __iomem *usb2h_strap_reg; >> + spinlock_t lock; /* spin lock for phy driver */ >> + bool host_mode; >> + struct ns2_phy_data *data; >> + struct extcon_specific_cable_nb extcon_dev; >> + struct extcon_specific_cable_nb extcon_host; >> + struct notifier_block host_nb; >> + struct notifier_block dev_nb; >> + struct delayed_work conn_work; >> + struct extcon_dev *edev; >> + struct gpio_desc *vbus_gpiod; >> + struct gpio_desc *id_gpiod; >> + int id_irq; >> + int vbus_irq; >> + unsigned long debounce_jiffies; >> + struct delayed_work wq_extcon; >> +}; >> + >> +struct ns2_phy_data { >> + struct ns2_phy_driver *driver; >> + struct phy *phy; >> + int new_state; >> + bool poweron; >> +}; >> + >> +static const unsigned int usb_extcon_cable[] = { >> + EXTCON_USB, >> + EXTCON_USB_HOST, >> + EXTCON_NONE, >> +}; >> + >> +static inline int pll_lock_stat(u32 usb_reg, int reg_mask, >> + struct ns2_phy_driver *driver) >> +{ >> + int retry = PLL_LOCK_RETRY; >> + u32 val; >> + >> + do { >> + udelay(1); >> + val = readl(driver->icfgdrd_regs + usb_reg); >> + if (val & reg_mask) >> + return 0; >> + } while (--retry > 0); >> + >> + return -EBUSY; >> +} >> + >> +static int ns2_drd_phy_init(struct phy *phy) >> +{ >> + struct ns2_phy_data *data = phy_get_drvdata(phy); >> + struct ns2_phy_driver *driver = data->driver; >> + unsigned long flags; >> + u32 val; >> + >> + spin_lock_irqsave(&driver->lock, flags); >> + >> + val = readl(driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + >> + if (data->new_state == EVT_HOST) { >> + val &= ~DRD_DEVICE_MODE; >> + val |= DRD_HOST_MODE; >> + } else { >> + val &= ~DRD_HOST_MODE; >> + val |= DRD_DEVICE_MODE; >> + } >> + writel(val, driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + >> + spin_unlock_irqrestore(&driver->lock, flags); >> + return 0; >> +} >> + >> +static int ns2_drd_phy_shutdown(struct phy *phy) >> +{ >> + struct ns2_phy_data *data = phy_get_drvdata(phy); >> + struct ns2_phy_driver *driver = data->driver; >> + unsigned long flags; >> + u32 val; >> + >> + spin_lock_irqsave(&driver->lock, flags); >> + if (!data->poweron) >> + goto exit; >> + >> + val = readl(driver->crmu_usb2_ctrl); >> + val &= ~AFE_CORERDY_VDDC; >> + writel(val, driver->crmu_usb2_ctrl); >> + >> + driver->host_mode = 0; >> + val = readl(driver->crmu_usb2_ctrl); >> + val &= ~DRD_DEV_MODE; >> + writel(val, driver->crmu_usb2_ctrl); >> + >> + /* Disable Host and Device Mode */ >> + val = readl(driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + val &= ~(DRD_HOST_MODE | DRD_DEVICE_MODE | ICFG_OFF_MODE); >> + writel(val, driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + >> + data->poweron = 0; >> +exit: >> + spin_unlock_irqrestore(&driver->lock, flags); >> + return 0; >> +} >> + >> +static int ns2_drd_phy_poweron(struct phy *phy) >> +{ >> + struct ns2_phy_data *data = phy_get_drvdata(phy); >> + struct ns2_phy_driver *driver = data->driver; >> + u32 extcon_event = data->new_state; >> + unsigned long flags; >> + int ret; >> + u32 val; >> + >> + spin_lock_irqsave(&driver->lock, flags); >> + if (extcon_event == EVT_DEVICE) { >> + if (data->poweron) >> + goto exit; >> + >> + writel(DRD_DEV_VAL, driver->icfgdrd_regs + ICFG_DRD_P0CTL); >> + >> + val = readl(driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + val &= ~(DRD_HOST_MODE | ICFG_OFF_MODE); >> + val |= DRD_DEVICE_MODE; >> + writel(val, driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + >> + val = readl(driver->idmdrd_rst_ctrl); >> + val &= ~IDM_RST_BIT; >> + writel(val, driver->idmdrd_rst_ctrl); >> + >> + val = readl(driver->crmu_usb2_ctrl); >> + val |= (AFE_CORERDY_VDDC | DRD_DEV_MODE); >> + writel(val, driver->crmu_usb2_ctrl); >> + >> + /* Bring PHY and PHY_PLL out of Reset */ >> + val = readl(driver->crmu_usb2_ctrl); >> + val |= (PHY_PLL_RESETB | PHY_RESETB); >> + writel(val, driver->crmu_usb2_ctrl); >> + >> + ret = pll_lock_stat(ICFG_MISC_STAT, PHY_PLL_LOCK, driver); >> + if (ret < 0) { >> + dev_err(&phy->dev, "Phy PLL lock failed\n"); >> + goto err_shutdown; >> + } >> + } else { >> + if (data->poweron && driver->host_mode) >> + goto exit; >> + >> + writel(DRD_HOST_VAL, driver->icfgdrd_regs + ICFG_DRD_P0CTL); >> + >> + val = readl(driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + val &= ~(DRD_DEVICE_MODE | ICFG_OFF_MODE); >> + val |= DRD_HOST_MODE; >> + writel(val, driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + >> + val = readl(driver->crmu_usb2_ctrl); >> + val |= AFE_CORERDY_VDDC; >> + writel(val, driver->crmu_usb2_ctrl); >> + >> + ret = pll_lock_stat(ICFG_MISC_STAT, PHY_PLL_LOCK, driver); >> + if (ret < 0) { >> + dev_err(&phy->dev, "Phy PLL lock failed\n"); >> + goto err_shutdown; >> + } >> + >> + val = readl(driver->idmdrd_rst_ctrl); >> + val &= ~IDM_RST_BIT; >> + writel(val, driver->idmdrd_rst_ctrl); >> + >> + /* port over current Polarity */ >> + val = readl(driver->usb2h_strap_reg); >> + val |= OHCI_OVRCUR_POL; >> + writel(val, driver->usb2h_strap_reg); >> + >> + driver->host_mode = 1; >> + } >> + >> + data->poweron = 1; >> +exit: >> + spin_unlock_irqrestore(&driver->lock, flags); >> + return 0; >> + >> +err_shutdown: >> + data->poweron = 1; >> + spin_unlock_irqrestore(&driver->lock, flags); >> + ns2_drd_phy_shutdown(phy); >> + return ret; >> +} >> + >> +static void connect_work(struct work_struct *work) >> +{ >> + struct ns2_phy_driver *driver; >> + struct ns2_phy_data *data; >> + u32 extcon_event; >> + >> + driver = container_of(to_delayed_work(work), >> + struct ns2_phy_driver, conn_work); >> + data = driver->data; >> + extcon_event = data->new_state; >> + >> + if (extcon_event == EVT_DEVICE || extcon_event == EVT_HOST) { >> + ns2_drd_phy_init(data->phy); >> + ns2_drd_phy_poweron(data->phy); >> + } else if (extcon_event == EVT_IDLE) { >> + ns2_drd_phy_shutdown(data->phy); >> + } >> +} >> + >> +static int drd_device_notify(struct notifier_block *self, >> + unsigned long event, void *ptr) >> +{ >> + struct ns2_phy_driver *driver = container_of(self, >> + struct ns2_phy_driver, dev_nb); >> + >> + if (event) { >> + pr_debug("Device connected\n"); >> + driver->data->new_state = EVT_DEVICE; >> + schedule_delayed_work(&driver->conn_work, 0); >> + } else { >> + pr_debug("Device disconnected\n"); >> + driver->data->new_state = EVT_IDLE; >> + schedule_delayed_work(&driver->conn_work, PHY_WQ_DELAY); >> + } >> + >> + return NOTIFY_DONE; >> +} >> + >> +static int drd_host_notify(struct notifier_block *self, >> + unsigned long event, void *ptr) >> +{ >> + struct ns2_phy_driver *driver = container_of(self, >> + struct ns2_phy_driver, host_nb); >> + >> + if (event) { >> + pr_debug("Host connected\n"); >> + driver->data->new_state = EVT_HOST; >> + schedule_delayed_work(&driver->conn_work, 0); >> + } else { >> + pr_debug("Host disconnected\n"); >> + driver->data->new_state = EVT_IDLE; >> + schedule_delayed_work(&driver->conn_work, PHY_WQ_DELAY); >> + } >> + >> + return NOTIFY_DONE; >> +} >> + >> +static void extcon_work(struct work_struct *work) >> +{ >> + struct ns2_phy_driver *driver; >> + int vbus; >> + int id; >> + >> + driver = container_of(to_delayed_work(work), >> + struct ns2_phy_driver, wq_extcon); >> + >> + id = gpiod_get_value_cansleep(driver->id_gpiod); >> + vbus = gpiod_get_value_cansleep(driver->vbus_gpiod); >> + >> + if (!id && vbus) { >> + extcon_set_cable_state_(driver->edev, EXTCON_USB_HOST, true); >> + } else if (id && !vbus) { >> + extcon_set_cable_state_(driver->edev, EXTCON_USB_HOST, false); >> + extcon_set_cable_state_(driver->edev, EXTCON_USB, false); >> + } else if (id && vbus) { >> + extcon_set_cable_state_(driver->edev, EXTCON_USB, true); >> + } >> +} >> + >> +static irqreturn_t gpio_irq_handler(int irq, void *dev_id) >> +{ >> + struct ns2_phy_driver *driver = dev_id; >> + >> + queue_delayed_work(system_power_efficient_wq, &driver->wq_extcon, >> + driver->debounce_jiffies); >> + >> + return IRQ_HANDLED; >> +} >> + >> +static int register_extcon_notifier(struct ns2_phy_driver *phy_driver, >> + struct device *dev) >> +{ >> + struct extcon_dev *edev; >> + int ret; >> + >> + phy_driver->host_nb.notifier_call = drd_host_notify; >> + phy_driver->dev_nb.notifier_call = drd_device_notify; >> + >> + edev = phy_driver->edev; >> + >> + /* Register for device change notification */ >> + ret = extcon_register_notifier(edev, EXTCON_USB, >> + &phy_driver->dev_nb); >> + if (ret < 0) { >> + dev_err(dev, "can't register extcon_dev for %s\n", edev->name); >> + return ret; >> + } >> + >> + /* Register for host change notification */ >> + ret = extcon_register_notifier(edev, EXTCON_USB_HOST, >> + &phy_driver->host_nb); >> + if (ret < 0) { >> + dev_err(dev, "can't register extcon_dev for %s\n", edev->name); >> + goto err_dev; >> + } >> + >> + /* Check the device cable connect state */ >> + ret = extcon_get_cable_state_(edev, EXTCON_USB); >> + if (ret < 0) { >> + dev_err(dev, "can't get extcon_dev state for %s\n", edev->name); >> + goto err_host; >> + } else if (ret) { >> + phy_driver->data->new_state = EVT_DEVICE; >> + } >> + >> + /* Check the host cable connect state */ >> + ret = extcon_get_cable_state_(edev, EXTCON_USB_HOST); >> + if (ret < 0) { >> + dev_err(dev, "can't get extcon_dev state for %s\n", edev->name); >> + goto err_host; >> + } else if (ret) { >> + phy_driver->data->new_state = EVT_HOST; >> + } >> + >> + return 0; >> + >> +err_host: >> + ret = extcon_unregister_notifier(edev, EXTCON_USB_HOST, >> + &phy_driver->host_nb); >> +err_dev: >> + ret = extcon_unregister_notifier(edev, EXTCON_USB, >> + &phy_driver->dev_nb); >> + return ret; >> +} >> + >> +static struct phy_ops ops = { >> + .init = ns2_drd_phy_init, > > Is this really being used by any controller driver? Can you point me to the > controller driver that is using this driver? This will be used by Synopsys UDC that's integrated into Broadcom's Northstar2 and Cygnus SoC's. I am currently working on upstream review comments for the same in a different patch series. The "amd5536udc" driver is being modified for platform device support (as per the suggestions I received in reviews). > >> + .power_on = ns2_drd_phy_poweron, >> + .power_off = ns2_drd_phy_shutdown, > > missing .owner. Will fix this. Thanks, Ravi > > Thanks > Kishon -- To unsubscribe from this list: send the line "unsubscribe devicetree" in the body of a message to majordomo-u79uwXL29TY76Z2rM5mHXA@public.gmane.org More majordomo info at http://vger.kernel.org/majordomo-info.html From mboxrd@z Thu Jan 1 00:00:00 1970 From: raviteja.garimella@broadcom.com (Raviteja Garimella) Date: Mon, 16 Jan 2017 16:21:43 +0530 Subject: [PATCH 2/3] Broadcom USB DRD Phy driver for Northstar2 In-Reply-To: <587C90E2.5020105@ti.com> References: <1480485338-23451-1-git-send-email-raviteja.garimella@broadcom.com> <1480485338-23451-3-git-send-email-raviteja.garimella@broadcom.com> <587C90E2.5020105@ti.com> Message-ID: To: linux-arm-kernel@lists.infradead.org List-Id: linux-arm-kernel.lists.infradead.org Hi Kishon, On Mon, Jan 16, 2017 at 2:52 PM, Kishon Vijay Abraham I wrote: > Hi, > > On Wednesday 30 November 2016 11:25 AM, Raviteja Garimella wrote: >> This is driver for USB DRD Phy used in Broadcom's Northstar2 >> SoC. The phy can be configured to be in Device mode or Host >> mode based on the type of cable connected to the port. The >> driver registers to extcon framework to get appropriate >> connect events for Host/Device cables connect/disconnect >> states based on VBUS and ID interrupts. >> >> Signed-off-by: Raviteja Garimella >> --- >> drivers/phy/Kconfig | 13 + >> drivers/phy/Makefile | 1 + >> drivers/phy/phy-bcm-ns2-usbdrd.c | 587 +++++++++++++++++++++++++++++++++++++++ >> 3 files changed, 601 insertions(+) >> create mode 100644 drivers/phy/phy-bcm-ns2-usbdrd.c >> >> diff --git a/drivers/phy/Kconfig b/drivers/phy/Kconfig >> index fe00f91..b3b6a73 100644 >> --- a/drivers/phy/Kconfig >> +++ b/drivers/phy/Kconfig >> @@ -479,6 +479,19 @@ config PHY_CYGNUS_PCIE >> Enable this to support the Broadcom Cygnus PCIe PHY. >> If unsure, say N. >> >> +config PHY_NS2_USB_DRD >> + tristate "Broadcom Northstar2 USB DRD PHY support" >> + depends on OF && (ARCH_BCM_IPROC || COMPILE_TEST) >> + select GENERIC_PHY >> + select EXTCON >> + default ARCH_BCM_IPROC >> + help >> + Enable this to support the Broadcom Northstar2 USB DRD PHY. >> + This driver initializes the PHY in either HOST or DEVICE mode. >> + The host or device configuration is read from device tree. >> + >> + If unsure, say N. >> + >> source "drivers/phy/tegra/Kconfig" >> >> config PHY_NS2_PCIE >> diff --git a/drivers/phy/Makefile b/drivers/phy/Makefile >> index a534cf5..b733ba2 100644 >> --- a/drivers/phy/Makefile >> +++ b/drivers/phy/Makefile >> @@ -58,5 +58,6 @@ obj-$(CONFIG_PHY_TUSB1210) += phy-tusb1210.o >> obj-$(CONFIG_PHY_BRCM_SATA) += phy-brcm-sata.o >> obj-$(CONFIG_PHY_PISTACHIO_USB) += phy-pistachio-usb.o >> obj-$(CONFIG_PHY_CYGNUS_PCIE) += phy-bcm-cygnus-pcie.o >> +obj-$(CONFIG_PHY_NS2_USB_DRD) += phy-bcm-ns2-usbdrd.o >> obj-$(CONFIG_ARCH_TEGRA) += tegra/ >> obj-$(CONFIG_PHY_NS2_PCIE) += phy-bcm-ns2-pcie.o >> diff --git a/drivers/phy/phy-bcm-ns2-usbdrd.c b/drivers/phy/phy-bcm-ns2-usbdrd.c >> new file mode 100644 >> index 0000000..460040d >> --- /dev/null >> +++ b/drivers/phy/phy-bcm-ns2-usbdrd.c >> @@ -0,0 +1,587 @@ >> +/* >> + * Copyright (C) 2016 Broadcom >> + * >> + * This program is free software; you can redistribute it and/or >> + * modify it under the terms of the GNU General Public License as >> + * published by the Free Software Foundation version 2. >> + * >> + * This program is distributed "as is" WITHOUT ANY WARRANTY of any >> + * kind, whether express or implied; without even the implied warranty >> + * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the >> + * GNU General Public License for more details. >> + */ >> + >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include >> + >> +#define ICFG_DRD_AFE 0x0 >> +#define ICFG_MISC_STAT 0x18 >> +#define ICFG_DRD_P0CTL 0x1C >> +#define ICFG_STRAP_CTRL 0x20 >> +#define ICFG_FSM_CTRL 0x24 >> + >> +#define IDM_RST_BIT BIT(0) >> +#define AFE_CORERDY_VDDC BIT(18) >> +#define PHY_PLL_RESETB BIT(15) >> +#define PHY_RESETB BIT(14) >> +#define PHY_PLL_LOCK BIT(0) >> + >> +#define DRD_DEV_MODE BIT(20) >> +#define OHCI_OVRCUR_POL BIT(11) >> +#define ICFG_OFF_MODE BIT(6) >> +#define PLL_LOCK_RETRY 1000 >> + >> +#define EVT_DEVICE 0 >> +#define EVT_HOST 1 >> +#define EVT_IDLE 2 >> + >> +#define DRD_HOST_MODE (BIT(2) | BIT(3)) >> +#define DRD_DEVICE_MODE (BIT(4) | BIT(5)) >> +#define DRD_HOST_VAL 0x803 >> +#define DRD_DEV_VAL 0x807 >> +#define GPIO_DELAY 20 >> +#define PHY_WQ_DELAY msecs_to_jiffies(600) >> + >> +struct ns2_phy_data; >> +struct ns2_phy_driver { >> + void __iomem *icfgdrd_regs; >> + void __iomem *idmdrd_rst_ctrl; >> + void __iomem *crmu_usb2_ctrl; >> + void __iomem *usb2h_strap_reg; >> + spinlock_t lock; /* spin lock for phy driver */ >> + bool host_mode; >> + struct ns2_phy_data *data; >> + struct extcon_specific_cable_nb extcon_dev; >> + struct extcon_specific_cable_nb extcon_host; >> + struct notifier_block host_nb; >> + struct notifier_block dev_nb; >> + struct delayed_work conn_work; >> + struct extcon_dev *edev; >> + struct gpio_desc *vbus_gpiod; >> + struct gpio_desc *id_gpiod; >> + int id_irq; >> + int vbus_irq; >> + unsigned long debounce_jiffies; >> + struct delayed_work wq_extcon; >> +}; >> + >> +struct ns2_phy_data { >> + struct ns2_phy_driver *driver; >> + struct phy *phy; >> + int new_state; >> + bool poweron; >> +}; >> + >> +static const unsigned int usb_extcon_cable[] = { >> + EXTCON_USB, >> + EXTCON_USB_HOST, >> + EXTCON_NONE, >> +}; >> + >> +static inline int pll_lock_stat(u32 usb_reg, int reg_mask, >> + struct ns2_phy_driver *driver) >> +{ >> + int retry = PLL_LOCK_RETRY; >> + u32 val; >> + >> + do { >> + udelay(1); >> + val = readl(driver->icfgdrd_regs + usb_reg); >> + if (val & reg_mask) >> + return 0; >> + } while (--retry > 0); >> + >> + return -EBUSY; >> +} >> + >> +static int ns2_drd_phy_init(struct phy *phy) >> +{ >> + struct ns2_phy_data *data = phy_get_drvdata(phy); >> + struct ns2_phy_driver *driver = data->driver; >> + unsigned long flags; >> + u32 val; >> + >> + spin_lock_irqsave(&driver->lock, flags); >> + >> + val = readl(driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + >> + if (data->new_state == EVT_HOST) { >> + val &= ~DRD_DEVICE_MODE; >> + val |= DRD_HOST_MODE; >> + } else { >> + val &= ~DRD_HOST_MODE; >> + val |= DRD_DEVICE_MODE; >> + } >> + writel(val, driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + >> + spin_unlock_irqrestore(&driver->lock, flags); >> + return 0; >> +} >> + >> +static int ns2_drd_phy_shutdown(struct phy *phy) >> +{ >> + struct ns2_phy_data *data = phy_get_drvdata(phy); >> + struct ns2_phy_driver *driver = data->driver; >> + unsigned long flags; >> + u32 val; >> + >> + spin_lock_irqsave(&driver->lock, flags); >> + if (!data->poweron) >> + goto exit; >> + >> + val = readl(driver->crmu_usb2_ctrl); >> + val &= ~AFE_CORERDY_VDDC; >> + writel(val, driver->crmu_usb2_ctrl); >> + >> + driver->host_mode = 0; >> + val = readl(driver->crmu_usb2_ctrl); >> + val &= ~DRD_DEV_MODE; >> + writel(val, driver->crmu_usb2_ctrl); >> + >> + /* Disable Host and Device Mode */ >> + val = readl(driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + val &= ~(DRD_HOST_MODE | DRD_DEVICE_MODE | ICFG_OFF_MODE); >> + writel(val, driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + >> + data->poweron = 0; >> +exit: >> + spin_unlock_irqrestore(&driver->lock, flags); >> + return 0; >> +} >> + >> +static int ns2_drd_phy_poweron(struct phy *phy) >> +{ >> + struct ns2_phy_data *data = phy_get_drvdata(phy); >> + struct ns2_phy_driver *driver = data->driver; >> + u32 extcon_event = data->new_state; >> + unsigned long flags; >> + int ret; >> + u32 val; >> + >> + spin_lock_irqsave(&driver->lock, flags); >> + if (extcon_event == EVT_DEVICE) { >> + if (data->poweron) >> + goto exit; >> + >> + writel(DRD_DEV_VAL, driver->icfgdrd_regs + ICFG_DRD_P0CTL); >> + >> + val = readl(driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + val &= ~(DRD_HOST_MODE | ICFG_OFF_MODE); >> + val |= DRD_DEVICE_MODE; >> + writel(val, driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + >> + val = readl(driver->idmdrd_rst_ctrl); >> + val &= ~IDM_RST_BIT; >> + writel(val, driver->idmdrd_rst_ctrl); >> + >> + val = readl(driver->crmu_usb2_ctrl); >> + val |= (AFE_CORERDY_VDDC | DRD_DEV_MODE); >> + writel(val, driver->crmu_usb2_ctrl); >> + >> + /* Bring PHY and PHY_PLL out of Reset */ >> + val = readl(driver->crmu_usb2_ctrl); >> + val |= (PHY_PLL_RESETB | PHY_RESETB); >> + writel(val, driver->crmu_usb2_ctrl); >> + >> + ret = pll_lock_stat(ICFG_MISC_STAT, PHY_PLL_LOCK, driver); >> + if (ret < 0) { >> + dev_err(&phy->dev, "Phy PLL lock failed\n"); >> + goto err_shutdown; >> + } >> + } else { >> + if (data->poweron && driver->host_mode) >> + goto exit; >> + >> + writel(DRD_HOST_VAL, driver->icfgdrd_regs + ICFG_DRD_P0CTL); >> + >> + val = readl(driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + val &= ~(DRD_DEVICE_MODE | ICFG_OFF_MODE); >> + val |= DRD_HOST_MODE; >> + writel(val, driver->icfgdrd_regs + ICFG_FSM_CTRL); >> + >> + val = readl(driver->crmu_usb2_ctrl); >> + val |= AFE_CORERDY_VDDC; >> + writel(val, driver->crmu_usb2_ctrl); >> + >> + ret = pll_lock_stat(ICFG_MISC_STAT, PHY_PLL_LOCK, driver); >> + if (ret < 0) { >> + dev_err(&phy->dev, "Phy PLL lock failed\n"); >> + goto err_shutdown; >> + } >> + >> + val = readl(driver->idmdrd_rst_ctrl); >> + val &= ~IDM_RST_BIT; >> + writel(val, driver->idmdrd_rst_ctrl); >> + >> + /* port over current Polarity */ >> + val = readl(driver->usb2h_strap_reg); >> + val |= OHCI_OVRCUR_POL; >> + writel(val, driver->usb2h_strap_reg); >> + >> + driver->host_mode = 1; >> + } >> + >> + data->poweron = 1; >> +exit: >> + spin_unlock_irqrestore(&driver->lock, flags); >> + return 0; >> + >> +err_shutdown: >> + data->poweron = 1; >> + spin_unlock_irqrestore(&driver->lock, flags); >> + ns2_drd_phy_shutdown(phy); >> + return ret; >> +} >> + >> +static void connect_work(struct work_struct *work) >> +{ >> + struct ns2_phy_driver *driver; >> + struct ns2_phy_data *data; >> + u32 extcon_event; >> + >> + driver = container_of(to_delayed_work(work), >> + struct ns2_phy_driver, conn_work); >> + data = driver->data; >> + extcon_event = data->new_state; >> + >> + if (extcon_event == EVT_DEVICE || extcon_event == EVT_HOST) { >> + ns2_drd_phy_init(data->phy); >> + ns2_drd_phy_poweron(data->phy); >> + } else if (extcon_event == EVT_IDLE) { >> + ns2_drd_phy_shutdown(data->phy); >> + } >> +} >> + >> +static int drd_device_notify(struct notifier_block *self, >> + unsigned long event, void *ptr) >> +{ >> + struct ns2_phy_driver *driver = container_of(self, >> + struct ns2_phy_driver, dev_nb); >> + >> + if (event) { >> + pr_debug("Device connected\n"); >> + driver->data->new_state = EVT_DEVICE; >> + schedule_delayed_work(&driver->conn_work, 0); >> + } else { >> + pr_debug("Device disconnected\n"); >> + driver->data->new_state = EVT_IDLE; >> + schedule_delayed_work(&driver->conn_work, PHY_WQ_DELAY); >> + } >> + >> + return NOTIFY_DONE; >> +} >> + >> +static int drd_host_notify(struct notifier_block *self, >> + unsigned long event, void *ptr) >> +{ >> + struct ns2_phy_driver *driver = container_of(self, >> + struct ns2_phy_driver, host_nb); >> + >> + if (event) { >> + pr_debug("Host connected\n"); >> + driver->data->new_state = EVT_HOST; >> + schedule_delayed_work(&driver->conn_work, 0); >> + } else { >> + pr_debug("Host disconnected\n"); >> + driver->data->new_state = EVT_IDLE; >> + schedule_delayed_work(&driver->conn_work, PHY_WQ_DELAY); >> + } >> + >> + return NOTIFY_DONE; >> +} >> + >> +static void extcon_work(struct work_struct *work) >> +{ >> + struct ns2_phy_driver *driver; >> + int vbus; >> + int id; >> + >> + driver = container_of(to_delayed_work(work), >> + struct ns2_phy_driver, wq_extcon); >> + >> + id = gpiod_get_value_cansleep(driver->id_gpiod); >> + vbus = gpiod_get_value_cansleep(driver->vbus_gpiod); >> + >> + if (!id && vbus) { >> + extcon_set_cable_state_(driver->edev, EXTCON_USB_HOST, true); >> + } else if (id && !vbus) { >> + extcon_set_cable_state_(driver->edev, EXTCON_USB_HOST, false); >> + extcon_set_cable_state_(driver->edev, EXTCON_USB, false); >> + } else if (id && vbus) { >> + extcon_set_cable_state_(driver->edev, EXTCON_USB, true); >> + } >> +} >> + >> +static irqreturn_t gpio_irq_handler(int irq, void *dev_id) >> +{ >> + struct ns2_phy_driver *driver = dev_id; >> + >> + queue_delayed_work(system_power_efficient_wq, &driver->wq_extcon, >> + driver->debounce_jiffies); >> + >> + return IRQ_HANDLED; >> +} >> + >> +static int register_extcon_notifier(struct ns2_phy_driver *phy_driver, >> + struct device *dev) >> +{ >> + struct extcon_dev *edev; >> + int ret; >> + >> + phy_driver->host_nb.notifier_call = drd_host_notify; >> + phy_driver->dev_nb.notifier_call = drd_device_notify; >> + >> + edev = phy_driver->edev; >> + >> + /* Register for device change notification */ >> + ret = extcon_register_notifier(edev, EXTCON_USB, >> + &phy_driver->dev_nb); >> + if (ret < 0) { >> + dev_err(dev, "can't register extcon_dev for %s\n", edev->name); >> + return ret; >> + } >> + >> + /* Register for host change notification */ >> + ret = extcon_register_notifier(edev, EXTCON_USB_HOST, >> + &phy_driver->host_nb); >> + if (ret < 0) { >> + dev_err(dev, "can't register extcon_dev for %s\n", edev->name); >> + goto err_dev; >> + } >> + >> + /* Check the device cable connect state */ >> + ret = extcon_get_cable_state_(edev, EXTCON_USB); >> + if (ret < 0) { >> + dev_err(dev, "can't get extcon_dev state for %s\n", edev->name); >> + goto err_host; >> + } else if (ret) { >> + phy_driver->data->new_state = EVT_DEVICE; >> + } >> + >> + /* Check the host cable connect state */ >> + ret = extcon_get_cable_state_(edev, EXTCON_USB_HOST); >> + if (ret < 0) { >> + dev_err(dev, "can't get extcon_dev state for %s\n", edev->name); >> + goto err_host; >> + } else if (ret) { >> + phy_driver->data->new_state = EVT_HOST; >> + } >> + >> + return 0; >> + >> +err_host: >> + ret = extcon_unregister_notifier(edev, EXTCON_USB_HOST, >> + &phy_driver->host_nb); >> +err_dev: >> + ret = extcon_unregister_notifier(edev, EXTCON_USB, >> + &phy_driver->dev_nb); >> + return ret; >> +} >> + >> +static struct phy_ops ops = { >> + .init = ns2_drd_phy_init, > > Is this really being used by any controller driver? Can you point me to the > controller driver that is using this driver? This will be used by Synopsys UDC that's integrated into Broadcom's Northstar2 and Cygnus SoC's. I am currently working on upstream review comments for the same in a different patch series. The "amd5536udc" driver is being modified for platform device support (as per the suggestions I received in reviews). > >> + .power_on = ns2_drd_phy_poweron, >> + .power_off = ns2_drd_phy_shutdown, > > missing .owner. Will fix this. Thanks, Ravi > > Thanks > Kishon