1 files changed, 5 insertions, 13 deletions

diff --git a/firmware/target/coldfire/mpio/hd200/usb-hd200.c b/firmware/target/coldfire/mpio/hd200/usb-hd200.c
index 4c9e353f66..9a82359966 100644
--- a/firmware/target/coldfire/mpio/hd200/usb-hd200.c
+++ b/firmware/target/coldfire/mpio/hd200/usb-hd200.c
@@ -52,27 +52,19 @@ void usb_enable(bool on)
     if(on)
     {
         and_l(~(1<<30),&GPIO_OUT);  /* GPIO30 low */
-        /* GPIO36 low delay GPIO36 high delay */
-        and_l(~(1<<4),&GPIO1_OUT);
-        or_l((1<<4),&GPIO1_OUT);
+        and_l(~(1<<22),&GPIO_OUT);  /* GPIO22 low */
+
+        or_l((1<<4),&GPIO1_OUT);    /* GPIO36 high */
 
-        sleep(HZ/5); /* delay 200 ms */
-        and_l(~(1<<22),&GPIO_OUT); /* GPIO22 low */
     }
     else
     {
-        /* GPIO36 low delay GPIO36 high delay */
-        and_l(~(1<<4),&GPIO1_OUT);
-        sleep(HZ/100);
-        or_l((1<<4),&GPIO1_OUT);
-        sleep(HZ/100);
-
         or_l((1<<22),&GPIO_OUT);  /* GPIO22 high */
         or_l((1<<30),&GPIO_OUT);  /* GPIO30 high */
 
         and_l(~(1<<4),&GPIO1_OUT); /* GPIO36 low */
 
-       while ( !(GPIO1_READ & (1<<5)) ) {}
-       sleep(HZ);
+        while ( !(GPIO1_READ & (1<<5)) ) {}
+        sleep(HZ);
     }
 }