usb: musb: gadget: support musb-specific test modes

we can support the musb-specific test modes on the
vendor specific range of test selector as stated
on USB Specification Table 9-7 Test Mode Selectors.

Signed-off-by: Felipe Balbi <felipe.balbi@nokia.com>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>

1 files changed, 25 insertions, 0 deletions

diff --git a/drivers/usb/musb/musb_gadget_ep0.c b/drivers/usb/musb/musb_gadget_ep0.c
index 53d06451f820..21b9788d0243 100644
--- a/drivers/usb/musb/musb_gadget_ep0.c
+++ b/drivers/usb/musb/musb_gadget_ep0.c
@@ -351,6 +351,31 @@ __acquires(musb->lock)
                                                 musb->test_mode_nr =
                                                         MUSB_TEST_PACKET;
                                                 break;
+
+                                        case 0xc0:
+                                                /* TEST_FORCE_HS */
+                                                pr_debug("TEST_FORCE_HS\n");
+                                                musb->test_mode_nr =
+                                                        MUSB_TEST_FORCE_HS;
+                                                break;
+                                        case 0xc1:
+                                                /* TEST_FORCE_FS */
+                                                pr_debug("TEST_FORCE_FS\n");
+                                                musb->test_mode_nr =
+                                                        MUSB_TEST_FORCE_FS;
+                                                break;
+                                        case 0xc2:
+                                                /* TEST_FIFO_ACCESS */
+                                                pr_debug("TEST_FIFO_ACCESS\n");
+                                                musb->test_mode_nr =
+                                                        MUSB_TEST_FIFO_ACCESS;
+                                                break;
+                                        case 0xc3:
+                                                /* TEST_FORCE_HOST */
+                                                pr_debug("TEST_FORCE_HOST\n");
+                                                musb->test_mode_nr =
+                                                        MUSB_TEST_FORCE_HOST;
+                                                break;
                                         default:
                                                 goto stall;
                                         }