stm32/mboot/main: Use correct formula for DFU download address.

As per ST's DfuSe specification, and following their example code.

1 files changed, 2 insertions, 1 deletions

diff --git a/ports/stm32/mboot/main.c b/ports/stm32/mboot/main.c
index 32a8e76dd..888ba4534 100644
--- a/ports/stm32/mboot/main.c
+++ b/ports/stm32/mboot/main.c
@@ -760,7 +760,8 @@ static int dfu_process_dnload(void) {
         }
     } else if (dfu_state.wBlockNum > 1) {
         // write data to memory
-        ret = do_write(dfu_state.addr, dfu_state.buf, dfu_state.wLength);
+        uint32_t addr = (dfu_state.wBlockNum - 2) * DFU_XFER_SIZE + dfu_state.addr;
+        ret = do_write(addr, dfu_state.buf, dfu_state.wLength);
     }
     if (ret == 0) {
         return DFU_STATUS_DNLOAD_IDLE;