core: U5: enable HAL ICACHE

Signed-off-by: Frederic Pillon <frederic.pillon@st.com>

Author: fpistm

cores/arduino/stm32/stm32yyxx_hal_conf.h

@@ -65,6 +65,12 @@
   #undef HAL_TIM_MODULE_ENABLED
 #endif
 
+#if !defined(HAL_ICACHE_MODULE_DISABLED)
+  #define HAL_ICACHE_MODULE_ENABLED
+#else
+  #undef HAL_ICACHE_MODULE_ENABLED
+#endif
+
 /*
  * Not defined by default
  */
@@ -137,7 +143,6 @@
   HAL_HASH_MODULE_ENABLED
   HAL_HCD_MODULE_ENABLED
   HAL_HRTIM_MODULE_ENABLED
-  HAL_ICACHE_MODULE_ENABLED
   HAL_IRDA_MODULE_ENABLED
   HAL_IWDG_MODULE_ENABLED // IWD built-in library uses LL
   HAL_JPEG_MODULE_ENABLED

libraries/SrcWrapper/src/stm32/hw_config.c

@@ -53,6 +53,16 @@ void hw_config_init(void)
 #if defined (USBCON) && defined(USBD_USE_CDC)
   USBD_CDC_init();
 #endif
+
+#if (__CORTEX_M == 33U) &&\
+  defined(HAL_ICACHE_MODULE_ENABLED) && !defined(HAL_ICACHE_MODULE_DISABLED)
+  if (HAL_ICACHE_ConfigAssociativityMode(ICACHE_1WAY) != HAL_OK) {
+    Error_Handler();
+  }
+  if (HAL_ICACHE_Enable() != HAL_OK) {
+    Error_Handler();
+  }
+#endif
 }
 #ifdef __cplusplus
 }