1 files changed, 13 insertions, 10 deletions

diff --git a/firmware/target/arm/as3525/sansa-fuze/button-fuze.c b/firmware/target/arm/as3525/sansa-fuze/button-fuze.c
index 9b6df70bd9..f5dca441d5 100644
--- a/firmware/target/arm/as3525/sansa-fuze/button-fuze.c
+++ b/firmware/target/arm/as3525/sansa-fuze/button-fuze.c
@@ -128,13 +128,14 @@ bool button_hold(void)
 
 static short button_dbop(void)
 {
-    /* skip home reading if lcd_button_support was blocked,
+    /* skip home and power reading if lcd_button_support was blocked,
      * since the dbop bit 15 is invalid then, and use the old value instead */
-    /* -20 (arbitary value) indicates valid home button read */
-    int old_home = -20;
-    int delay = 0;
+    /* -20 (arbitary value) indicates valid home&power button read */
+    int old_home_power = -20;
     if(!lcd_button_support())
-        old_home = (_dbop_din & 1<<15);
+    {
+        old_home_power = (_dbop_din & (1<<15|1<<8));
+    }
 
     /* Wait for fifo to empty */
     while ((DBOP_STAT & (1<<10)) == 0);
@@ -145,10 +146,8 @@ static short button_dbop(void)
     DBOP_TIMPOL_01 = 0xe167e167;
     DBOP_TIMPOL_23 = 0xe167006e;
 
-    while(delay++ < 64);
-
     DBOP_CTRL |= (1<<15); /* start read */
-    ((DBOP_STAT & (1<<16)) == 0); /* wait for valid data */
+    while((DBOP_STAT & (1<<16)) == 0); /* wait for valid data */
 
     _dbop_din = DBOP_DIN; /* now read */
 
@@ -158,8 +157,12 @@ static short button_dbop(void)
     DBOP_CTRL |= (1<<16);
     DBOP_CTRL &= ~(1<<19);
 
-    if (old_home != -20)
-        _dbop_din |= old_home;
+    /* write back old values if blocked */
+    if (old_home_power != -20)
+    {
+        _dbop_din |= old_home_power & 1<<15;
+        _dbop_din &= 0xfeff|(old_home_power & 1<<8);
+    }
     return _dbop_din;
 }