Обновление данных лидара поставлено на таймер 7
This commit is contained in:
@@ -32,6 +32,8 @@ typedef struct
|
||||
} lidar_data;
|
||||
|
||||
void lidar_init();
|
||||
void lidar_tim7_init();
|
||||
void TIM7_DAC_IRQHandler();
|
||||
void USART3_IRQHandler();
|
||||
void lidar_update(lidar_data* lidar);
|
||||
|
||||
|
||||
@@ -3,6 +3,7 @@
|
||||
volatile uint8_t usart3_index = 0;
|
||||
volatile uint8_t usart3_checksum = 0;
|
||||
volatile uint8_t usart3_frame_ready = 0;
|
||||
volatile uint8_t lidar_update_flag = 0;
|
||||
static lidar_data_buf buffer;
|
||||
static uint8_t* buff_data = (uint8_t*)&buffer;
|
||||
|
||||
@@ -59,6 +60,28 @@ void lidar_init()
|
||||
NVIC_EnableIRQ(USART3_IRQn);
|
||||
}
|
||||
|
||||
void lidar_tim7_init()
|
||||
{
|
||||
RCC->APB1ENR1 |= RCC_APB1ENR1_TIM7EN;
|
||||
|
||||
TIM7->PSC = 16000 - 1; // 16 MHz / 16000 = 1000 Hz (1 ms)
|
||||
TIM7->ARR = 10 - 1; // 10 ms
|
||||
|
||||
TIM7->DIER |= TIM_DIER_UIE; // interrupt enable
|
||||
TIM7->CR1 |= TIM_CR1_CEN; // counter enable
|
||||
|
||||
NVIC_EnableIRQ(TIM7_DAC_IRQn);
|
||||
}
|
||||
|
||||
void TIM7_DAC_IRQHandler()
|
||||
{
|
||||
if (TIM7->SR & TIM_SR_UIF)
|
||||
{
|
||||
TIM7->SR &= ~TIM_SR_UIF;
|
||||
lidar_update_flag = 1;
|
||||
}
|
||||
}
|
||||
|
||||
void USART3_IRQHandler()
|
||||
{
|
||||
if (USART3->ISR & USART_ISR_RXNE)
|
||||
@@ -83,6 +106,9 @@ void USART3_IRQHandler()
|
||||
|
||||
void lidar_update(lidar_data* lidar)
|
||||
{
|
||||
if (!lidar_update_flag)
|
||||
return;
|
||||
|
||||
if (!usart3_frame_ready)
|
||||
return;
|
||||
|
||||
|
||||
@@ -39,6 +39,7 @@ int main(void)
|
||||
motors_init();*/
|
||||
|
||||
lidar_init();
|
||||
lidar_tim7_init();
|
||||
|
||||
while (1)
|
||||
{
|
||||
|
||||
Reference in New Issue
Block a user