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

Handle some divide by zero edge cases on init.

Browse Source
This commit is contained in:
James Goppert
2016-11-30 01:27:48 -05:00
parent 945edbc58c
commit 74a120f554
3 changed files with 28 additions and 14 deletions
Download Patch File Download Diff File Expand all files Collapse all files
test/attitude.cpp
+4
View File
@@ -283,6 +283,10 @@ int main()
AxisAnglef aa_data_init(aa_data);
TEST(isEqual(aa_data_init, AxisAnglef(4.0f, 5.0f, 6.0f)));
AxisAnglef aa_norm_check(Vector3f(0.0f, 0.0f, 0.0f));
TEST(isEqual(aa_norm_check.axis(), Vector3f(1, 0, 0)));
TEST(isEqualF(aa_norm_check.angle(), 0.0f));
q = Quatf(-0.29555112749297824f, 0.25532186f, 0.51064372f, 0.76596558f);
TEST(isEqual(q.imag(), Vector3f(0.25532186f, 0.51064372f, 0.76596558f)));