aboutsummaryrefslogtreecommitdiff
path: root/apps/mathlib/math/EulerAngles.cpp
diff options
context:
space:
mode:
Diffstat (limited to 'apps/mathlib/math/EulerAngles.cpp')
-rw-r--r--apps/mathlib/math/EulerAngles.cpp26
1 files changed, 15 insertions, 11 deletions
diff --git a/apps/mathlib/math/EulerAngles.cpp b/apps/mathlib/math/EulerAngles.cpp
index 8991d5623..27ebbf8b3 100644
--- a/apps/mathlib/math/EulerAngles.cpp
+++ b/apps/mathlib/math/EulerAngles.cpp
@@ -97,23 +97,27 @@ EulerAngles::~EulerAngles()
int __EXPORT eulerAnglesTest()
{
printf("Test EulerAngles\t: ");
- EulerAngles euler(1, 2, 3);
+ EulerAngles euler(0.1, 0.2, 0.3);
// test ctor
- ASSERT(vectorEqual(Vector3(1, 2, 3), euler));
- ASSERT(equal(euler.getPhi(), 1));
- ASSERT(equal(euler.getTheta(), 2));
- ASSERT(equal(euler.getPsi(), 3));
+ ASSERT(vectorEqual(Vector3(0.1, 0.2, 0.3), euler));
+ ASSERT(equal(euler.getPhi(), 0.1));
+ ASSERT(equal(euler.getTheta(), 0.2));
+ ASSERT(equal(euler.getPsi(), 0.3));
// test dcm ctor
+ euler = Dcm(EulerAngles(0.1,0.2,0.3));
+ ASSERT(vectorEqual(Vector3(0.1,0.2,0.3),euler));
+
+ // test quat ctor
+ euler = Quaternion(EulerAngles(0.1,0.2,0.3));
+ ASSERT(vectorEqual(Vector3(0.1,0.2,0.3),euler));
// test assignment
- euler.setPhi(4);
- ASSERT(equal(euler.getPhi(), 4));
- euler.setTheta(5);
- ASSERT(equal(euler.getTheta(), 5));
- euler.setPsi(6);
- ASSERT(equal(euler.getPsi(), 6));
+ euler.setPhi(0.4);
+ euler.setTheta(0.5);
+ euler.setPsi(0.6);
+ ASSERT(vectorEqual(Vector3(0.4,0.5,0.6),euler));
printf("PASS\n");
return 0;