Ondio: adjustments for models with mask bit 2 == 0 (different MMC clock select circuitry)

git-svn-id: svn://svn.rockbox.org/rockbox/trunk@5421 a1c6a512-1295-4272-9138-f99709370657

1 files changed, 6 insertions, 4 deletions

diff --git a/firmware/drivers/ata_mmc.c b/firmware/drivers/ata_mmc.c
index f927a1bdeb..897f59b8be 100644
--- a/firmware/drivers/ata_mmc.c
+++ b/firmware/drivers/ata_mmc.c
@@ -141,10 +141,12 @@ static void mmc_tick(void);
 
 void mmc_select_clock(int card_no)
 {
-    if (card_no == 0)             /* internal */
-        or_b(0x10, &PADRH);       /* set clock gate PA12  CHECKME: mask? */
-    else                          /* external */
-        and_b(~0x10, &PADRH);     /* clear clock gate PA12  CHECKME: mask?*/
+    /* set clock gate for external card / reset for internal card if the
+     * MMC clock polarity bit is 0, vice versa if it is 1 */
+    if ((card_no != 0) ^ (read_hw_mask() & MMC_CLOCK_POLARITY))
+        or_b(0x10, &PADRH);       /* set clock gate PA12 */
+    else
+        and_b(~0x10, &PADRH);     /* clear clock gate PA12 */
 }
 
 static int select_card(int card_no)