@@ -990,91 +990,6 @@ static int set_up_plls(void)
990
990
return 0 ;
991
991
}
992
992
993
- #if defined(CONFIG_SOC_SERIES_STM32H7RSX )
994
- /* adapted from the stm32cube SystemCoreClockUpdate*/
995
- void stm32_system_clock_update (void )
996
- {
997
- uint32_t sysclk , hsivalue , pllsource , pllm , pllp , core_presc ;
998
- float_t pllfracn , pllvco ;
999
-
1000
- /* Get SYSCLK source */
1001
- switch (RCC -> CFGR & RCC_CFGR_SWS ) {
1002
- case 0x00 : /* HSI used as system clock source (default after reset) */
1003
- sysclk = (HSI_VALUE >> ((RCC -> CR & RCC_CR_HSIDIV )
1004
- >> RCC_CR_HSIDIV_Pos ));
1005
- break ;
1006
-
1007
- case 0x08 : /* CSI used as system clock source */
1008
- sysclk = CSI_VALUE ;
1009
- break ;
1010
-
1011
- case 0x10 : /* HSE used as system clock source */
1012
- sysclk = HSE_VALUE ;
1013
- break ;
1014
-
1015
- case 0x18 : /* PLL1 used as system clock source */
1016
- /*
1017
- * PLL1_VCO = (HSE_VALUE or HSI_VALUE or CSI_VALUE/ PLLM) * PLLN
1018
- * SYSCLK = PLL1_VCO / PLL1R
1019
- */
1020
- pllsource = (RCC -> PLLCKSELR & RCC_PLLCKSELR_PLLSRC );
1021
- pllm = ((RCC -> PLLCKSELR & RCC_PLLCKSELR_DIVM1 ) >> RCC_PLLCKSELR_DIVM1_Pos );
1022
-
1023
- if ((RCC -> PLLCFGR & RCC_PLLCFGR_PLL1FRACEN ) != 0U ) {
1024
- pllfracn = (float_t )(uint32_t )(((RCC -> PLL1FRACR & RCC_PLL1FRACR_FRACN )
1025
- >> RCC_PLL1FRACR_FRACN_Pos ));
1026
- } else {
1027
- pllfracn = (float_t )0U ;
1028
- }
1029
-
1030
- if (pllm != 0U ) {
1031
- switch (pllsource ) {
1032
- case 0x02 : /* HSE used as PLL1 clock source */
1033
- pllvco = ((float_t )HSE_VALUE / (float_t )pllm ) *
1034
- ((float_t )(uint32_t )(RCC -> PLL1DIVR1 & RCC_PLL1DIVR1_DIVN ) +
1035
- (pllfracn /(float_t )0x2000 ) + (float_t )1 );
1036
- break ;
1037
-
1038
- case 0x01 : /* CSI used as PLL1 clock source */
1039
- pllvco = ((float_t )CSI_VALUE / (float_t )pllm ) *
1040
- ((float_t )(uint32_t )(RCC -> PLL1DIVR1 & RCC_PLL1DIVR1_DIVN ) +
1041
- (pllfracn /(float_t )0x2000 ) + (float_t )1 );
1042
- break ;
1043
-
1044
- case 0x00 : /* HSI used as PLL1 clock source */
1045
- default :
1046
- hsivalue = (HSI_VALUE >> ((RCC -> CR & RCC_CR_HSIDIV ) >>
1047
- RCC_CR_HSIDIV_Pos ));
1048
- pllvco = ((float_t )hsivalue / (float_t )pllm ) *
1049
- ((float_t )(uint32_t )(RCC -> PLL1DIVR1 & RCC_PLL1DIVR1_DIVN ) +
1050
- (pllfracn /(float_t )0x2000 ) + (float_t )1 );
1051
- break ;
1052
- }
1053
-
1054
- pllp = (((RCC -> PLL1DIVR1 & RCC_PLL1DIVR1_DIVP ) >>
1055
- RCC_PLL1DIVR1_DIVP_Pos ) + 1U );
1056
- sysclk = (uint32_t )(float_t )(pllvco /(float_t )pllp );
1057
- } else {
1058
- sysclk = 0U ;
1059
- }
1060
- break ;
1061
-
1062
- default : /* Unexpected, default to HSI used as system clk source (default after reset) */
1063
- sysclk = (HSI_VALUE >> ((RCC -> CR & RCC_CR_HSIDIV ) >> RCC_CR_HSIDIV_Pos ));
1064
- break ;
1065
- }
1066
-
1067
- /* system clock frequency : CM7 CPU frequency */
1068
- core_presc = (RCC -> CDCFGR & RCC_CDCFGR_CPRE );
1069
-
1070
- if (core_presc >= 8U ) {
1071
- SystemCoreClock = (sysclk >> (core_presc - RCC_CDCFGR_CPRE_3 + 1U ));
1072
- } else {
1073
- SystemCoreClock = sysclk ;
1074
- }
1075
- }
1076
- #endif /* CONFIG_SOC_SERIES_STM32H7RSX */
1077
-
1078
993
int stm32_clock_control_init (const struct device * dev )
1079
994
{
1080
995
int r = 0 ;
0 commit comments