}
 
 /* Clear up all ep queues */
-static int reset_queues(struct fsl_udc *udc)
+static int reset_queues(struct fsl_udc *udc, bool bus_reset)
 {
        u8 pipe;
 
 
        /* report disconnect; the driver is already quiesced */
        spin_unlock(&udc->lock);
-       udc->driver->disconnect(&udc->gadget);
+       if (bus_reset)
+               usb_gadget_udc_reset(&udc->gadget, udc->driver);
+       else
+               udc->driver->disconnect(&udc->gadget);
        spin_lock(&udc->lock);
 
        return 0;
                udc->bus_reset = 1;
                /* Reset all the queues, include XD, dTD, EP queue
                 * head and TR Queue */
-               reset_queues(udc);
+               reset_queues(udc, true);
                udc->usb_state = USB_STATE_DEFAULT;
        } else {
                VDBG("Controller reset");
                dr_controller_setup(udc);
 
                /* Reset all internal used Queues */
-               reset_queues(udc);
+               reset_queues(udc, false);
 
                ep0_setup(udc);