3 files changed, 25 insertions, 50 deletions

diff --git a/firmware/target/arm/as3525/ata_sd_as3525.c b/firmware/target/arm/as3525/ata_sd_as3525.c
index 8ec90c5ced..a6265b37f4 100644
--- a/firmware/target/arm/as3525/ata_sd_as3525.c
+++ b/firmware/target/arm/as3525/ata_sd_as3525.c
@@ -122,7 +122,7 @@ static volatile bool retry;
 static inline void mci_delay(void) { int i = 0xffff; while(i--) ; }
 
 #ifdef HAVE_HOTSWAP
-#if defined(SANSA_E200V2) || defined(SANSA_FUZE)
+#if defined(SANSA_E200V2) || defined(SANSA_FUZE) || defined(SANSA_C200V2)
 static int sd1_oneshot_callback(struct timeout *tmo)
 {
     (void)tmo;
@@ -146,7 +146,7 @@ void INT_GPIOA(void)
     GPIOA_IC = (1<<2);
     timeout_register(&sd1_oneshot, sd1_oneshot_callback, (3*HZ/10), 0);
 }
-#endif  /* defined(SANSA_E200V2) || defined(SANSA_FUZE) */
+#endif  /* defined(SANSA_E200V2) || defined(SANSA_FUZE) || defined(SANSA_C200V2) */
 #endif  /* HAVE_HOTSWAP */
 
 void INT_NAND(void)
@@ -437,7 +437,7 @@ static void init_pl180_controller(const int drive)
     VIC_INT_ENABLE |=
         (drive == INTERNAL_AS3525) ? INTERRUPT_NAND : INTERRUPT_MCI0;
 
-#if defined(SANSA_E200V2) || defined(SANSA_FUZE)
+#if defined(SANSA_E200V2) || defined(SANSA_FUZE) || defined(SANSA_C200V2)
     /* setup isr for microsd monitoring */
     VIC_INT_ENABLE |= (INTERRUPT_GPIOA);
     /* clear previous irq */
@@ -886,13 +886,12 @@ tCardInfo *card_get_info_target(int card_no)
 
 bool card_detect_target(void)
 {
-#ifdef HAVE_HOTSWAP
-    /* TODO: add e200/c200 */
-#if defined(SANSA_E200V2) || defined(SANSA_FUZE)
+#if defined(HAVE_HOTSWAP) && \
+    (defined(SANSA_E200V2) || defined(SANSA_FUZE) || defined(SANSA_C200V2))
     return !(GPIOA_PIN(2));
-#endif
-#endif
+#else
     return false;
+#endif
 }
 
 #ifdef HAVE_HOTSWAP
