1 files changed, 14 insertions, 2 deletions

diff --git a/firmware/target/arm/as3525/sd-as3525v2.c b/firmware/target/arm/as3525/sd-as3525v2.c
index a668f65e0c..386b76e758 100644
--- a/firmware/target/arm/as3525/sd-as3525v2.c
+++ b/firmware/target/arm/as3525/sd-as3525v2.c
@@ -953,8 +953,20 @@ long sd_last_disk_activity(void)
 
 void sd_enable(bool on)
 {
-    /* TODO */
-    (void) on;
+    if (on)
+    {
+        CGU_PERI |= CGU_MCI_CLOCK_ENABLE;
+        CGU_IDE |= (1<<7);                  /* AHB interface enable */
+        CGU_MEMSTICK |= (1<<7);             /* interface enable */
+        CGU_SDSLOT |= (1<<7);               /* interface enable */
+    }
+    else
+    {
+        CGU_SDSLOT &= ~(1<<7);              /* interface enable */
+        CGU_MEMSTICK &= ~(1<<7);            /* interface enable */
+        CGU_IDE &= ~(1<<7);                 /* AHB interface enable */
+        CGU_PERI &= ~CGU_MCI_CLOCK_ENABLE;
+    }
 }
 
 tCardInfo *card_get_info_target(int card_no)