mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-05-15 04:17:34 +08:00
Formatting.
This commit is contained in:
+4
-3
@@ -21,7 +21,8 @@ int main()
|
||||
float dcm_data[] = {
|
||||
0.93629336, -0.27509585, 0.21835066,
|
||||
0.28962948, 0.95642509, -0.03695701,
|
||||
-0.19866933, 0.0978434 , 0.97517033};
|
||||
-0.19866933, 0.0978434 , 0.97517033
|
||||
};
|
||||
Dcmf dcm_check(dcm_data);
|
||||
|
||||
// euler ctor
|
||||
@@ -39,8 +40,8 @@ int main()
|
||||
q.normalize();
|
||||
q.T().print();
|
||||
assert((q - Quatf(
|
||||
0.18257419, 0.36514837, 0.54772256, 0.73029674)
|
||||
).norm() < eps);
|
||||
0.18257419, 0.36514837, 0.54772256, 0.73029674)
|
||||
).norm() < eps);
|
||||
|
||||
// euler to quaternion
|
||||
q = Quatf(euler_check);
|
||||
|
||||
Reference in New Issue
Block a user