mirror of
https://gitee.com/xiaohuolufeihua/bizhang_-obav.git
synced 2026-05-22 09:28:58 +00:00
Working on comments.
This commit is contained in:
@@ -97,27 +97,27 @@ EulerAngles::~EulerAngles()
|
||||
int __EXPORT eulerAnglesTest()
|
||||
{
|
||||
printf("Test EulerAngles\t: ");
|
||||
EulerAngles euler(0.1, 0.2, 0.3);
|
||||
EulerAngles euler(0.1f, 0.2f, 0.3f);
|
||||
|
||||
// test ctor
|
||||
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));
|
||||
ASSERT(vectorEqual(Vector3(0.1f, 0.2f, 0.3f), euler));
|
||||
ASSERT(equal(euler.getPhi(), 0.1f));
|
||||
ASSERT(equal(euler.getTheta(), 0.2f));
|
||||
ASSERT(equal(euler.getPsi(), 0.3f));
|
||||
|
||||
// test dcm ctor
|
||||
euler = Dcm(EulerAngles(0.1,0.2,0.3));
|
||||
ASSERT(vectorEqual(Vector3(0.1,0.2,0.3),euler));
|
||||
euler = Dcm(EulerAngles(0.1f, 0.2f, 0.3f));
|
||||
ASSERT(vectorEqual(Vector3(0.1f, 0.2f, 0.3f),euler));
|
||||
|
||||
// test quat ctor
|
||||
euler = Quaternion(EulerAngles(0.1,0.2,0.3));
|
||||
ASSERT(vectorEqual(Vector3(0.1,0.2,0.3),euler));
|
||||
euler = Quaternion(EulerAngles(0.1f, 0.2f, 0.3f));
|
||||
ASSERT(vectorEqual(Vector3(0.1f, 0.2f, 0.3f),euler));
|
||||
|
||||
// test assignment
|
||||
euler.setPhi(0.4);
|
||||
euler.setTheta(0.5);
|
||||
euler.setPsi(0.6);
|
||||
ASSERT(vectorEqual(Vector3(0.4,0.5,0.6),euler));
|
||||
euler.setPhi(0.4f);
|
||||
euler.setTheta(0.5f);
|
||||
euler.setPsi(0.6f);
|
||||
ASSERT(vectorEqual(Vector3(0.4f, 0.5f, 0.6f),euler));
|
||||
|
||||
printf("PASS\n");
|
||||
return 0;
|
||||
|
||||
Reference in New Issue
Block a user