fixme: add bootloader reflasher for c33

This is needed to expose the second dfu endpoint for sketches

Author: facchinm

loader/CMakeLists.txt

@@ -8,5 +8,9 @@ find_package(Zephyr REQUIRED HINTS $ENV{ZEPHYR_BASE})
 
 project(app LANGUAGES C CXX)
 
+include(${CMAKE_CURRENT_SOURCE_DIR}/blobs/CMakeLists.txt)
+
 FILE(GLOB app_sources *.c)
 target_sources(app PRIVATE ${app_sources})
+
+target_link_libraries(app PUBLIC blobs)

loader/blobs/CMakeLists.txt

@@ -0,0 +1,12 @@
+zephyr_interface_library_named(blobs)
+
+if (CONFIG_BOARD_ARDUINO_PORTENTA_C33)
+    set(gen_inc_dir ${ZEPHYR_BINARY_DIR}/misc/generated)
+    zephyr_include_directories(${gen_inc_dir})
+    set(gen_dir ${gen_inc_dir}/c33_bl_patch)
+    generate_inc_file_for_target(
+        ${ZEPHYR_CURRENT_LIBRARY}
+        ${CMAKE_CURRENT_SOURCE_DIR}/blobs/c33_bl.bin
+        ${gen_dir}/c33_bl.bin.inc
+    )
+endif()

loader/blobs/c33_bl.bin

@@ -100,4 +100,48 @@ int smh_init(void) {
 }
 
 SYS_INIT(smh_init, POST_KERNEL, CONFIG_CLOCK_CONTROL_PWM_INIT_PRIORITY);
+#endif
+
+#if defined(CONFIG_BOARD_ARDUINO_PORTENTA_C33)
+#include <zephyr/kernel.h>
+#include <zephyr/storage/flash_map.h>
+
+int maybe_flash_bootloader(void)
+{
+	// memcmp the first 256bytes of "embedded bootloader" and address 0x0
+	// if they are different, flash the bootloader
+	const uint8_t embedded_bootloader[] = {
+		#include "c33_bl_patch/c33_bl.bin.inc"
+	};
+
+	const struct flash_area *fa;
+	int rc;
+
+	rc = flash_area_open(FIXED_PARTITION_ID(mcuboot), &fa);
+	if (rc) {
+		printk("Failed to open flash area, rc %d\n", rc);
+		return rc;
+	}
+
+	uint8_t flash_bootloader[256];
+	flash_area_read(fa, 0, flash_bootloader, 256);
+
+	if (memcmp(embedded_bootloader, flash_bootloader, 256) != 0) {
+		// flash the bootloader
+		rc = flash_area_erase(fa, 0, fa->fa_size);
+		if (rc) {
+			printk("Failed to erase flash area, rc %d\n", rc);
+			return rc;
+		}
+		flash_area_write(fa, 0, embedded_bootloader, sizeof(embedded_bootloader));
+		if (rc) {
+			printk("Failed to write flash area, rc %d\n", rc);
+			return rc;
+		}
+	}
+	return 0;
+}
+
+SYS_INIT(maybe_flash_bootloader, POST_KERNEL, CONFIG_FILE_SYSTEM_INIT_PRIORITY);
+
 #endif