LPC54xxx: fixed flash write

Author: danielinux

config/examples/lpc54606j512.config

@@ -21,8 +21,8 @@ RAM_CODE?=0
 DUALBANK_SWAP?=0
 IMAGE_HEADER_SIZE?=256
 PKA?=1
-WOLFBOOT_PARTITION_SIZE?=0x3A000
-WOLFBOOT_SECTOR_SIZE?=0x1000
-WOLFBOOT_PARTITION_BOOT_ADDRESS?=0xA000
-WOLFBOOT_PARTITION_UPDATE_ADDRESS?=0x44000
-WOLFBOOT_PARTITION_SWAP_ADDRESS?=0x7f000
+WOLFBOOT_PARTITION_SIZE?=0x38000
+WOLFBOOT_SECTOR_SIZE?=0x8000
+WOLFBOOT_PARTITION_BOOT_ADDRESS?=0x8000
+WOLFBOOT_PARTITION_UPDATE_ADDRESS?=0x40000
+WOLFBOOT_PARTITION_SWAP_ADDRESS?=0x78000

hal/lpc.c

@@ -113,7 +113,7 @@ int RAMFUNCTION hal_flash_write(uint32_t address, const uint8_t *data, int len)
     uint32_t offset;
     int size;
     while (idx < len) {
-        page_address = (address + idx) / FLASH_PAGE_SIZE;
+        page_address = ((address + idx) / FLASH_PAGE_SIZE) * FLASH_PAGE_SIZE;
         offset = address - page_address;
         size = FLASH_PAGE_SIZE - offset;
         if (size > (len - idx))