phy: tegra: xusb: Support USB role default mode

Bugzilla: https://bugzilla.redhat.com/show_bug.cgi?id=2122414
Upstream Status: https://git.kernel.org/pub/scm/linux/kernel/git/next/linux-next.git
Tested: Verify USB-A and USB-C are functional on Nvidia Orin board,
 and no regressions on other platforms.

commit 3cde1ef
Author: Haotien Hsu <haotienh@nvidia.com>
Date:   Fri Dec 16 12:21:46 2022 +0800

    phy: tegra: xusb: Support USB role default mode

    Support role-switch-default-mode property when usb-role-switch is
    enabled.

    Signed-off-by: Haotien Hsu <haotienh@nvidia.com>
    Link: https://lore.kernel.org/r/20221216042146.99307-1-haotienh@nvidia.com
    Signed-off-by: Vinod Koul <vkoul@kernel.org>
    (cherry picked from commit 3cde1ef)

Signed-off-by: David Marlin <dmarlin@redhat.com>

Author: damarlin

drivers/phy/tegra/xusb.c

@@ -718,6 +718,22 @@ static int tegra_xusb_setup_usb_role_switch(struct tegra_xusb_port *port)
 	return err;
 }
 
+static void tegra_xusb_parse_usb_role_default_mode(struct tegra_xusb_port *port)
+{
+	enum usb_role role = USB_ROLE_NONE;
+	enum usb_dr_mode mode = usb_get_role_switch_default_mode(&port->dev);
+
+	if (mode == USB_DR_MODE_HOST)
+		role = USB_ROLE_HOST;
+	else if (mode == USB_DR_MODE_PERIPHERAL)
+		role = USB_ROLE_DEVICE;
+
+	if (role != USB_ROLE_NONE) {
+		usb_role_switch_set_role(port->usb_role_sw, role);
+		dev_dbg(&port->dev, "usb role default mode is %s", modes[mode]);
+	}
+}
+
 static int tegra_xusb_usb2_port_parse_dt(struct tegra_xusb_usb2_port *usb2)
 {
 	struct tegra_xusb_port *port = &usb2->base;
@@ -747,6 +763,7 @@ static int tegra_xusb_usb2_port_parse_dt(struct tegra_xusb_usb2_port *usb2)
 			err = tegra_xusb_setup_usb_role_switch(port);
 			if (err < 0)
 				return err;
+			tegra_xusb_parse_usb_role_default_mode(port);
 		} else {
 			dev_err(&port->dev, "usb-role-switch not found for %s mode",
 				modes[usb2->mode]);