diff --git a/src/main/flight/mixer.c b/src/main/flight/mixer.c index abf8e27832..100aeb62f8 100755 --- a/src/main/flight/mixer.c +++ b/src/main/flight/mixer.c @@ -633,7 +633,7 @@ void writeServos(void) } #endif -void writeMotors(uint8_t unsyncedPwm) +void writeMotors(uint8_t fastPwmProtocol, uint8_t unsyncedPwm) { uint8_t i; @@ -641,7 +641,7 @@ void writeMotors(uint8_t unsyncedPwm) pwmWriteMotor(i, motor[i]); - if (feature(FEATURE_ONESHOT125) && !unsyncedPwm) { + if (fastPwmProtocol && !unsyncedPwm) { pwmCompleteOneshotMotorUpdate(motorCount); } } @@ -653,7 +653,7 @@ void writeAllMotors(int16_t mc) // Sends commands to all motors for (i = 0; i < motorCount; i++) motor[i] = mc; - writeMotors(1); + writeMotors(1,1); } void stopMotors(void) diff --git a/src/main/flight/mixer.h b/src/main/flight/mixer.h index 8ebd0fd22a..8ccd45cb37 100644 --- a/src/main/flight/mixer.h +++ b/src/main/flight/mixer.h @@ -213,6 +213,6 @@ int servoDirection(int servoIndex, int fromChannel); #endif void mixerResetDisarmedMotors(void); void mixTable(void); -void writeMotors(uint8_t unsyncedPwm); +void writeMotors(uint8_t fastPwmProtocol, uint8_t unsyncedPwm); void stopMotors(void); void StopPwmAllMotors(void); diff --git a/src/main/mw.c b/src/main/mw.c index cc515485b4..f5865a27b4 100644 --- a/src/main/mw.c +++ b/src/main/mw.c @@ -742,7 +742,7 @@ void subTaskMotorUpdate(void) #endif if (motorControlEnable) { - writeMotors(masterConfig.use_unsyncedPwm); + writeMotors(masterConfig.fast_pwm_protocol, masterConfig.use_unsyncedPwm); } if (debugMode == DEBUG_PIDLOOP) {debug[3] = micros() - startTime;} }