ReflashBootloader.cxx

Go to the documentation of this file.

 
#include "utils/ReflashBootloader.hxx"
 
#include "freertos/bootloader_hal.h"
 
extern const SegmentTable table[];
 
extern "C" {
void reflash_bootloader_entry()
{
    bootloader_hw_set_to_safe();
    bootloader_hw_init();
 
    for (unsigned i = 0; table[i].length; i++)
    {
        uint8_t *dst_address = table[i].dst_address;
        const uint8_t *src_address = table[i].src_address;
        uint8_t *const end_address = table[i].dst_address + table[i].length;
        while (dst_address < end_address)
        {
            const void *page_start;
            uint32_t page_length_bytes;
            get_flash_page_info(dst_address, &page_start, &page_length_bytes);
            raw_erase_flash_page(page_start);
            uint32_t write_length = end_address - dst_address;
            uint32_t max_length = ((const uint8_t*)page_start) + page_length_bytes - dst_address;
            if (write_length > max_length)
            {
                write_length = max_length;
            }
            raw_write_flash(dst_address, src_address, write_length);
            dst_address += write_length;
            src_address += write_length;
        }
    }
 
    bootloader_reboot();
}
}