djsundog/circuitpython
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Override HAL_Delay and HAL_GetTick

Browse Source
This commit is contained in:
Lucian Copeland 2020-06-05 11:42:34 -04:00
parent a0977cac7b
commit ad0971fb25
5 changed files with 33 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
ports/stm/peripherals/stm32f4/stm32f401xe/clocks.h
View File

@ -37,7 +37,7 @@
#ifndef CPY_CLK_PLLN #ifndef CPY_CLK_PLLN
#define CPY_CLK_PLLN (336) #define CPY_CLK_PLLN (336)
#endif #endif
#ifndef (CPY_CLK_PLLP #ifndef CPY_CLK_PLLP
#define CPY_CLK_PLLP (RCC_PLLP_DIV4) #define CPY_CLK_PLLP (RCC_PLLP_DIV4)
#endif #endif
#ifndef CPY_CLK_PLLQ #ifndef CPY_CLK_PLLQ

32
ports/stm/supervisor/port.c
View File

@ -147,9 +147,10 @@ __attribute__((used, naked)) void Reset_Handler(void) {
__enable_irq(); __enable_irq();
main(); main();
} }
#endif //end H7 specific code #endif //end H7 specific code
// Low power clock variables
static volatile uint32_t systick_ms;
static RTC_HandleTypeDef _hrtc; static RTC_HandleTypeDef _hrtc;
#if BOARD_HAS_LOW_SPEED_CRYSTAL #if BOARD_HAS_LOW_SPEED_CRYSTAL
@ -159,7 +160,7 @@ static uint32_t rtc_clock_frequency = LSI_VALUE;
#endif #endif
safe_mode_t port_init(void) { safe_mode_t port_init(void) {
HAL_Init(); HAL_Init(); // Turns on SysTick
__HAL_RCC_SYSCFG_CLK_ENABLE(); __HAL_RCC_SYSCFG_CLK_ENABLE();
#if (CPY_STM32F4) #if (CPY_STM32F4)
@ -182,13 +183,38 @@ safe_mode_t port_init(void) {
HAL_RTC_Init(&_hrtc); HAL_RTC_Init(&_hrtc);
HAL_NVIC_EnableIRQ(RTC_Alarm_IRQn); HAL_NVIC_EnableIRQ(RTC_Alarm_IRQn);
// Turn off SysTick
SysTick->CTRL = 0;
return NO_SAFE_MODE; return NO_SAFE_MODE;
} }
void HAL_Delay(uint32_t delay_ms) {
if (SysTick->CTRL != 0) {
// SysTick is on, so use it
uint32_t tickstart = systick_ms;
while (systick_ms - tickstart < delay_ms) {
}
} else {
mp_hal_delay_ms(delay_ms);
}
}
uint32_t HAL_GetTick() {
if (SysTick->CTRL != 0) {
return systick_ms;
} else {
uint8_t subticks;
uint32_t result = (uint32_t)port_get_raw_ticks(&subticks);
return result;
}
}
void SysTick_Handler(void) { void SysTick_Handler(void) {
systick_ms += 1;
// Read the CTRL register to clear the SysTick interrupt. // Read the CTRL register to clear the SysTick interrupt.
SysTick->CTRL; SysTick->CTRL;
HAL_IncTick();
} }
void reset_port(void) { void reset_port(void) {