soc: arm: smartbond: Reconfigure cache on init
Applications that are run from MCUboot should reconfigure cache to
ensure they run from cached ared on flash. Initial cache configuration
is done by internal bootloader and is valid for MCUboot only.
Cache is configured once at boot, then new configuration is applied by
triggering SW reset.
Co-authored-by: Andrzej Kaczmarek <andrzej.kaczmarek@codecoup.pl>
Signed-off-by: Andrzej Kaczmarek <andrzej.kaczmarek@codecoup.pl>
Signed-off-by: Niek Ilmer <niek.ilmer.aj@renesas.com>
diff --git a/soc/arm/renesas_smartbond/da1469x/Kconfig.defconfig.series b/soc/arm/renesas_smartbond/da1469x/Kconfig.defconfig.series
index 60eec76..ecbc761 100644
--- a/soc/arm/renesas_smartbond/da1469x/Kconfig.defconfig.series
+++ b/soc/arm/renesas_smartbond/da1469x/Kconfig.defconfig.series
@@ -20,4 +20,7 @@
config FLASH_BASE_ADDRESS
default $(dt_chosen_reg_addr_hex,$(DT_CHOSEN_Z_FLASH))
+config PLATFORM_SPECIFIC_INIT
+ default y
+
endif # SOC_SERIES_DA1469X
diff --git a/soc/arm/renesas_smartbond/da1469x/soc.c b/soc/arm/renesas_smartbond/da1469x/soc.c
index b3d5bbc..b353b10 100644
--- a/soc/arm/renesas_smartbond/da1469x/soc.c
+++ b/soc/arm/renesas_smartbond/da1469x/soc.c
@@ -7,6 +7,24 @@
#include <zephyr/init.h>
#include <zephyr/arch/arm/aarch32/cortex_m/cmsis.h>
#include <zephyr/arch/arm/aarch32/nmi.h>
+#include <zephyr/linker/linker-defs.h>
+#include <string.h>
+
+#define REMAP_ADR0_QSPI 0x2
+
+#define FLASH_REGION_SIZE_32M 0
+#define FLASH_REGION_SIZE_16M 1
+#define FLASH_REGION_SIZE_8M 2
+#define FLASH_REGION_SIZE_4M 3
+#define FLASH_REGION_SIZE_2M 4
+#define FLASH_REGION_SIZE_1M 5
+#define FLASH_REGION_SIZE_05M 6
+#define FLASH_REGION_SIZE_025M 7
+
+#if defined(CONFIG_BOOTLOADER_MCUBOOT)
+#define MAGIC 0xaabbccdd
+static uint32_t z_renesas_cache_configured;
+#endif
void sys_arch_reboot(int type)
{
@@ -15,6 +33,81 @@
NVIC_SystemReset();
}
+#if defined(CONFIG_BOOTLOADER_MCUBOOT)
+static void z_renesas_configure_cache(void)
+{
+ uint32_t cache_start;
+ uint32_t region_size;
+ uint32_t reg_region_size;
+ uint32_t reg_cache_len;
+
+ if (z_renesas_cache_configured == MAGIC) {
+ return;
+ }
+
+ cache_start = (uint32_t)&_vector_start;
+ region_size = (uint32_t)&__rom_region_end - cache_start;
+
+ /* Disable cache before configuring it */
+ CACHE->CACHE_CTRL2_REG = 0;
+ CRG_TOP->SYS_CTRL_REG &= ~CRG_TOP_SYS_CTRL_REG_CACHERAM_MUX_Msk;
+
+ /* Disable MRM unit */
+ CACHE->CACHE_MRM_CTRL_REG = 0;
+ CACHE->CACHE_MRM_TINT_REG = 0;
+ CACHE->CACHE_MRM_MISSES_THRES_REG = 0;
+
+ if (region_size > MB(16)) {
+ reg_region_size = FLASH_REGION_SIZE_32M;
+ } else if (region_size > MB(8)) {
+ reg_region_size = FLASH_REGION_SIZE_16M;
+ } else if (region_size > MB(4)) {
+ reg_region_size = FLASH_REGION_SIZE_8M;
+ } else if (region_size > MB(2)) {
+ reg_region_size = FLASH_REGION_SIZE_4M;
+ } else if (region_size > MB(1)) {
+ reg_region_size = FLASH_REGION_SIZE_2M;
+ } else if (region_size > KB(512)) {
+ reg_region_size = FLASH_REGION_SIZE_1M;
+ } else if (region_size > KB(256)) {
+ reg_region_size = FLASH_REGION_SIZE_05M;
+ } else {
+ reg_region_size = FLASH_REGION_SIZE_025M;
+ }
+ CACHE->CACHE_FLASH_REG =
+ (cache_start >> 16) << CACHE_CACHE_FLASH_REG_FLASH_REGION_BASE_Pos |
+ ((cache_start & 0xffff) >> 2) << CACHE_CACHE_FLASH_REG_FLASH_REGION_OFFSET_Pos |
+ reg_region_size << CACHE_CACHE_FLASH_REG_FLASH_REGION_SIZE_Pos;
+
+ reg_cache_len = CLAMP(reg_region_size / KB(64), 0, 0x1ff);
+ CACHE->CACHE_CTRL2_REG = (CACHE->CACHE_FLASH_REG & ~CACHE_CACHE_CTRL2_REG_CACHE_LEN_Msk) |
+ reg_cache_len;
+
+ /* Copy IVT from flash to start of RAM.
+ * It will be remapped at 0x0 so it can be used after SW Reset
+ */
+ memcpy(&_image_ram_start, &_vector_start, 0x200);
+
+ /* Configure remapping */
+ CRG_TOP->SYS_CTRL_REG = (CRG_TOP->SYS_CTRL_REG & ~CRG_TOP_SYS_CTRL_REG_REMAP_ADR0_Msk) |
+ CRG_TOP_SYS_CTRL_REG_CACHERAM_MUX_Msk |
+ CRG_TOP_SYS_CTRL_REG_REMAP_INTVECT_Msk |
+ REMAP_ADR0_QSPI;
+
+ z_renesas_cache_configured = MAGIC;
+
+ /* Trigger SW Reset to apply cache configuration */
+ CRG_TOP->SYS_CTRL_REG |= CRG_TOP_SYS_CTRL_REG_SW_RESET_Msk;
+}
+#endif /* CONFIG_HAS_FLASH_LOAD_OFFSET */
+
+void z_arm_platform_init(void)
+{
+#if defined(CONFIG_BOOTLOADER_MCUBOOT)
+ z_renesas_configure_cache();
+#endif
+}
+
static int renesas_da14699_init(void)
{
