@@ -257,5 +257,3 @@ UART5: TELEMETRY_USART
|
|||||||
#define GT911_ROTATION_MODE 180
|
#define GT911_ROTATION_MODE 180
|
||||||
|
|
||||||
#define TOUCH_I2C_CLK_RATE 100000
|
#define TOUCH_I2C_CLK_RATE 100000
|
||||||
|
|
||||||
#define LSE_DRIVE_STRENGTH RCC_LSEDRIVE_HIGH
|
|
||||||
|
|||||||
@@ -22,6 +22,13 @@
|
|||||||
#include "stm32_hal.h"
|
#include "stm32_hal.h"
|
||||||
#include "rtc.h"
|
#include "rtc.h"
|
||||||
|
|
||||||
|
// LSEDRV resets to LOW, which is marginal for the crystals fitted on these
|
||||||
|
// boards. Override with -DLSE_DRIVE_STRENGTH if a board needs less.
|
||||||
|
#if !defined(LSE_DRIVE_STRENGTH) && \
|
||||||
|
(defined(STM32H7) || defined(STM32H7RS) || defined(STM32H5))
|
||||||
|
#define LSE_DRIVE_STRENGTH RCC_LSEDRIVE_HIGH
|
||||||
|
#endif
|
||||||
|
|
||||||
RTC_HandleTypeDef rtc = {};
|
RTC_HandleTypeDef rtc = {};
|
||||||
|
|
||||||
void rtcSetTime(const struct gtm * t)
|
void rtcSetTime(const struct gtm * t)
|
||||||
@@ -57,6 +64,36 @@ void rtcGetTime(struct gtm * t)
|
|||||||
t->tm_mday = RTC_DateStruct.Date;
|
t->tm_mday = RTC_DateStruct.Date;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#if defined(LSE_DRIVE_STRENGTH)
|
||||||
|
// LSEDRV can only be written while the LSE is stopped, and it is kept in the
|
||||||
|
// backup domain, so only stop the oscillator when the drive is not already set.
|
||||||
|
static void rtcSetLSEDriveStrength()
|
||||||
|
{
|
||||||
|
uint32_t drive = LSE_DRIVE_STRENGTH;
|
||||||
|
|
||||||
|
#if defined(RCC_VER_X)
|
||||||
|
// rev.Y and below encode the two MEDIUM levels inverted
|
||||||
|
if ((drive == RCC_LSEDRIVE_MEDIUMLOW || drive == RCC_LSEDRIVE_MEDIUMHIGH) &&
|
||||||
|
HAL_GetREVID() <= REV_ID_Y) {
|
||||||
|
drive = ~drive & RCC_BDCR_LSEDRV_Msk;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
if ((RCC->BDCR & RCC_BDCR_LSEDRV) == drive) return;
|
||||||
|
|
||||||
|
RCC_OscInitTypeDef RCC_OscInitStruct = {};
|
||||||
|
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_LSE;
|
||||||
|
#if !defined(STM32H7RS) && !defined(STM32H5)
|
||||||
|
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_NONE;
|
||||||
|
#endif
|
||||||
|
RCC_OscInitStruct.LSEState = RCC_LSE_OFF;
|
||||||
|
|
||||||
|
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK) return;
|
||||||
|
|
||||||
|
MODIFY_REG(RCC->BDCR, RCC_BDCR_LSEDRV, drive);
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
void rtcInit()
|
void rtcInit()
|
||||||
{
|
{
|
||||||
rtc.Instance = RTC;
|
rtc.Instance = RTC;
|
||||||
@@ -73,8 +110,7 @@ void rtcInit()
|
|||||||
|
|
||||||
HAL_PWR_EnableBkUpAccess();
|
HAL_PWR_EnableBkUpAccess();
|
||||||
#if defined(LSE_DRIVE_STRENGTH)
|
#if defined(LSE_DRIVE_STRENGTH)
|
||||||
__HAL_RCC_LSE_CONFIG(RCC_LSE_OFF);
|
rtcSetLSEDriveStrength();
|
||||||
__HAL_RCC_LSEDRIVE_CONFIG(LSE_DRIVE_STRENGTH);
|
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
// Enable LSE Oscillator
|
// Enable LSE Oscillator
|
||||||
@@ -90,10 +126,6 @@ void rtcInit()
|
|||||||
__HAL_RCC_RTC_CONFIG(RCC_RTCCLKSOURCE_LSE);
|
__HAL_RCC_RTC_CONFIG(RCC_RTCCLKSOURCE_LSE);
|
||||||
}
|
}
|
||||||
|
|
||||||
#if defined(STM32H7)
|
|
||||||
__HAL_RCC_LSEDRIVE_CONFIG(RCC_LSEDRIVE_HIGH);
|
|
||||||
#endif
|
|
||||||
|
|
||||||
__HAL_RCC_RTC_ENABLE();
|
__HAL_RCC_RTC_ENABLE();
|
||||||
HAL_RTC_WaitForSynchro(&rtc);
|
HAL_RTC_WaitForSynchro(&rtc);
|
||||||
|
|
||||||
|
|||||||
@@ -327,6 +327,4 @@ TIM17: ROTARY_ENCODER_TIMER
|
|||||||
#define EXTI2_IRQ_Priority 9
|
#define EXTI2_IRQ_Priority 9
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#define LSE_DRIVE_STRENGTH RCC_LSEDRIVE_HIGH
|
|
||||||
|
|
||||||
#endif // _HAL_H_
|
#endif // _HAL_H_
|
||||||
|
|||||||
@@ -298,6 +298,4 @@ TIM17: ROTARY_ENCODER_TIMER
|
|||||||
#define LANDSCAPE_LCD_STD true
|
#define LANDSCAPE_LCD_STD true
|
||||||
#define LANDSCAPE_LCD_LRG false
|
#define LANDSCAPE_LCD_LRG false
|
||||||
|
|
||||||
#define LSE_DRIVE_STRENGTH RCC_LSEDRIVE_HIGH
|
|
||||||
|
|
||||||
#endif // _HAL_H_
|
#endif // _HAL_H_
|
||||||
|
|||||||
@@ -252,6 +252,4 @@ USART6: EXTMODULE_USART
|
|||||||
#define EXTI15_10_IRQ_Priority 9
|
#define EXTI15_10_IRQ_Priority 9
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#define LSE_DRIVE_STRENGTH RCC_LSEDRIVE_HIGH
|
|
||||||
|
|
||||||
#endif // _HAL_H_
|
#endif // _HAL_H_
|
||||||
|
|||||||
@@ -263,6 +263,4 @@ TIM17: ROTARY_ENCODER_TIMER
|
|||||||
#define EXTI15_10_IRQ_Priority 9
|
#define EXTI15_10_IRQ_Priority 9
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#define LSE_DRIVE_STRENGTH RCC_LSEDRIVE_HIGH
|
|
||||||
|
|
||||||
#endif // _HAL_H_
|
#endif // _HAL_H_
|
||||||
@@ -349,6 +349,4 @@ SAI1_Block_A: PDM_CLOCK (1 MHz bit-clock output on SAI1_CK1 / PE5, !FLYSKY_GIMBA
|
|||||||
#define EXTI2_IRQ_Priority 9
|
#define EXTI2_IRQ_Priority 9
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#define LSE_DRIVE_STRENGTH RCC_LSEDRIVE_HIGH
|
|
||||||
|
|
||||||
#endif // _HAL_H_
|
#endif // _HAL_H_
|
||||||
|
|||||||
@@ -342,6 +342,4 @@ USART6: INTMODULE_USART
|
|||||||
#define EXTI2_IRQ_Priority 9
|
#define EXTI2_IRQ_Priority 9
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#define LSE_DRIVE_STRENGTH RCC_LSEDRIVE_HIGH
|
|
||||||
|
|
||||||
#endif // _HAL_H_
|
#endif // _HAL_H_
|
||||||
|
|||||||
@@ -267,6 +267,4 @@ USART6: EXTMODULE_USART
|
|||||||
#define TRAINER_GPIO_AF LL_GPIO_AF_2
|
#define TRAINER_GPIO_AF LL_GPIO_AF_2
|
||||||
#define TRAINER_TIMER_FREQ (PERI2_FREQUENCY * TIMER_MULT_APB2)
|
#define TRAINER_TIMER_FREQ (PERI2_FREQUENCY * TIMER_MULT_APB2)
|
||||||
|
|
||||||
#define LSE_DRIVE_STRENGTH RCC_LSEDRIVE_HIGH
|
|
||||||
|
|
||||||
#endif // _HAL_H_
|
#endif // _HAL_H_
|
||||||
|
|||||||
Reference in New Issue
Block a user