cpu: Add clock source selection based on CLOCK_HSE or CLOCK_HSI for STM32F4 family

This commit is contained in:
DipSwitch 2015-10-27 10:57:23 +01:00
parent f626ee5969
commit 5b526df730

View File

@ -14,6 +14,7 @@
* @brief Implementation of the CPU initialization
*
* @author Hauke Petersen <hauke.petersen@fu-berlin.de>
* @author Nick van IJzendoorn <nijzendoorn@engineering-spirit.nl>
* @}
*/
@ -21,7 +22,22 @@
#include "cpu.h"
#include "periph_conf.h"
/* Check the source to be used for the PLL */
#if defined(CLOCK_HSI) && defined(CLOCK_HSE)
#error "Only provide one of two CLOCK_HSI/CLOCK_HSE"
#elif CLOCK_HSI
#define CLOCK_CR_SOURCE RCC_CR_HSION
#define CLOCK_CR_SOURCE_RDY RCC_CR_HSIRDY
#define CLOCK_PLL_SOURCE RCC_PLLCFGR_PLLSRC_HSI
#define CLOCK_DISABLE_HSI 0
#elif CLOCK_HSE
#define CLOCK_CR_SOURCE RCC_CR_HSEON
#define CLOCK_CR_SOURCE_RDY RCC_CR_HSERDY
#define CLOCK_PLL_SOURCE RCC_PLLCFGR_PLLSRC_HSE
#define CLOCK_DISABLE_HSI 1
#else
#error "Please provide CLOCK_HSI or CLOCK_HSE in boards/NAME/includes/perhip_cpu.h"
#endif
static void cpu_clock_init(void);
@ -45,8 +61,8 @@ void cpu_init(void)
*
* Use the following formulas to calculate the needed values:
*
* SYSCLK = ((HSE_VALUE / CLOCK_PLL_M) * CLOCK_PLL_N) / CLOCK_PLL_P
* USB, SDIO and RNG Clock = ((HSE_VALUE / CLOCK_PLL_M) * CLOCK_PLL_N) / CLOCK_PLL_Q
* SYSCLK = ((XTAL_SPEED / CLOCK_PLL_M) * CLOCK_PLL_N) / CLOCK_PLL_P
* USB, SDIO and RNG Clock = ((XTAL_SPEED / CLOCK_PLL_M) * CLOCK_PLL_N) / CLOCK_PLL_Q
*
* The actual used values are specified in the board's `periph_conf.h` file.
*
@ -55,11 +71,6 @@ void cpu_init(void)
*/
static void cpu_clock_init(void)
{
/* configure the HSE clock */
/* enable the HSI clock */
RCC->CR |= RCC_CR_HSION;
/* reset clock configuration register */
RCC->CFGR = 0;
@ -69,11 +80,11 @@ static void cpu_clock_init(void)
/* disable all clock interrupts */
RCC->CIR = 0;
/* enable the HSE clock */
RCC->CR |= RCC_CR_HSEON;
/* enable the high speed clock */
RCC->CR |= CLOCK_CR_SOURCE;
/* wait for HSE to be ready */
while (!(RCC->CR & RCC_CR_HSERDY)) {}
/* wait for the high speed clock source to be ready */
while (!(RCC->CR & CLOCK_CR_SOURCE_RDY)) {}
/* setup power module */
@ -98,8 +109,8 @@ static void cpu_clock_init(void)
/* reset PLL config register */
RCC->PLLCFGR = 0;
/* set HSE as source for the PLL */
RCC->PLLCFGR |= RCC_PLLCFGR_PLLSRC_HSE;
/* set high speed clock as source for the PLL */
RCC->PLLCFGR |= CLOCK_PLL_SOURCE;
/* set division factor for main PLL input clock */
RCC->PLLCFGR |= (CLOCK_PLL_M & 0x3F);
/* set main PLL multiplication factor for VCO */
@ -136,4 +147,10 @@ static void cpu_clock_init(void)
/* wait for sysclock to be stable */
while (!(RCC->CFGR & RCC_CFGR_SWS_PLL)) {}
#if CLOCK_DISABLE_HSI
/* disable the HSI if we use the HSE */
RCC->CR &= ~(RCC_CR_HSION);
while (RCC->CR & RCC_CR_HSIRDY) {}
#endif
}