fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-13 08:47:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

Quaternion add copyTo

Browse Source
This commit is contained in:
Daniel Agar
2017-02-24 11:08:39 -05:00
parent e2211c5867
commit 68c7cc5bfd
3 changed files with 55 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
test/attitude.cpp
+11
View File
@@ -343,6 +343,17 @@ int main()
q = Quatf(0,0,0,1); // 180 degree rotation around the z axis
R = Dcmf(q);
TEST(isEqual(q, Quatf(R)));
// Quaternion copyTo
q = Quatf(1, 2, 3, 4);
float dst[4] = {};
q.copyTo(dst);
TEST(fabsf(q(0) - dst[0]) < eps);
TEST(fabsf(q(1) - dst[1]) < eps);
TEST(fabsf(q(2) - dst[2]) < eps);
TEST(fabsf(q(3) - dst[3]) < eps);
}
/* vim: set et fenc=utf-8 ff=unix sts=0 sw=4 ts=4 : */