2 files changed, 8 insertions, 33 deletions

diff --git a/firmware/target/arm/as3525/ata_sd_as3525.c b/firmware/target/arm/as3525/ata_sd_as3525.c
index 7e5bc126af..342be613c5 100644
--- a/firmware/target/arm/as3525/ata_sd_as3525.c
+++ b/firmware/target/arm/as3525/ata_sd_as3525.c
@@ -117,32 +117,6 @@ static volatile bool retry;
 
 static inline void mci_delay(void) { int i = 0xffff; while(i--) ; }
 
-static void mci_set_clock_divider(const int drive, int divider)
-{
-    int clock = MCI_CLOCK(drive);
-
-    if(divider > 1)
-    {
-        /* use divide logic */
-        clock &= ~MCI_CLOCK_BYPASS;
-
-        /* convert divider to MCI_CLOCK logic */
-        divider = (divider/2) - 1;
-        if(divider >= 256)
-            divider = 255;
-    }
-    else
-    {
-        /* bypass dividing logic */
-        clock |= MCI_CLOCK_BYPASS;
-        divider = 0;
-    }
-
-    MCI_CLOCK(drive) = clock | divider;
-
-    mci_delay();
-}
-
 #ifdef HAVE_HOTSWAP
 #if defined(SANSA_E200V2) || defined(SANSA_FUZE)
 static int sd1_oneshot_callback(struct timeout *tmo)
@@ -348,7 +322,8 @@ static int sd_init_card(const int drive)
 
     card_info[drive].initialized = 1;
 
-    mci_set_clock_divider(drive, 1); /* full speed */
+    MCI_CLOCK(drive) |= MCI_CLOCK_BYPASS;   /* full speed */
+    mci_delay();
 
     /*
      * enable bank switching 
@@ -481,12 +456,9 @@ static void init_pl180_controller(const int drive)
 
     MCI_SELECT(drive) = 0;
 
-    MCI_CLOCK(drive) = MCI_CLOCK_ENABLE;
-    MCI_CLOCK(drive) &= ~MCI_CLOCK_POWERSAVE;
-
-    /* set MCLK divider */
-    mci_set_clock_divider(drive,
-        CLK_DIV(AS3525_PCLK_FREQ, AS3525_SD_IDENT_FREQ));
+    MCI_CLOCK(drive) = MCI_CLOCK_ENABLE |
+                (((CLK_DIV(AS3525_PCLK_FREQ, AS3525_SD_IDENT_FREQ)) / 2) - 1);
+    mci_delay();
 }
 
 int sd_init(void)
diff --git a/firmware/target/arm/as3525/clock-target.h b/firmware/target/arm/as3525/clock-target.h
index 21fd4c65d2..f4b223cdff 100644
--- a/firmware/target/arm/as3525/clock-target.h
+++ b/firmware/target/arm/as3525/clock-target.h
@@ -63,5 +63,8 @@
 #endif
 
 #define AS3525_SD_IDENT_FREQ    400000      /* must be between 100 & 400 kHz */
+#if ((CLK_DIV(AS3525_PCLK_FREQ, AS3525_SD_IDENT_FREQ) / 2) - 1) >= (1<<8) /* 8 bits */
+#error SD IDENTIFICATION frequency is too low : clock divider will not fit !
+#endif
 
 #endif /* CLOCK_TARGET_H */