diff --git a/Multiprotocol/Common.ino b/Multiprotocol/Common.ino index b0e5204..1c2be25 100644 --- a/Multiprotocol/Common.ino +++ b/Multiprotocol/Common.ino @@ -14,27 +14,20 @@ */ #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 +//Convert from percentage to failsafe value #define FAILSAFE_THROTTLE_LOW_VAL (((FAILSAFE_THROTTLE_LOW+125)*1024)/125) -#if FAILSAFE_THROTTLE_LOW_VAL == 0 +#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