usb: gadget: renesas_usbhs: add usbhs_set_device_speed() support for host

mod_host needs device speed setup function

Signed-off-by: Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
Signed-off-by: Felipe Balbi <balbi@ti.com>

1 files changed, 42 insertions, 0 deletions

diff --git a/drivers/usb/renesas_usbhs/common.c b/drivers/usb/renesas_usbhs/common.c
index 895eb44a1a51..c3aef40fa9e5 100644
--- a/drivers/usb/renesas_usbhs/common.c
+++ b/drivers/usb/renesas_usbhs/common.c
@@ -227,6 +227,48 @@ static void usbhsc_bus_init(struct usbhs_priv *priv)
 }
 
 /*
+ *              device configuration
+ */
+int usbhs_set_device_speed(struct usbhs_priv *priv, int devnum,
+                           u16 upphub, u16 hubport, u16 speed)
+{
+        struct device *dev = usbhs_priv_to_dev(priv);
+        u16 usbspd = 0;
+        u32 reg = DEVADD0 + (2 * devnum);
+
+        if (devnum > 10) {
+                dev_err(dev, "cannot set speed to unknown device %d\n", devnum);
+                return -EIO;
+        }
+
+        if (upphub > 0xA) {
+                dev_err(dev, "unsupported hub number %d\n", upphub);
+                return -EIO;
+        }
+
+        switch (speed) {
+        case USB_SPEED_LOW:
+                usbspd = USBSPD_SPEED_LOW;
+                break;
+        case USB_SPEED_FULL:
+                usbspd = USBSPD_SPEED_FULL;
+                break;
+        case USB_SPEED_HIGH:
+                usbspd = USBSPD_SPEED_HIGH;
+                break;
+        default:
+                dev_err(dev, "unsupported speed %d\n", speed);
+                return -EIO;
+        }
+
+        usbhs_write(priv, reg,  UPPHUB(upphub)  |
+                                HUBPORT(hubport)|
+                                USBSPD(usbspd));
+
+        return 0;
+}
+
+/*
  *              local functions
  */
 static void usbhsc_set_buswait(struct usbhs_priv *priv)