mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-17 09:53:33 +08:00
Added axis angle accessors, removed == operator.
This commit is contained in:
+2
-1
@@ -276,7 +276,8 @@ int main()
|
||||
|
||||
AxisAnglef aa_axis_angle_init(Vector3f(1.0f, 2.0f, 3.0f), 3.0f);
|
||||
TEST(isEqual(aa_axis_angle_init, Vector3f(0.80178373f, 1.60356745f, 2.40535118f)));
|
||||
|
||||
TEST(isEqual(aa_axis_angle_init.axis(), Vector3f(0.26726124f, 0.53452248f, 0.80178373f)));
|
||||
TEST(isEqual(aa_axis_angle_init.angle(), 3.0f));
|
||||
TEST(isEqual(Quatf((AxisAnglef(Vector3f(0.0f, 0.0f, 1.0f), 0.0f))),
|
||||
Quatf(1.0f, 0.0f, 0.0f, 0.0f)));
|
||||
};
|
||||
|
||||
@@ -30,7 +30,7 @@ int main()
|
||||
Matrix3f m3(data_times_2);
|
||||
|
||||
TEST(isEqual(m, m2));
|
||||
TEST(!(m == m3));
|
||||
TEST(!(isEqual(m, m3)));
|
||||
|
||||
m2 *= 2;
|
||||
TEST(isEqual(m2, m3));
|
||||
|
||||
+2
-2
@@ -17,10 +17,10 @@ int main()
|
||||
TEST(fabs(v1.dot(v2) - 130.0f) < 1e-5);
|
||||
v2.normalize();
|
||||
Vector<float, 5> v3(v2);
|
||||
TEST(v2 == v3);
|
||||
TEST(isEqual(v2, v3));
|
||||
float data1_sq[] = {1,4,9,16,25};
|
||||
Vector<float, 5> v4(data1_sq);
|
||||
TEST(v1 == v4.pow(0.5));
|
||||
TEST(isEqual(v1, v4.pow(0.5)));
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
+4
-4
@@ -12,15 +12,15 @@ int main()
|
||||
Vector3f a(1, 0, 0);
|
||||
Vector3f b(0, 1, 0);
|
||||
Vector3f c = a.cross(b);
|
||||
TEST (c == Vector3f(0,0,1));
|
||||
TEST(isEqual(c, Vector3f(0,0,1)));
|
||||
c = a % b;
|
||||
TEST (c == Vector3f(0,0,1));
|
||||
TEST (isEqual(c, Vector3f(0,0,1)));
|
||||
Matrix<float, 3, 1> d(c);
|
||||
Vector3f e(d);
|
||||
TEST (e == d);
|
||||
TEST (isEqual(e, d));
|
||||
float data[] = {4, 5, 6};
|
||||
Vector3f f(data);
|
||||
TEST (f == Vector3f(4, 5, 6));
|
||||
TEST(isEqual(f, Vector3f(4, 5, 6)));
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user