From 3d41e4739d182f7cda4a49917895e8ff6c9d97a3 Mon Sep 17 00:00:00 2001 From: 3djc Date: Tue, 22 Jun 2021 10:49:50 +0200 Subject: [PATCH] Fix pulse timing issue --- radio/src/pulses/pulses.cpp | 4 ++-- radio/src/pulses/pxx.h | 1 + 2 files changed, 3 insertions(+), 2 deletions(-) diff --git a/radio/src/pulses/pulses.cpp b/radio/src/pulses/pulses.cpp index 0ec02e49e..5c7fdc51e 100755 --- a/radio/src/pulses/pulses.cpp +++ b/radio/src/pulses/pulses.cpp @@ -487,7 +487,7 @@ static void enablePulsesInternalModule(uint8_t protocol) #if defined(INTMODULE_HEARTBEAT) // use backup trigger (1 ms later) init_intmodule_heartbeat(); - mixerSchedulerSetPeriod(INTERNAL_MODULE, PXX2_PERIOD + 1000/*us*/); + mixerSchedulerSetPeriod(INTERNAL_MODULE, PXX2_HEARTBEAT_PERIOD); #else mixerSchedulerSetPeriod(INTERNAL_MODULE, PXX2_PERIOD); #endif @@ -547,7 +547,7 @@ bool setupPulsesInternalModule(uint8_t protocol) else { #if defined(INTMODULE_HEARTBEAT) mixerSchedulerResetTimer(); - mixerSchedulerSetPeriod(INTERNAL_MODULE, PXX2_PERIOD + 2000 /* backup */); + mixerSchedulerSetPeriod(INTERNAL_MODULE, PXX2_HEARTBEAT_PERIOD); #else mixerSchedulerSetPeriod(INTERNAL_MODULE, PXX2_PERIOD); #endif diff --git a/radio/src/pulses/pxx.h b/radio/src/pulses/pxx.h index e852de180..8ea42b08e 100644 --- a/radio/src/pulses/pxx.h +++ b/radio/src/pulses/pxx.h @@ -30,6 +30,7 @@ #define PXX2_LOWSPEED_BAUDRATE 230400 #define PXX2_HIGHSPEED_BAUDRATE 450000 #define PXX2_PERIOD 4000/*us*/ +#define PXX2_HEARTBEAT_PERIOD 8000/*us 7ms frame rate + 1ms heartbeat backup*/ #define PXX2_TOOLS_PERIOD 1000/*us*/ #define PXX2_FRAME_MAXLENGTH 64