mirror of
https://github.com/betaflight/betaflight.git
synced 2025-07-18 22:05:17 +03:00
Timer code simplification in preparation of led strip being assignable.
Moved some repeated code into timer.c - preparation for allowing resource command for led strip
This commit is contained in:
parent
d5e20232be
commit
fe3ac4754e
14 changed files with 103 additions and 136 deletions
|
@ -22,6 +22,7 @@
|
|||
|
||||
#include "io.h"
|
||||
#include "timer.h"
|
||||
#include "timer_stm32f4xx.h"
|
||||
#include "pwm_output.h"
|
||||
#include "nvic.h"
|
||||
#include "dma.h"
|
||||
|
@ -139,38 +140,9 @@ void pwmDigitalMotorHardwareConfig(const timerHardware_t *timerHardware, uint8_t
|
|||
TIM_OCInitStructure.TIM_OutputNState = TIM_OutputNState_Disable;
|
||||
TIM_OCInitStructure.TIM_Pulse = 0;
|
||||
|
||||
uint32_t timerChannelAddress = 0;
|
||||
uint32_t dmaItFlag = 0;
|
||||
switch (timerHardware->channel) {
|
||||
case TIM_Channel_1:
|
||||
TIM_OC1Init(timer, &TIM_OCInitStructure);
|
||||
motor->timerDmaSource = TIM_DMA_CC1;
|
||||
timerChannelAddress = (uint32_t)(&timer->CCR1);
|
||||
TIM_OC1PreloadConfig(timer, TIM_OCPreload_Enable);
|
||||
dmaItFlag = DMA_IT_TCIF1;
|
||||
break;
|
||||
case TIM_Channel_2:
|
||||
TIM_OC2Init(timer, &TIM_OCInitStructure);
|
||||
motor->timerDmaSource = TIM_DMA_CC2;
|
||||
timerChannelAddress = (uint32_t)(&timer->CCR2);
|
||||
TIM_OC2PreloadConfig(timer, TIM_OCPreload_Enable);
|
||||
dmaItFlag = DMA_IT_TCIF2;
|
||||
break;
|
||||
case TIM_Channel_3:
|
||||
TIM_OC3Init(timer, &TIM_OCInitStructure);
|
||||
motor->timerDmaSource = TIM_DMA_CC3;
|
||||
timerChannelAddress = (uint32_t)(&timer->CCR3);
|
||||
TIM_OC3PreloadConfig(timer, TIM_OCPreload_Enable);
|
||||
dmaItFlag = DMA_IT_TCIF3;
|
||||
break;
|
||||
case TIM_Channel_4:
|
||||
TIM_OC4Init(timer, &TIM_OCInitStructure);
|
||||
motor->timerDmaSource = TIM_DMA_CC4;
|
||||
timerChannelAddress = (uint32_t)(&timer->CCR4);
|
||||
TIM_OC4PreloadConfig(timer, TIM_OCPreload_Enable);
|
||||
dmaItFlag = DMA_IT_TCIF4;
|
||||
break;
|
||||
}
|
||||
timerOCInit(timer, timerHardware->channel, &TIM_OCInitStructure);
|
||||
timerOCPreloadConfig(timer, timerHardware->channel, TIM_OCPreload_Enable);
|
||||
motor->timerDmaSource = timerDmaSource(timerHardware->channel);
|
||||
dmaMotorTimers[timerIndex].timerDmaSources |= motor->timerDmaSource;
|
||||
|
||||
TIM_CCxCmd(timer, motor->timerHardware->channel, TIM_CCx_Enable);
|
||||
|
@ -187,7 +159,7 @@ void pwmDigitalMotorHardwareConfig(const timerHardware_t *timerHardware, uint8_t
|
|||
DMA_DeInit(stream);
|
||||
DMA_StructInit(&DMA_InitStructure);
|
||||
DMA_InitStructure.DMA_Channel = timerHardware->dmaChannel;
|
||||
DMA_InitStructure.DMA_PeripheralBaseAddr = timerChannelAddress;
|
||||
DMA_InitStructure.DMA_PeripheralBaseAddr = (uint32_t)timerChCCR(timerHardware);
|
||||
DMA_InitStructure.DMA_Memory0BaseAddr = (uint32_t)motor->dmaBuffer;
|
||||
DMA_InitStructure.DMA_DIR = DMA_DIR_MemoryToPeripheral;
|
||||
DMA_InitStructure.DMA_BufferSize = MOTOR_DMA_BUFFER_SIZE;
|
||||
|
@ -205,7 +177,7 @@ void pwmDigitalMotorHardwareConfig(const timerHardware_t *timerHardware, uint8_t
|
|||
DMA_Init(stream, &DMA_InitStructure);
|
||||
|
||||
DMA_ITConfig(stream, DMA_IT_TC, ENABLE);
|
||||
DMA_ClearITPendingBit(stream, dmaItFlag);
|
||||
DMA_ClearITPendingBit(stream, dmaFlag_IT_TCIF(timerHardware->dmaStream));
|
||||
|
||||
dmaSetHandler(timerHardware->dmaIrqHandler, motor_DMA_IRQHandler, NVIC_BUILD_PRIORITY(1, 2), motorIndex);
|
||||
}
|
||||
|
|
Loading…
Add table
Add a link
Reference in a new issue