|
@@ -80,3 +80,202 @@ void SystemClock_Config(void)
|
|
|
Error_Handler();
|
|
|
}
|
|
|
}
|
|
|
+
|
|
|
+
|
|
|
+#ifdef RT_USING_PM
|
|
|
+
|
|
|
+void SystemClock_MSI_ON(void)
|
|
|
+{
|
|
|
+ RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
|
+ RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
|
+
|
|
|
+ /* Initializes the CPU, AHB and APB busses clocks */
|
|
|
+ RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_MSI;
|
|
|
+ RCC_OscInitStruct.MSIState = RCC_MSI_ON;
|
|
|
+ if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
|
+ {
|
|
|
+ RT_ASSERT(0);
|
|
|
+ }
|
|
|
+
|
|
|
+ RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_SYSCLK;
|
|
|
+ RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_MSI;
|
|
|
+ if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_1) != HAL_OK)
|
|
|
+ {
|
|
|
+ Error_Handler();
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void SystemClock_MSI_OFF(void)
|
|
|
+{
|
|
|
+ RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
|
+
|
|
|
+ RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_MSI;
|
|
|
+ RCC_OscInitStruct.HSIState = RCC_MSI_OFF;
|
|
|
+ RCC_OscInitStruct.PLL.PLLState = RCC_PLL_NONE; /* No update on PLL */
|
|
|
+ if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
|
+ {
|
|
|
+ Error_Handler();
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void SystemClock_80M(void)
|
|
|
+{
|
|
|
+ RCC_OscInitTypeDef RCC_OscInitStruct;
|
|
|
+ RCC_ClkInitTypeDef RCC_ClkInitStruct;
|
|
|
+
|
|
|
+ /**Initializes the CPU, AHB and APB busses clocks */
|
|
|
+ RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
|
+ RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
|
+ RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
|
+ RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
|
+ RCC_OscInitStruct.PLL.PLLM = 1;
|
|
|
+ RCC_OscInitStruct.PLL.PLLN = 20;
|
|
|
+ RCC_OscInitStruct.PLL.PLLP = RCC_PLLP_DIV7;
|
|
|
+ RCC_OscInitStruct.PLL.PLLQ = RCC_PLLQ_DIV2;
|
|
|
+ RCC_OscInitStruct.PLL.PLLR = RCC_PLLR_DIV2;
|
|
|
+ if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
|
+ {
|
|
|
+ Error_Handler();
|
|
|
+ }
|
|
|
+
|
|
|
+ /**Initializes the CPU, AHB and APB busses clocks
|
|
|
+ */
|
|
|
+ RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK | RCC_CLOCKTYPE_SYSCLK
|
|
|
+ | RCC_CLOCKTYPE_PCLK1 | RCC_CLOCKTYPE_PCLK2;
|
|
|
+ RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
|
+ RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
|
+ RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV1;
|
|
|
+ RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
|
+
|
|
|
+ if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_4) != HAL_OK)
|
|
|
+ {
|
|
|
+ Error_Handler();
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void SystemClock_Config_fromSTOP(void)
|
|
|
+{
|
|
|
+ RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
|
+ RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
|
+ uint32_t pFLatency = 0;
|
|
|
+
|
|
|
+ /* Get the Oscillators & PLL configuration according to the internal RCC registers */
|
|
|
+ HAL_RCC_GetOscConfig(&RCC_OscInitStruct);
|
|
|
+
|
|
|
+ /* Wake up on HSI, re-enable MSI and PLL with MSI as source */
|
|
|
+ RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_MSI;
|
|
|
+ RCC_OscInitStruct.MSIState = RCC_MSI_ON;
|
|
|
+ RCC_OscInitStruct.MSIClockRange = RCC_MSIRANGE_6;
|
|
|
+ RCC_OscInitStruct.MSICalibrationValue = RCC_MSICALIBRATION_DEFAULT;
|
|
|
+ RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
|
+ RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_MSI;
|
|
|
+ if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
|
+ {
|
|
|
+ Error_Handler();
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Get the Clocks configuration according to the internal RCC registers */
|
|
|
+ HAL_RCC_GetClockConfig(&RCC_ClkInitStruct, &pFLatency);
|
|
|
+
|
|
|
+ /* Select PLL as system clock source */
|
|
|
+ RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_SYSCLK;
|
|
|
+ RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
|
+ if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, pFLatency) != HAL_OK)
|
|
|
+ {
|
|
|
+ Error_Handler();
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void SystemClock_24M(void)
|
|
|
+{
|
|
|
+ RCC_OscInitTypeDef RCC_OscInitStruct;
|
|
|
+ RCC_ClkInitTypeDef RCC_ClkInitStruct;
|
|
|
+
|
|
|
+ /** Initializes the CPU, AHB and APB busses clocks */
|
|
|
+ RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
|
+ RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
|
+ RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
|
+ RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
|
+ RCC_OscInitStruct.PLL.PLLM = 1;
|
|
|
+ RCC_OscInitStruct.PLL.PLLN = 12;
|
|
|
+ RCC_OscInitStruct.PLL.PLLP = RCC_PLLP_DIV7;
|
|
|
+ RCC_OscInitStruct.PLL.PLLQ = RCC_PLLQ_DIV2;
|
|
|
+ RCC_OscInitStruct.PLL.PLLR = RCC_PLLR_DIV4;
|
|
|
+ if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
|
+ {
|
|
|
+ Error_Handler();
|
|
|
+ }
|
|
|
+ /** Initializes the CPU, AHB and APB busses clocks */
|
|
|
+ RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK | RCC_CLOCKTYPE_SYSCLK
|
|
|
+ | RCC_CLOCKTYPE_PCLK1 | RCC_CLOCKTYPE_PCLK2;
|
|
|
+ RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
|
+ RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
|
+ RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV1;
|
|
|
+ RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
|
+ if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_1) != HAL_OK)
|
|
|
+ {
|
|
|
+ Error_Handler();
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void SystemClock_2M(void)
|
|
|
+{
|
|
|
+ RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
|
+ RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
|
+
|
|
|
+ /* MSI is enabled after System reset, update MSI to 2Mhz (RCC_MSIRANGE_5) */
|
|
|
+ RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_MSI;
|
|
|
+ RCC_OscInitStruct.MSIState = RCC_MSI_ON;
|
|
|
+ RCC_OscInitStruct.MSIClockRange = RCC_MSIRANGE_5;
|
|
|
+ RCC_OscInitStruct.MSICalibrationValue = RCC_MSICALIBRATION_DEFAULT;
|
|
|
+ RCC_OscInitStruct.PLL.PLLState = RCC_PLL_NONE;
|
|
|
+ if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
|
+ {
|
|
|
+ /* Initialization Error */
|
|
|
+ Error_Handler();
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Select MSI as system clock source and configure the HCLK, PCLK1 and PCLK2
|
|
|
+ clocks dividers */
|
|
|
+ RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_SYSCLK;
|
|
|
+ RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_MSI;
|
|
|
+ RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
|
+ RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV1;
|
|
|
+ RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
|
+ if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_0) != HAL_OK)
|
|
|
+ {
|
|
|
+ /* Initialization Error */
|
|
|
+ Error_Handler();
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * @brief Configures system clock after wake-up from STOP: enable HSI, PLL
|
|
|
+ * and select PLL as system clock source.
|
|
|
+ * @param None
|
|
|
+ * @retval None
|
|
|
+ */
|
|
|
+void SystemClock_ReConfig(uint8_t mode)
|
|
|
+{
|
|
|
+ SystemClock_MSI_ON();
|
|
|
+
|
|
|
+ switch (mode)
|
|
|
+ {
|
|
|
+ case PM_RUN_MODE_HIGH_SPEED:
|
|
|
+ case PM_RUN_MODE_NORMAL_SPEED:
|
|
|
+ SystemClock_80M();
|
|
|
+ break;
|
|
|
+ case PM_RUN_MODE_MEDIUM_SPEED:
|
|
|
+ SystemClock_24M();
|
|
|
+ break;
|
|
|
+ case PM_RUN_MODE_LOW_SPEED:
|
|
|
+ SystemClock_2M();
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ // SystemClock_MSI_OFF();
|
|
|
+}
|
|
|
+
|
|
|
+#endif
|