usb: xhci-tegra: Add OTG support

Get usb-phy's for availbale USB 2 phys. Register id notifiers for available
usb-phy's to receive role change notifications. Perform PP for the received
role change usb ports.

Signed-off-by: Nagarjuna Kristam <nkristam@nvidia.com>
[treding@nvidia.com: rebase onto Greg's usb-next branch]
Signed-off-by: Thierry Reding <treding@nvidia.com>

diff --git a/drivers/usb/host/xhci-tegra.c b/drivers/usb/host/xhci-tegra.c
index a6e36b3c968f95c16224baa940ab7e19da0c2beb..2eaf5c0af80ce156b609a85c8239e199c1e478eb 100644 (file)
--- a/drivers/usb/host/xhci-tegra.c
+++ b/drivers/usb/host/xhci-tegra.c
@@ -24,6 +24,9 @@
 #include <linux/regulator/consumer.h>
 #include <linux/reset.h>
 #include <linux/slab.h>
+#include <linux/usb/otg.h>
+#include <linux/usb/phy.h>
+#include <linux/usb/role.h>
 #include <soc/tegra/pmc.h>
 
 #include "xhci.h"
@@ -204,6 +207,7 @@ struct tegra_xusb_soc {
        bool scale_ss_clock;
        bool has_ipfs;
        bool lpm_support;
+       bool otg_reset_sspi;
 };
 
 struct tegra_xusb_context {
@@ -251,6 +255,14 @@ struct tegra_xusb {
        struct phy **phys;
        unsigned int num_phys;
 
+       struct usb_phy **usbphy;
+       unsigned int num_usb_phys;
+       int otg_usb2_port;
+       int otg_usb3_port;
+       bool host_mode;
+       struct notifier_block id_nb;
+       struct work_struct id_work;
+
        /* Firmware loading related */
        struct {
                size_t size;
@@ -1082,6 +1094,205 @@ static int tegra_xusb_enable_firmware_messages(struct tegra_xusb *tegra)
        return err;
 }
 
+static void tegra_xhci_set_port_power(struct tegra_xusb *tegra, bool main,
+                                                bool set)
+{
+       struct xhci_hcd *xhci = hcd_to_xhci(tegra->hcd);
+       struct usb_hcd *hcd = main ?  xhci->main_hcd : xhci->shared_hcd;
+       unsigned int wait = (!main && !set) ? 1000 : 10;
+       u16 typeReq = set ? SetPortFeature : ClearPortFeature;
+       u16 wIndex = main ? tegra->otg_usb2_port + 1 : tegra->otg_usb3_port + 1;
+       u32 status;
+       u32 stat_power = main ? USB_PORT_STAT_POWER : USB_SS_PORT_STAT_POWER;
+       u32 status_val = set ? stat_power : 0;
+
+       dev_dbg(tegra->dev, "%s():%s %s port power\n", __func__,
+               set ? "set" : "clear", main ? "HS" : "SS");
+
+       hcd->driver->hub_control(hcd, typeReq, USB_PORT_FEAT_POWER, wIndex,
+                                NULL, 0);
+
+       do {
+               tegra_xhci_hc_driver.hub_control(hcd, GetPortStatus, 0, wIndex,
+                                       (char *) &status, sizeof(status));
+               if (status_val == (status & stat_power))
+                       break;
+
+               if (!main && !set)
+                       usleep_range(600, 700);
+               else
+                       usleep_range(10, 20);
+       } while (--wait > 0);
+
+       if (status_val != (status & stat_power))
+               dev_info(tegra->dev, "failed to %s %s PP %d\n",
+                                               set ? "set" : "clear",
+                                               main ? "HS" : "SS", status);
+}
+
+static struct phy *tegra_xusb_get_phy(struct tegra_xusb *tegra, char *name,
+                                                               int port)
+{
+       unsigned int i, phy_count = 0;
+
+       for (i = 0; i < tegra->soc->num_types; i++) {
+               if (!strncmp(tegra->soc->phy_types[i].name, "usb2",
+                                                           strlen(name)))
+                       return tegra->phys[phy_count+port];
+
+               phy_count += tegra->soc->phy_types[i].num;
+       }
+
+       return NULL;
+}
+
+static void tegra_xhci_id_work(struct work_struct *work)
+{
+       struct tegra_xusb *tegra = container_of(work, struct tegra_xusb,
+                                               id_work);
+       struct xhci_hcd *xhci = hcd_to_xhci(tegra->hcd);
+       struct tegra_xusb_mbox_msg msg;
+       struct phy *phy = tegra_xusb_get_phy(tegra, "usb2",
+                                                   tegra->otg_usb2_port);
+       u32 status;
+       int ret;
+
+       dev_dbg(tegra->dev, "host mode %s\n", tegra->host_mode ? "on" : "off");
+
+       mutex_lock(&tegra->lock);
+
+       if (tegra->host_mode)
+               phy_set_mode_ext(phy, PHY_MODE_USB_OTG, USB_ROLE_HOST);
+       else
+               phy_set_mode_ext(phy, PHY_MODE_USB_OTG, USB_ROLE_NONE);
+
+       mutex_unlock(&tegra->lock);
+
+       if (tegra->host_mode) {
+               /* switch to host mode */
+               if (tegra->otg_usb3_port >= 0) {
+                       if (tegra->soc->otg_reset_sspi) {
+                               /* set PP=0 */
+                               tegra_xhci_hc_driver.hub_control(
+                                       xhci->shared_hcd, GetPortStatus,
+                                       0, tegra->otg_usb3_port+1,
+                                       (char *) &status, sizeof(status));
+                               if (status & USB_SS_PORT_STAT_POWER)
+                                       tegra_xhci_set_port_power(tegra, false,
+                                                                 false);
+
+                               /* reset OTG port SSPI */
+                               msg.cmd = MBOX_CMD_RESET_SSPI;
+                               msg.data = tegra->otg_usb3_port+1;
+
+                               ret = tegra_xusb_mbox_send(tegra, &msg);
+                               if (ret < 0) {
+                                       dev_info(tegra->dev,
+                                               "failed to RESET_SSPI %d\n",
+                                               ret);
+                               }
+                       }
+
+                       tegra_xhci_set_port_power(tegra, false, true);
+               }
+
+               tegra_xhci_set_port_power(tegra, true, true);
+
+       } else {
+               if (tegra->otg_usb3_port >= 0)
+                       tegra_xhci_set_port_power(tegra, false, false);
+
+               tegra_xhci_set_port_power(tegra, true, false);
+       }
+}
+
+static int tegra_xusb_get_usb2_port(struct tegra_xusb *tegra,
+                                             struct usb_phy *usbphy)
+{
+       unsigned int i;
+
+       for (i = 0; i < tegra->num_usb_phys; i++) {
+               if (tegra->usbphy[i] && usbphy == tegra->usbphy[i])
+                       return i;
+       }
+
+       return -1;
+}
+
+static int tegra_xhci_id_notify(struct notifier_block *nb,
+                                        unsigned long action, void *data)
+{
+       struct tegra_xusb *tegra = container_of(nb, struct tegra_xusb,
+                                                   id_nb);
+       struct usb_phy *usbphy = (struct usb_phy *)data;
+
+       dev_dbg(tegra->dev, "%s(): action is %d", __func__, usbphy->last_event);
+
+       if ((tegra->host_mode && usbphy->last_event == USB_EVENT_ID) ||
+               (!tegra->host_mode && usbphy->last_event != USB_EVENT_ID)) {
+               dev_dbg(tegra->dev, "Same role(%d) received. Ignore",
+                       tegra->host_mode);
+               return NOTIFY_OK;
+       }
+
+       tegra->otg_usb2_port = tegra_xusb_get_usb2_port(tegra, usbphy);
+       tegra->otg_usb3_port = tegra_xusb_padctl_get_usb3_companion(
+                                                       tegra->padctl,
+                                                       tegra->otg_usb2_port);
+
+       tegra->host_mode = (usbphy->last_event == USB_EVENT_ID) ? true : false;
+
+       schedule_work(&tegra->id_work);
+
+       return NOTIFY_OK;
+}
+
+static int tegra_xusb_init_usb_phy(struct tegra_xusb *tegra)
+{
+       unsigned int i;
+
+       tegra->usbphy = devm_kcalloc(tegra->dev, tegra->num_usb_phys,
+                                  sizeof(*tegra->usbphy), GFP_KERNEL);
+       if (!tegra->usbphy)
+               return -ENOMEM;
+
+       INIT_WORK(&tegra->id_work, tegra_xhci_id_work);
+       tegra->id_nb.notifier_call = tegra_xhci_id_notify;
+
+       for (i = 0; i < tegra->num_usb_phys; i++) {
+               struct phy *phy = tegra_xusb_get_phy(tegra, "usb2", i);
+
+               if (!phy)
+                       continue;
+
+               tegra->usbphy[i] = devm_usb_get_phy_by_node(tegra->dev,
+                                                       phy->dev.of_node,
+                                                       &tegra->id_nb);
+               if (!IS_ERR(tegra->usbphy[i])) {
+                       dev_dbg(tegra->dev, "usbphy-%d registered", i);
+                       otg_set_host(tegra->usbphy[i]->otg, &tegra->hcd->self);
+               } else {
+                       /*
+                        * usb-phy is optional, continue if its not available.
+                        */
+                       tegra->usbphy[i] = NULL;
+               }
+       }
+
+       return 0;
+}
+
+static void tegra_xusb_deinit_usb_phy(struct tegra_xusb *tegra)
+{
+       unsigned int i;
+
+       cancel_work_sync(&tegra->id_work);
+
+       for (i = 0; i < tegra->num_usb_phys; i++)
+               if (tegra->usbphy[i])
+                       otg_set_host(tegra->usbphy[i]->otg, NULL);
+}
+
 static int tegra_xusb_probe(struct platform_device *pdev)
 {
        struct tegra_xusb *tegra;
@@ -1255,8 +1466,11 @@ static int tegra_xusb_probe(struct platform_device *pdev)
                goto put_powerdomains;
        }
 
-       for (i = 0; i < tegra->soc->num_types; i++)
+       for (i = 0; i < tegra->soc->num_types; i++) {
+               if (!strncmp(tegra->soc->phy_types[i].name, "usb2", 4))
+                       tegra->num_usb_phys = tegra->soc->phy_types[i].num;
                tegra->num_phys += tegra->soc->phy_types[i].num;
+       }
 
        tegra->phys = devm_kcalloc(&pdev->dev, tegra->num_phys,
                                   sizeof(*tegra->phys), GFP_KERNEL);
@@ -1385,6 +1599,12 @@ static int tegra_xusb_probe(struct platform_device *pdev)
                goto remove_usb3;
        }
 
+       err = tegra_xusb_init_usb_phy(tegra);
+       if (err < 0) {
+               dev_err(&pdev->dev, "failed to init USB PHY: %d\n", err);
+               goto remove_usb3;
+       }
+
        return 0;
 
 remove_usb3:
@@ -1421,6 +1641,8 @@ static int tegra_xusb_remove(struct platform_device *pdev)
        struct tegra_xusb *tegra = platform_get_drvdata(pdev);
        struct xhci_hcd *xhci = hcd_to_xhci(tegra->hcd);
 
+       tegra_xusb_deinit_usb_phy(tegra);
+
        usb_remove_hcd(xhci->shared_hcd);
        usb_put_hcd(xhci->shared_hcd);
        xhci->shared_hcd = NULL;
@@ -1695,6 +1917,7 @@ static const struct tegra_xusb_soc tegra124_soc = {
        },
        .scale_ss_clock = true,
        .has_ipfs = true,
+       .otg_reset_sspi = false,
        .mbox = {
                .cmd = 0xe4,
                .data_in = 0xe8,
@@ -1734,6 +1957,7 @@ static const struct tegra_xusb_soc tegra210_soc = {
        },
        .scale_ss_clock = false,
        .has_ipfs = true,
+       .otg_reset_sspi = true,
        .mbox = {
                .cmd = 0xe4,
                .data_in = 0xe8,
@@ -1774,6 +1998,7 @@ static const struct tegra_xusb_soc tegra186_soc = {
        },
        .scale_ss_clock = false,
        .has_ipfs = false,
+       .otg_reset_sspi = false,
        .mbox = {
                .cmd = 0xe4,
                .data_in = 0xe8,
@@ -1804,6 +2029,7 @@ static const struct tegra_xusb_soc tegra194_soc = {
        },
        .scale_ss_clock = false,
        .has_ipfs = false,
+       .otg_reset_sspi = false,
        .mbox = {
                .cmd = 0x68,
                .data_in = 0x6c,