stm32l4x.c: Correct waiting for data.

[openocd] / contrib / loaders / flash / stm32l4x.S

diff --git a/contrib/loaders/flash/stm32l4x.S b/contrib/loaders/flash/stm32l4x.S
index 045f9d0d6b16c045ce495dbe7823e9c4cced8447..799dec5277f988a57b2795504011be0df956415e 100644 (file)
--- a/contrib/loaders/flash/stm32l4x.S
+++ b/contrib/loaders/flash/stm32l4x.S
@@ -65,7 +65,10 @@ wait_fifo:
        beq     exit
        ldr     r5, [r0, #4]    /* read rp */
        subs    r6, r8, r5      /* number of bytes available for read in r6*/
-       cmp     r6, #7          /* wait until 8 bytes are available */
+       itt     mi              /* if wrapped around*/
+       addmi   r6, r1          /* add size of buffer */
+       submi   r6, r0
+       cmp     r6, #8          /* wait until 8 bytes are available */
        bcc     wait_fifo
 
        ldr     r6, STM32_PROG