1 files changed, 11 insertions, 1 deletions

diff --git a/firmware/target/arm/imx233/usb-imx233.c b/firmware/target/arm/imx233/usb-imx233.c
index c2d355ad88..c275f76916 100644
--- a/firmware/target/arm/imx233/usb-imx233.c
+++ b/firmware/target/arm/imx233/usb-imx233.c
@@ -28,6 +28,7 @@
 #include "usb-target.h"
 #include "system.h"
 #include "system-target.h"
+#include "clkctrl-imx233.h"
 
 
 void usb_insert_int(void)
@@ -77,9 +78,18 @@ bool usb_plugged(void)
 
 void usb_enable(bool on)
 {
-    /* FIXME: power up/down usb phy and pll usb */
     if(on)
+    {
+        imx233_enable_usb_pll(true);
+        imx233_enable_usb_phy(true);
+        imx233_enable_usb_controller(true);
         usb_core_init();
+    }
     else
+    {
         usb_core_exit();
+        imx233_enable_usb_controller(false);
+        imx233_enable_usb_phy(false);
+        imx233_enable_usb_pll(false);
+    }
 }