fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-21 07:33:33 +08:00
Code Issues Packages Projects Releases Wiki Activity

Fixed euler wrapping.

Browse Source
This commit is contained in:
James Goppert
2016-01-25 13:40:51 -05:00
parent a92d5c1338
commit 1778ac199c
2 changed files with 2 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files
test/attitude.cpp
+2 -2
View File
@@ -104,8 +104,8 @@ int main()
roll_expected = 0;
yaw_expected = yaw + roll;
}
if (yaw_expected < 0) yaw_expected += 360;
if (yaw_expected > 360) yaw_expected -= 360;
if (yaw_expected < -180) yaw_expected += 360;
if (yaw_expected > 180) yaw_expected -= 360;
printf("roll:%d pitch:%d yaw:%d\n", roll, pitch, yaw);
Euler<double> euler_expected(