RoboidControl-cpp/test/Quaternion_test.cc
2022-01-27 13:59:15 +01:00

23 lines
458 B
C++

#include <gtest/gtest.h>
#include <math.h>
#include <limits>
#include "Quaternion.h"
#define FLOAT_INFINITY std::numeric_limits<float>::infinity()
TEST(Quaternion, Normalze) {
bool r = false;
Quaternion q1 = Quaternion(0, 0, 0, 1);
Quaternion q = Quaternion::identity;
q = q1;
q.Normalize();
r = q == q1;
EXPECT_TRUE(r) << "q.Normalzed 0 0 0 1";
q = Quaternion::Normalize(q1);
r = q == q1;
EXPECT_TRUE(r) << "Quaternion::Normalize 0 0 0 1";
}