USB: add weaked system clock config from resume

USBD_SystemClockConfigFromResume allows to configure
system clock and system IP clocks after wake-up from USB
resume callBack. It can be redefined by user at sketch level.
By default, calls 'SystemClock_Config()'.

Signed-off-by: Frederic Pillon <[email protected]>

Author: fpistm

cores/arduino/stm32/usb/usbd_conf.c

@@ -317,7 +317,7 @@ void HAL_PCD_SuspendCallback(PCD_HandleTypeDef *hpcd)
 void HAL_PCD_ResumeCallback(PCD_HandleTypeDef *hpcd)
 {
   if (hpcd->Init.low_power_enable) {
-    SystemClock_Config();
+    USBD_SystemClockConfigFromResume();
 
     /* Reset SLEEPDEEP bit of Cortex System Control Register */
     SCB->SCR &= (uint32_t)~((uint32_t)(SCB_SCR_SLEEPDEEP_Msk | SCB_SCR_SLEEPONEXIT_Msk));
@@ -415,9 +415,8 @@ void USB_H_IRQHandler(void)
     /* Reset SLEEPDEEP bit of Cortex System Control Register */
     SCB->SCR &= (uint32_t)~((uint32_t)(SCB_SCR_SLEEPDEEP_Msk | SCB_SCR_SLEEPONEXIT_Msk));
 
-    /* Configures system clock after wake-up from STOP: enable HSE, PLL and select
-    PLL as system clock source (HSE and PLL are disabled in STOP mode) */
-    SystemClock_Config();
+    /* Configures system clock after wake-up */
+    USBD_SystemClockConfigFromResume();
 
     /* ungate PHY clock */
     __HAL_PCD_UNGATE_PHYCLOCK((&g_hpcd));

cores/arduino/stm32/usb/usbd_if.c

@@ -175,4 +175,19 @@ void USBD_CDC_init(void)
   CDC_init();
 }
 #endif /* USBD_USE_CDC */
+
+/**
+  * @brief  Configures system clock and system IP clocks after wake-up from USB
+  *         resume callBack
+  * @note   Weaked function which can be redefined by user at the sketch level.
+  *         By default, calls 'SystemClock_Config()'.
+  * @param  None
+  * @retval None
+  */
+WEAK void USBD_SystemClockConfigFromResume(void)
+{
+  configIPClock();
+  SystemClock_Config();
+}
+
 #endif /* USBCON */

cores/arduino/stm32/usb/usbd_if.h

@@ -27,6 +27,10 @@ void USBD_reenumerate(void);
 #ifdef USBD_USE_CDC
 void USBD_CDC_init(void);
 #endif
+
+/* Weaked function */
+void USBD_SystemClockConfigFromResume(void);
+
 #ifdef __cplusplus
 }
 #endif