usb: gadget: composite: handle otg status selector request from OTG host

If gadget with HNP polling support receives GetStatus request of otg
status selector, it feedback to host with host request flag to indicate
if it wants to take host role.

Acked-by: Peter Chen <peter.chen@freescale.com>
Signed-off-by: Li Jun <jun.li@nxp.com>
Signed-off-by: Felipe Balbi <balbi@kernel.org>

diff --git a/drivers/usb/gadget/composite.c b/drivers/usb/gadget/composite.c
index 64ad1bebb0faba74b711fab8ec91d24fe47b5326..a5c62093c26c67192dc91ca9920817e88928ae02 100644 (file)
--- a/drivers/usb/gadget/composite.c
+++ b/drivers/usb/gadget/composite.c
@@ -1707,15 +1707,24 @@ composite_setup(struct usb_gadget *gadget, const struct usb_ctrlrequest *ctrl)
                *((u8 *)req->buf) = value;
                value = min(w_length, (u16) 1);
                break;
-
-       /*
-        * USB 3.0 additions:
-        * Function driver should handle get_status request. If such cb
-        * wasn't supplied we respond with default value = 0
-        * Note: function driver should supply such cb only for the first
-        * interface of the function
-        */
        case USB_REQ_GET_STATUS:
+               if (gadget_is_otg(gadget) && gadget->hnp_polling_support &&
+                                               (w_index == OTG_STS_SELECTOR)) {
+                       if (ctrl->bRequestType != (USB_DIR_IN |
+                                                       USB_RECIP_DEVICE))
+                               goto unknown;
+                       *((u8 *)req->buf) = gadget->host_request_flag;
+                       value = 1;
+                       break;
+               }
+
+               /*
+                * USB 3.0 additions:
+                * Function driver should handle get_status request. If such cb
+                * wasn't supplied we respond with default value = 0
+                * Note: function driver should supply such cb only for the
+                * first interface of the function
+                */
                if (!gadget_is_superspeed(gadget))
                        goto unknown;
                if (ctrl->bRequestType != (USB_DIR_IN | USB_RECIP_INTERFACE))