66 lines
2.6 KiB
C
66 lines
2.6 KiB
C
// Copyright (c) 2023 Cesanta Software Limited
|
|
// All rights reserved
|
|
//
|
|
// This file contains essentials required by the CMSIS:
|
|
// uint32_t SystemCoreClock - holds the system core clock value
|
|
// SystemInit() - initialises the system, e.g. sets up clocks
|
|
|
|
#include "hal.h"
|
|
|
|
uint32_t SystemCoreClock = CPU_FREQUENCY;
|
|
|
|
static inline unsigned int div2prescval(unsigned int div) {
|
|
// 0 --> /1; 8 --> /2 ... 11 --> /16; 12 --> /64 ... 15 --> /512
|
|
if (div == 1) return 0;
|
|
if (div > 16) div /= 2;
|
|
unsigned int val = 7;
|
|
while (div >>= 1) ++val;
|
|
return val;
|
|
}
|
|
|
|
static inline unsigned int pllrge(unsigned int f) {
|
|
unsigned int val = 0;
|
|
while (f >>= 1) ++val;
|
|
return val - 1;
|
|
}
|
|
|
|
void SystemInit(void) { // Called automatically by startup code
|
|
SCB->CPACR |= ((3UL << 10 * 2) | (3UL << 11 * 2)); // Enable FPU
|
|
asm("DSB");
|
|
asm("ISB");
|
|
PWR->CR3 |= BIT(1); // select LDO (reset value)
|
|
while ((PWR->CSR1 && BIT(13)) == 0) spin(1); // ACTVOSRDY
|
|
PWR->D3CR |= BIT(15) | BIT(14); // Select VOS1
|
|
uint32_t f = PWR->D3CR; // fake read to wait for bus clocking
|
|
while ((PWR->CSR1 && BIT(13)) == 0) spin(1); // ACTVOSRDY
|
|
SYSCFG->PWRCR |= BIT(0); // ODEN
|
|
f = SYSCFG->PWRCR;
|
|
while ((PWR->CSR1 && BIT(13)) == 0) spin(1); // ACTVOSRDY
|
|
(void) f;
|
|
SETBITS(
|
|
RCC->D1CFGR, (0x0F << 8) | (7 << 4) | (0x0F << 0),
|
|
(div2prescval(D1CPRE) << 8) | (D1PPRE << 4) | (div2prescval(HPRE) << 0));
|
|
RCC->D2CFGR = (D2PPRE2 << 8) | (D2PPRE1 << 4);
|
|
RCC->D3CFGR = (D3PPRE << 4);
|
|
SETBITS(RCC->PLLCFGR, 3 << 2,
|
|
pllrge(PLL1_HSI / PLL1_M)
|
|
<< 2); // keep reset config (DIVP1EN, !PLL1VCOSEL), PLL1RGE
|
|
SETBITS(RCC->PLL1DIVR, (0x7F << 9) | (0x1FF << 0),
|
|
((PLL1_P - 1) << 9) | ((PLL1_N - 1) << 0)); // Set PLL1_P PLL1_N
|
|
SETBITS(RCC->PLLCKSELR, 0x3F << 4,
|
|
PLL1_M << 4); // Set PLL1_M (source defaults to HSI)
|
|
RCC->CR |= BIT(24); // Enable PLL1
|
|
while ((RCC->CR & BIT(25)) == 0) spin(1); // Wait until done
|
|
RCC->CFGR |= (3 << 0); // Set clock source to PLL1
|
|
while ((RCC->CFGR & (7 << 3)) != (3 << 3)) spin(1); // Wait until done
|
|
FLASH->ACR |= FLASH_LATENCY; // default is larger
|
|
#if 0
|
|
// Enable SRAM block if you want to use it for ETH buffer (needs proper attributes in driver code)
|
|
// RCC->AHB2ENR |= BIT(29) | BIT(30) | BIT(31);
|
|
#endif
|
|
|
|
RCC->APB4ENR |= RCC_APB4ENR_SYSCFGEN; // Enable SYSCFG
|
|
rng_init(); // Initialise random number generator
|
|
SysTick_Config(CPU_FREQUENCY / 1000); // Sys tick every 1ms
|
|
}
|