Fix FPV angle mix

This commit is contained in:
borisbstyle 2017-01-17 00:03:35 +01:00
parent b314c36b81
commit 704b12f297
1 changed files with 4 additions and 4 deletions

View File

@ -217,6 +217,10 @@ void processRcCommand(void)
if (isRXDataNew) {
currentRxRefreshRate = constrain(getTaskDeltaTime(TASK_RX),1000,20000);
checkForThrottleErrorResetState(currentRxRefreshRate);
// Scaling of AngleRate to camera angle (Mixing Roll and Yaw)
if (rxConfig()->fpvCamAngleDegrees && IS_RC_MODE_ACTIVE(BOXFPVANGLEMIX) && !FLIGHT_MODE(HEADFREE_MODE))
scaleRcCommandToFpvCamAngle();
}
if (rxConfig()->rcInterpolation || flightModeFlags) {
@ -270,10 +274,6 @@ void processRcCommand(void)
if (isRXDataNew)
readyToCalculateRateAxisCnt = FD_YAW;
// Scaling of AngleRate to camera angle (Mixing Roll and Yaw)
if (rxConfig()->fpvCamAngleDegrees && IS_RC_MODE_ACTIVE(BOXFPVANGLEMIX) && !FLIGHT_MODE(HEADFREE_MODE))
scaleRcCommandToFpvCamAngle();
for (int axis = 0; axis <= readyToCalculateRateAxisCnt; axis++)
calculateSetpointRate(axis, rcCommand[axis]);