From: Li Jun <b47...@freescale.com>

Peripheral answers OTG status selector request from host according to
host_request_flag of gadget, length is 1.

Signed-off-by: Li Jun <jun...@freescale.com>
---
 drivers/usb/chipidea/udc.c |   28 +++++++++++++++++++++++-----
 1 file changed, 23 insertions(+), 5 deletions(-)

diff --git a/drivers/usb/chipidea/udc.c b/drivers/usb/chipidea/udc.c
index 4254792..eed66bc 100644
--- a/drivers/usb/chipidea/udc.c
+++ b/drivers/usb/chipidea/udc.c
@@ -831,7 +831,17 @@ __acquires(hwep->lock)
                return -ENOMEM;
 
        req->complete = isr_get_status_complete;
-       req->length   = 2;
+       if (setup->wIndex == OTG_STS_SELECTOR) {
+               if (ci_otg_is_fsm_mode(ci)) {
+                       req->length = 1;
+               } else {
+                       retval = -ENOTSUPP;
+                       goto err_free_req;
+               }
+       } else {
+               req->length = 2;
+       }
+
        req->buf      = kzalloc(req->length, gfp_flags);
        if (req->buf == NULL) {
                retval = -ENOMEM;
@@ -839,8 +849,15 @@ __acquires(hwep->lock)
        }
 
        if ((setup->bRequestType & USB_RECIP_MASK) == USB_RECIP_DEVICE) {
-               *(u16 *)req->buf = (ci->remote_wakeup << 1) |
-                       ci->gadget.is_selfpowered;
+               if (setup->wIndex == OTG_STS_SELECTOR) {
+                       if (ci->gadget.host_request_flag)
+                               *(u8 *)req->buf = HOST_REQUEST_FLAG;
+                       else
+                               *(u8 *)req->buf = 0;
+               } else {
+                       *(u16 *)req->buf = (ci->remote_wakeup << 1) |
+                                               ci->gadget.is_selfpowered;
+               }
        } else if ((setup->bRequestType & USB_RECIP_MASK) \
                   == USB_RECIP_ENDPOINT) {
                dir = (le16_to_cpu(setup->wIndex) & USB_ENDPOINT_DIR_MASK) ?
@@ -1018,8 +1035,9 @@ __acquires(ci->lock)
                    type != (USB_DIR_IN|USB_RECIP_ENDPOINT) &&
                    type != (USB_DIR_IN|USB_RECIP_INTERFACE))
                        goto delegate;
-               if (le16_to_cpu(req.wLength) != 2 ||
-                   le16_to_cpu(req.wValue)  != 0)
+               if ((le16_to_cpu(req.wLength) != 2 &&
+                       le16_to_cpu(req.wLength) != 1) ||
+                               le16_to_cpu(req.wValue) != 0)
                        break;
                err = isr_get_status_response(ci, &req);
                break;
-- 
1.7.9.5

--
To unsubscribe from this list: send the line "unsubscribe linux-usb" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to