usb: gadget: xudc: Refactor update data role work

The notification call chain should be registered after the device gets
ready. Otherwise, we  might get errors when setting data roles in an
incomplete system.

This patch refactors update data role work and register the notifier
call chain after the system gets ready.

Signed-off-by: Wayne Chang <waynec@nvidia.com>
Signed-off-by: Haotien Hsu <haotienh@nvidia.com>
Link: https://lore.kernel.org/r/20221216042026.98517-1-haotienh@nvidia.com
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
Wayne Chang 2022-12-16 12:20:26 +08:00 committed by Greg Kroah-Hartman
parent 569d23e9bf
commit 2582d629c9
1 changed files with 24 additions and 9 deletions

View File

@ -796,21 +796,16 @@ static int tegra_xudc_get_phy_index(struct tegra_xudc *xudc,
return -1;
}
static int tegra_xudc_vbus_notify(struct notifier_block *nb,
unsigned long action, void *data)
static void tegra_xudc_update_data_role(struct tegra_xudc *xudc,
struct usb_phy *usbphy)
{
struct tegra_xudc *xudc = container_of(nb, struct tegra_xudc,
vbus_nb);
struct usb_phy *usbphy = (struct usb_phy *)data;
int phy_index;
dev_dbg(xudc->dev, "%s(): event is %d\n", __func__, usbphy->last_event);
if ((xudc->device_mode && usbphy->last_event == USB_EVENT_VBUS) ||
(!xudc->device_mode && usbphy->last_event != USB_EVENT_VBUS)) {
dev_dbg(xudc->dev, "Same role(%d) received. Ignore",
xudc->device_mode);
return NOTIFY_OK;
return;
}
xudc->device_mode = (usbphy->last_event == USB_EVENT_VBUS) ? true :
@ -826,6 +821,18 @@ static int tegra_xudc_vbus_notify(struct notifier_block *nb,
xudc->curr_usbphy = usbphy;
schedule_work(&xudc->usb_role_sw_work);
}
}
static int tegra_xudc_vbus_notify(struct notifier_block *nb,
unsigned long action, void *data)
{
struct tegra_xudc *xudc = container_of(nb, struct tegra_xudc,
vbus_nb);
struct usb_phy *usbphy = (struct usb_phy *)data;
dev_dbg(xudc->dev, "%s(): event is %d\n", __func__, usbphy->last_event);
tegra_xudc_update_data_role(xudc, usbphy);
return NOTIFY_OK;
}
@ -3521,7 +3528,7 @@ static int tegra_xudc_phy_get(struct tegra_xudc *xudc)
/* Get usb-phy, if utmi phy is available */
xudc->usbphy[i] = devm_usb_get_phy_by_node(xudc->dev,
xudc->utmi_phy[i]->dev.of_node,
&xudc->vbus_nb);
NULL);
if (IS_ERR(xudc->usbphy[i])) {
err = PTR_ERR(xudc->usbphy[i]);
dev_err_probe(xudc->dev, err,
@ -3856,6 +3863,14 @@ static int tegra_xudc_probe(struct platform_device *pdev)
goto free_eps;
}
for (i = 0; i < xudc->soc->num_phys; i++) {
if (!xudc->usbphy[i])
continue;
usb_register_notifier(xudc->usbphy[i], &xudc->vbus_nb);
tegra_xudc_update_data_role(xudc, xudc->usbphy[i]);
}
return 0;
free_eps: