From 853bb4c168d63d018bc4e0a6127c6315f12b536e Mon Sep 17 00:00:00 2001 From: KiteAnton Date: Fri, 15 Jan 2016 17:10:41 +0100 Subject: [PATCH] Fixed degree to radian conversion --- src/main/mw.c | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/src/main/mw.c b/src/main/mw.c index cb0431255..db4f0b592 100644 --- a/src/main/mw.c +++ b/src/main/mw.c @@ -210,8 +210,8 @@ void filterRc(void){ void scaleRcCommandToFpvCamAngle(void) { int16_t roll = rcCommand[ROLL]; int16_t yaw = rcCommand[YAW]; - rcCommand[ROLL] = constrain(cos(masterConfig.rxConfig.fpvCamAngleDegrees) * roll + sin(masterConfig.rxConfig.fpvCamAngleDegrees) * yaw, -500, 500); - rcCommand[YAW] = constrain(cos(masterConfig.rxConfig.fpvCamAngleDegrees) * yaw + sin(masterConfig.rxConfig.fpvCamAngleDegrees) * roll, -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); } void annexCode(void)