diff --git a/Multiprotocol/Common.ino b/Multiprotocol/Common.ino index c72261d..b0e5204 100644 --- a/Multiprotocol/Common.ino +++ b/Multiprotocol/Common.ino @@ -14,11 +14,27 @@ */ #ifdef FAILSAFE_ENABLE +#if FAILSAFE_THROTTLE_LOW < -125 + #undef FAILSAFE_THROTTLE_LOW + #define FAILSAFE_THROTTLE_LOW -125 +#elif FAILSAFE_THROTTLE_LOW > 125 + #undef FAILSAFE_THROTTLE_LOW + #define FAILSAFE_THROTTLE_LOW 125 +#endif +#define FAILSAFE_THROTTLE_LOW_VAL (((FAILSAFE_THROTTLE_LOW+125)*1024)/125) +#if FAILSAFE_THROTTLE_LOW_VAL == 0 + #undef FAILSAFE_THROTTLE_LOW_VAL + #define FAILSAFE_THROTTLE_LOW_VAL 1 +#elif (FAILSAFE_THROTTLE_LOW_VAL) >= 2046 + #undef FAILSAFE_THROTTLE_LOW_VAL + #define FAILSAFE_THROTTLE_LOW_VAL 2046 +#endif +//#define FAILSAFE_THROTTLE_LOW_VAL FAILSAFE_THROTTLE_LOW void InitFailsafe() { for(uint8_t i=0;i