On 8/10/2021 2:42 PM, Argishti Aleksanyan wrote:
> Implemented udc_set_speed() gadget ops to allow the udc to select
> the gadget speed on initialization.
>
> Signed-off-by: Argishti Aleksanyan <aleksan@xxxxxxxxxxxx>
Acked-by: Minas Harutyunyan <Minas.Harutyunyan@xxxxxxxxxxxx>
> ---
> drivers/usb/dwc2/gadget.c | 23 +++++++++++++++++++++++
> 1 file changed, 23 insertions(+)
>
> diff --git a/drivers/usb/dwc2/gadget.c b/drivers/usb/dwc2/gadget.c
> index 985b272f53d5..837237e4bc96 100644
> --- a/drivers/usb/dwc2/gadget.c
> +++ b/drivers/usb/dwc2/gadget.c
> @@ -4709,12 +4709,35 @@ static int dwc2_hsotg_vbus_draw(struct usb_gadget *gadget, unsigned int mA)
> return usb_phy_set_power(hsotg->uphy, mA);
> }
>
> +static void dwc2_gadget_set_speed(struct usb_gadget *g, enum usb_device_speed speed)
> +{
> + struct dwc2_hsotg *hsotg = to_hsotg(g);
> + unsigned long flags;
> +
> + spin_lock_irqsave(&hsotg->lock, flags);
> + switch (speed) {
> + case USB_SPEED_HIGH:
> + hsotg->params.speed = DWC2_SPEED_PARAM_HIGH;
> + break;
> + case USB_SPEED_FULL:
> + hsotg->params.speed = DWC2_SPEED_PARAM_FULL;
> + break;
> + case USB_SPEED_LOW:
> + hsotg->params.speed = DWC2_SPEED_PARAM_LOW;
> + break;
> + default:
> + dev_err(hsotg->dev, "invalid speed (%d)\n", speed);
> + }
> + spin_unlock_irqrestore(&hsotg->lock, flags);
> +}
> +
> static const struct usb_gadget_ops dwc2_hsotg_gadget_ops = {
> .get_frame = dwc2_hsotg_gadget_getframe,
> .set_selfpowered = dwc2_hsotg_set_selfpowered,
> .udc_start = dwc2_hsotg_udc_start,
> .udc_stop = dwc2_hsotg_udc_stop,
> .pullup = dwc2_hsotg_pullup,
> + .udc_set_speed = dwc2_gadget_set_speed,
> .vbus_session = dwc2_hsotg_vbus_session,
> .vbus_draw = dwc2_hsotg_vbus_draw,
> };
>
> base-commit: 73e19de7b79a2f26f0b370cc071728cede1ab3a0
>
