Bugfix AS3525 usb driver unboosted the cpu without first boosting it

Change-Id: Id2d45870a9128b19ace0e8d5c16d3b3fa4b923dd

1 files changed, 11 insertions, 2 deletions

diff --git a/firmware/target/arm/as3525/usb-as3525.c b/firmware/target/arm/as3525/usb-as3525.c
index d798d4da83..3f636256a8 100644
--- a/firmware/target/arm/as3525/usb-as3525.c
+++ b/firmware/target/arm/as3525/usb-as3525.c
@@ -53,12 +53,21 @@ static int usb_status = USB_EXTRACTED;
 void usb_enable(bool on)
 {
 #if defined(HAVE_USBSTACK)
+    static int boosted = 0;
     if (on){
-        cpu_boost(1);
+        if (boosted == 0)
+        {
+            cpu_boost(1);
+            boosted = 1;
+        }    
         usb_core_init();
     } else {
         usb_core_exit();
-        cpu_boost(0);
+        if(boosted == 1)
+        {
+            cpu_boost(0);
+            boosted = 0;
+        }
     }
 #else
     (void)on;