mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-03 18:38:54 +08:00
Add test for setting Quaternion to Identity (#104)
This commit is contained in:
@@ -265,6 +265,12 @@ int main()
|
|||||||
TEST(isEqual(q_non_canonical,q_canonical_ref));
|
TEST(isEqual(q_non_canonical,q_canonical_ref));
|
||||||
TEST(isEqual(q_canonical,q_canonical_ref));
|
TEST(isEqual(q_canonical,q_canonical_ref));
|
||||||
|
|
||||||
|
// quaternion setIdentity
|
||||||
|
Quatf q_nonIdentity(-0.7f, 0.4f, 0.5f, -0.3f);
|
||||||
|
Quatf q_identity(1.0f, 0.0f, 0.0f, 0.0f);
|
||||||
|
q_nonIdentity.setIdentity();
|
||||||
|
TEST(isEqual(q_nonIdentity, q_identity));
|
||||||
|
|
||||||
// non-unit quaternion invese
|
// non-unit quaternion invese
|
||||||
Quatf qI(1.0f, 0.0f, 0.0f, 0.0f);
|
Quatf qI(1.0f, 0.0f, 0.0f, 0.0f);
|
||||||
Quatf q_nonunit(0.1f, 0.2f, 0.3f, 0.4f);
|
Quatf q_nonunit(0.1f, 0.2f, 0.3f, 0.4f);
|
||||||
|
|||||||
Reference in New Issue
Block a user