@@ -901,14 +900,14 @@ void card_enable_monitoring_target(bool on)
     if (on)
     {
     /* add e200v2/c200v2 here */
-#if defined(SANSA_E200V2) || defined(SANSA_FUZE)
+#if defined(SANSA_E200V2) || defined(SANSA_FUZE) || defined(SANSA_C200V2)
         /* enable isr*/
         GPIOA_IE |= (1<<2);
 #endif
     }
     else
     {
-#if defined(SANSA_E200V2) || defined(SANSA_FUZE)
+#if defined(SANSA_E200V2) || defined(SANSA_FUZE) || defined(SANSA_C200V2)
         /* edisable isr*/
         GPIOA_IE &= ~(1<<2);
 #endif
diff --git a/firmware/target/arm/as3525/debug-as3525.c b/firmware/target/arm/as3525/debug-as3525.c
index 7585f76431..405b7109b1 100644
--- a/firmware/target/arm/as3525/debug-as3525.c
+++ b/firmware/target/arm/as3525/debug-as3525.c
@@ -65,7 +65,7 @@
 /* FIXME: target tree is including ./debug-target.h rather than the one in
  * sansa-fuze/, even though deps contains the correct one
  * if I put the below into a sansa-fuze/debug-target.h, it doesn't work*/
-#if defined(SANSA_FUZE) || defined(SANSA_E200V2)
+#if defined(SANSA_FUZE) || defined(SANSA_E200V2) || defined(SANSA_C200V2)
 #define DEBUG_DBOP
 unsigned short button_dbop_data(void);
 #endif
diff --git a/firmware/target/arm/as3525/sansa-c200v2/button-c200v2.c b/firmware/target/arm/as3525/sansa-c200v2/button-c200v2.c
index d3504c97e9..965006ce61 100644
--- a/firmware/target/arm/as3525/sansa-c200v2/button-c200v2.c
+++ b/firmware/target/arm/as3525/sansa-c200v2/button-c200v2.c
@@ -36,6 +36,12 @@ static bool hold_button     = false;
 static bool hold_button_old = false;
 #endif
 
+/* for the debug menu */
+unsigned short button_dbop_data(void)
+{
+    return _dbop_din;
+}
+
 void button_init_device(void)
 {
     GPIOA_DIR &= ~(1<<3);
@@ -54,9 +60,6 @@ static void button_read_dbop(void)
     DBOP_TIMPOL_01 = 0xe167e167;         /* Set Timing & Polarity regs 0 & 1 */
     DBOP_TIMPOL_23 = 0xe167006e;         /* Set Timing & Polarity regs 2 & 3 */
 
-    int i = 50;
-    while(i--) asm volatile ("nop\n");
-
     DBOP_CTRL |= (1<<15);                /* start read */
     while (!(DBOP_STAT & (1<<16)));      /* wait for valid data */
 
@@ -74,52 +77,25 @@ static void button_read_dbop(void)
  */
 int button_read_device(void)
 {
-    int delay;
-    int dir_save_c = 0;
-    int afsel_save_c = 0;
     int btn = BUTTON_NONE;
 
-    /* Save the current direction and afsel */
-    dir_save_c = GPIOC_DIR;
-    afsel_save_c = GPIOC_AFSEL;
-
-    GPIOC_AFSEL &= ~(1<<6|1<<5|1<<4|1<<3);
-    GPIOC_DIR |= (1<<6|1<<5|1<<4|1<<3);
-
-    /* These should not be needed with button event interupts */
-    /* they are necessary now to clear out lcd data */
-
-    GPIOC_PIN(6) = (1<<6);
-    GPIOC_PIN(5) = (1<<5);
-    GPIOC_PIN(4) = (1<<4);
-    GPIOC_PIN(3) = (1<<3);
-    GPIOC_DIR &= ~(1<<6|1<<5|1<<4|1<<3);
-
-    delay = 100;
-    while(delay--)
-        asm volatile("nop\n");
-    
     /* direct GPIO connections */
     if (GPIOA_PIN(3))
         btn |= BUTTON_POWER;
-    if (!GPIOC_PIN(6))
-        btn |= BUTTON_RIGHT;
-    if (!GPIOC_PIN(5))
-        btn |= BUTTON_UP;
-    if (!GPIOC_PIN(4))
-        btn |= BUTTON_SELECT;
-    if (!GPIOC_PIN(3))
-        btn |= BUTTON_DOWN;
-
-    /* return to settings needed for lcd */
-    GPIOC_DIR = dir_save_c;
-    GPIOC_AFSEL = afsel_save_c;
 
     if(lcd_button_support())
         button_read_dbop();
 
-    if(_dbop_din & (1<<6))
+    if(!(_dbop_din & (1<<2)))
         btn |= BUTTON_LEFT;
+    if(!(_dbop_din & (1<<3)))
+        btn |= BUTTON_DOWN;
+    if(!(_dbop_din & (1<<4)))
+        btn |= BUTTON_SELECT;
+    if(!(_dbop_din & (1<<5)))
+        btn |= BUTTON_UP;
+    if(!(_dbop_din & (1<<6)))
+        btn |= BUTTON_RIGHT;
 
 #ifndef BOOTLOADER
     /* light handling */