mirror of https://gitee.com/openkylin/linux.git
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>
This commit is contained in:
Nagarjuna Kristam
Thierry Reding
parent
80525cc238
commit
f836e78430
|
|
@ -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,
|
||||
|
|
|
|||
Loading…
Reference in New Issue