[Horus] Nothing on Heartbeat PIN
This commit is contained in:
@@ -152,50 +152,3 @@ extern "C" void TRAINER_TIMER_IRQHandler()
|
||||
trainerSendNextFrame();
|
||||
}
|
||||
}
|
||||
|
||||
extern "C" void HEARTBEAT_TIMER_IRQHandler()
|
||||
{
|
||||
uint16_t capture = 0;
|
||||
bool doCapture = false;
|
||||
|
||||
if ((HEARTBEAT_TIMER->DIER & TIM_DIER_CC2IE ) && (HEARTBEAT_TIMER->SR & TIM_SR_CC2IF)) {
|
||||
// capture mode on heartbeat pin (external module)
|
||||
capture = HEARTBEAT_TIMER->CCR2;
|
||||
if (currentTrainerMode == TRAINER_MODE_MASTER_CPPM_EXTERNAL_MODULE) {
|
||||
doCapture = true;
|
||||
}
|
||||
}
|
||||
|
||||
if (doCapture) {
|
||||
captureTrainerPulses(capture);
|
||||
}
|
||||
}
|
||||
|
||||
void init_cppm_on_heartbeat_capture(void)
|
||||
{
|
||||
EXTERNAL_MODULE_ON();
|
||||
|
||||
configure_pins(HEARTBEAT_GPIO_PIN, PIN_PERIPHERAL | PIN_PORTD | PIN_PER_2);
|
||||
|
||||
HEARTBEAT_TIMER->ARR = 0xFFFF;
|
||||
HEARTBEAT_TIMER->PSC = (PERI1_FREQUENCY * TIMER_MULT_APB1) / 2000000 - 1; // 0.5uS
|
||||
HEARTBEAT_TIMER->CR2 = 0;
|
||||
HEARTBEAT_TIMER->CCMR1 = TIM_CCMR1_IC2F_0 | TIM_CCMR1_IC2F_1 | TIM_CCMR1_CC2S_0;
|
||||
HEARTBEAT_TIMER->CCER = TIM_CCER_CC2E;
|
||||
HEARTBEAT_TIMER->SR &= ~TIM_SR_CC2IF; // Clear flag
|
||||
HEARTBEAT_TIMER->DIER |= TIM_DIER_CC2IE;
|
||||
HEARTBEAT_TIMER->CR1 = TIM_CR1_CEN;
|
||||
NVIC_SetPriority(HEARTBEAT_TIMER_IRQn, 7);
|
||||
NVIC_EnableIRQ(HEARTBEAT_TIMER_IRQn);
|
||||
}
|
||||
|
||||
void stop_cppm_on_heartbeat_capture(void)
|
||||
{
|
||||
HEARTBEAT_TIMER->DIER = 0;
|
||||
HEARTBEAT_TIMER->CR1 &= ~TIM_CR1_CEN; // Stop counter
|
||||
NVIC_DisableIRQ(HEARTBEAT_TIMER_IRQn); // Stop Interrupt
|
||||
|
||||
if (!IS_EXTERNAL_MODULE_PRESENT()) {
|
||||
EXTERNAL_MODULE_OFF();
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user