Missed this, another F4 specific difference

androda · Apr 7, 2022 · d1c36e5 · d1c36e5
1 parent c025c06
commit d1c36e5
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/F4_BlueSCSI/F4_BlueSCSI.ino b/F4_BlueSCSI/F4_BlueSCSI.ino
@@ -920,7 +920,7 @@ void readDataLoop(uint32_t blockSize)
     WAIT_ACK_ACTIVE();
     uint32_t ret = PBREG->IDR;
     REQ_OFF();
-    *dstptr++ = ~(ret >> 8);
+    *dstptr++ = (byte)~(((ret >> 8) & 0b11110111) | ((ret & 0x00000004) << 1));
     // Move wait loop in to a single 8 byte prefetch buffer
     asm("nop.w;nop");
     WAIT_ACK_INACTIVE();