X-Git-Url: https://review.openocd.org/gitweb?a=blobdiff_plain;f=contrib%2Floaders%2Fflash%2Fstm32l4x.S;h=799dec5277f988a57b2795504011be0df956415e;hb=refs%2Fchanges%2F40%2F3140%2F2;hp=045f9d0d6b16c045ce495dbe7823e9c4cced8447;hpb=a28b94e9ab00c63951f68ac44833e9d51200f7db;p=openocd.git

diff --git a/contrib/loaders/flash/stm32l4x.S b/contrib/loaders/flash/stm32l4x.S
index 045f9d0d6b..799dec5277 100644
--- 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