Make call to fsl_otg_event for each id change even

Signed-off-by: Ramneek Mehresh <ramneek.mehr...@freescale.com>
Reviewed-by: Fleming Andrew-AFLEMING <aflem...@freescale.com>
Tested-by: Fleming Andrew-AFLEMING <aflem...@freescale.com>
---
 drivers/usb/phy/phy-fsl-usb.c | 15 +++------------
 1 file changed, 3 insertions(+), 12 deletions(-)

diff --git a/drivers/usb/phy/phy-fsl-usb.c b/drivers/usb/phy/phy-fsl-usb.c
index 2eb54ef..ce40d5c 100644
--- a/drivers/usb/phy/phy-fsl-usb.c
+++ b/drivers/usb/phy/phy-fsl-usb.c
@@ -733,6 +733,7 @@ irqreturn_t fsl_otg_isr(int irq, void *dev_id)
 {
        struct otg_fsm *fsm = &((struct fsl_otg *)dev_id)->fsm;
        struct usb_otg *otg = ((struct fsl_otg *)dev_id)->phy.otg;
+       struct fsl_otg *otg_dev = dev_id;
        u32 otg_int_src, otg_sc;
 
        otg_sc = fsl_readl(&usb_dr_regs->otgsc);
@@ -762,18 +763,8 @@ irqreturn_t fsl_otg_isr(int irq, void *dev_id)
                                otg->gadget->is_a_peripheral = !fsm->id;
                        VDBG("ID int (ID is %d)\n", fsm->id);
 
-                       if (fsm->id) {  /* switch to gadget */
-                               schedule_delayed_work(
-                                       &((struct fsl_otg *)dev_id)->otg_event,
-                                       100);
-                       } else {        /* switch to host */
-                               cancel_delayed_work(&
-                                                   ((struct fsl_otg *)dev_id)->
-                                                   otg_event);
-                               fsl_otg_start_gadget(fsm, 0);
-                               otg_drv_vbus(fsm, 1);
-                               fsl_otg_start_host(fsm, 1);
-                       }
+                       schedule_delayed_work(&otg_dev->otg_event, 100);
+
                        return IRQ_HANDLED;
                }
        }
-- 
1.8.3.1

--
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