diff --git a/src/main/mw.c b/src/main/mw.c index 3ba114b4a..afd3c1efa 100644 --- a/src/main/mw.c +++ b/src/main/mw.c @@ -219,7 +219,7 @@ void filterRc(void){ void scaleRcCommandToFpvCamAngle(void) { int16_t roll = rcCommand[ROLL]; int16_t yaw = rcCommand[YAW]; - rcCommand[ROLL] = constrain(cos(masterConfig.rxConfig.fpvCamAngleDegrees*RAD) * roll + sin(masterConfig.rxConfig.fpvCamAngleDegrees*RAD) * yaw, -500, 500); + rcCommand[ROLL] = constrain(cos(masterConfig.rxConfig.fpvCamAngleDegrees*RAD) * roll - sin(masterConfig.rxConfig.fpvCamAngleDegrees*RAD) * yaw, -500, 500); rcCommand[YAW] = constrain(cos(masterConfig.rxConfig.fpvCamAngleDegrees*RAD) * yaw + sin(masterConfig.rxConfig.fpvCamAngleDegrees*RAD) * roll, -500, 500); }