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

helper_functions: generalize unwrapping function

Browse Source
This commit is contained in:
Matthias Grob
2022-03-08 10:56:32 +01:00
parent c86c2db07f
commit c4bc062714
2 changed files with 23 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/matrix/test/unwrap.cpp
+4 -4
View File
@@ -19,7 +19,7 @@ TEST(Unwrap, UnwrapFloats)
float last_angle = wrapped_angles[0];
for (int i = 1; i < 6; i++) {
last_angle = unwrap(last_angle, wrapped_angles[i]);
last_angle = unwrap_pi(last_angle, wrapped_angles[i]);
EXPECT_FLOAT_EQ(last_angle, unwrapped_angles[i]);
}
@@ -27,7 +27,7 @@ TEST(Unwrap, UnwrapFloats)
last_angle = -wrapped_angles[0];
for (int i = 1; i < 6; i++) {
last_angle = unwrap(last_angle, -wrapped_angles[i]);
last_angle = unwrap_pi(last_angle, -wrapped_angles[i]);
EXPECT_FLOAT_EQ(last_angle, -unwrapped_angles[i]);
}
}
@@ -48,7 +48,7 @@ TEST(Unwrap, UnwrapDoubles)
double last_angle = wrapped_angles[0];
for (int i = 1; i < 6; i++) {
last_angle = unwrap(last_angle, wrapped_angles[i]);
last_angle = unwrap_pi(last_angle, wrapped_angles[i]);
EXPECT_DOUBLE_EQ(last_angle, unwrapped_angles[i]);
}
@@ -56,7 +56,7 @@ TEST(Unwrap, UnwrapDoubles)
last_angle = -wrapped_angles[0];
for (int i = 1; i < 6; i++) {
last_angle = unwrap(last_angle, -wrapped_angles[i]);
last_angle = unwrap_pi(last_angle, -wrapped_angles[i]);
EXPECT_DOUBLE_EQ(last_angle, -unwrapped_angles[i]);
}
}