drivers: clock_control: stm32u5: set voltage scaling VOS for MSIS

In case of MSIS selected as system clock source it is necessary
to set Voltage scaling (VOS) when freqency is greater than 24MHz

Signed-off-by: Alexandre Bourdiol <[email protected]>

Author: ABOSTM

drivers/clock_control/clock_stm32_ll_u5.c

@@ -487,6 +487,15 @@ void config_src_sysclk_msis(LL_UTILS_ClkInitTypeDef s_ClkInitStruct)
 		LL_SetFlashLatency(new_hclk_freq);
 	}
 
+	if (new_hclk_freq > MHZ(24)) {
+		/* when freq > 24MHz it is necessary to set voltage scaling
+		 * to range3
+		 */
+		LL_PWR_SetRegulVoltageScaling(LL_PWR_REGU_VOLTAGE_SCALE3);
+		while (LL_PWR_IsActiveFlag_VOS() == 0) {
+		}
+	}
+
 	/* Set MSIS as SYSCLCK source */
 	set_up_clk_msis();
 	LL_RCC_SetSysClkSource(LL_RCC_SYS_CLKSOURCE_MSIS);