RoboidControl-cpp/test/Vector3_test.cc
2022-01-24 13:11:32 +01:00

164 lines
3.7 KiB
C++

#include <gtest/gtest.h>
#include <limits>
#include "Vector3.h"
#define MY_INFINITY std::numeric_limits<float>::infinity()
TEST(Vector3, Magnitude) {
Vector3 v = Vector3(1, 2, 3);
float m = 0;
m = v.magnitude();
EXPECT_FLOAT_EQ(m, 3.74165738677F) << "v.magnitude 1 2 3";
m = Vector3::Magnitude(v);
EXPECT_FLOAT_EQ(m, 3.74165738677F) << "Vector3::Magnitude 1 2 3";
v = Vector3(-1, -2, -3);
m = v.magnitude();
EXPECT_FLOAT_EQ(m, 3.74165738677F) << "v.magnitude -1 -2 -3";
v = Vector3(0, 0, 0);
m = v.magnitude();
EXPECT_FLOAT_EQ(m, 0) << "v.magnitude 0 0 0 ";
v = Vector3(MY_INFINITY, MY_INFINITY, MY_INFINITY);
m = v.magnitude();
EXPECT_FLOAT_EQ(m, MY_INFINITY) << "v.magnitude INFINITY INFINITY INFINITY ";
}
TEST(Vector3, SqrMagnitude) {
Vector3 v = Vector3(1, 2, 3);
float m = 0;
m = v.sqrMagnitude();
EXPECT_FLOAT_EQ(m, 14) << "v.sqrMagnitude 1 2 3";
m = Vector3::SqrMagnitude(v);
EXPECT_FLOAT_EQ(m, 14) << "Vector3::SqrMagnitude 1 2 3";
v = Vector3(-1, -2, -3);
m = v.sqrMagnitude();
EXPECT_FLOAT_EQ(m, 14) << "v.sqrMagnitude -1 -2 -3";
v = Vector3(0, 0, 0);
m = v.sqrMagnitude();
EXPECT_FLOAT_EQ(m, 0) << "v.sqrMagnitude 0 0 0 ";
}
TEST(Vector3, Normalize) {
bool r = false;
Vector3 v = Vector3(0, 2, 0);
Vector3 normalized_v = Vector3::zero;
normalized_v = v.normalized();
EXPECT_TRUE(normalized_v == Vector3(0, 1, 0)) << "v.normalized 0 2 0";
normalized_v = Vector3::Normalize(v);
EXPECT_TRUE(normalized_v == Vector3(0, 1, 0)) << "Vector3::Normalize 0 2 0";
v = Vector3(0, -2, 0);
normalized_v = v.normalized();
EXPECT_TRUE(normalized_v == Vector3(0, -1, 0)) << "v.normalized 0 -2 0";
}
TEST(Vector3, Negate) {
bool r = false;
Vector3 v1 = Vector3(4, 5, 6);
Vector3 v = Vector3::zero;
v = -v1;
EXPECT_TRUE(v == Vector3(-4, -5, -6)) << "- 4 5 6";
v1 = Vector3(0, 0, 0);
v = -v1;
EXPECT_TRUE(v == Vector3(0, 0, 0)) << "- 0 0 0 ";
}
TEST(Vector3, Subtract) {
bool r = false;
Vector3 v1 = Vector3(4, 5, 6);
Vector3 v2 = Vector3(1, 2, 3);
Vector3 v = Vector3::zero;
v = v1 - v2;
EXPECT_TRUE(v == Vector3(3, 3, 3)) << "4 5 6 - 1 2 3";
v2 = Vector3(-1, -2, -3);
v = v1 - v2;
EXPECT_TRUE(v == Vector3(5, 7, 9)) << "4 5 6 - -1 -2 -3";
v2 = Vector3(4, 5, 6);
v = v1 - v2;
EXPECT_TRUE(v == Vector3(0, 0, 0)) << "4 5 6 - 4 5 6";
}
TEST(Vector3, Addition) {
bool r = false;
Vector3 v1 = Vector3(4, 5, 6);
Vector3 v2 = Vector3(1, 2, 3);
Vector3 v = Vector3::zero;
v = v1 + v2;
EXPECT_TRUE(v == Vector3(5, 7, 9)) << "4 5 6 + 1 2 3";
v2 = Vector3(-1, -2, -3);
v = v1 + v2;
EXPECT_TRUE(v == Vector3(3, 3, 3)) << "4 5 6 + -1 -2 -3";
v2 = Vector3(4, 5, 6);
v = v1 + v2;
EXPECT_TRUE(v == Vector3(8, 10, 12)) << "4 5 6 + 4 5 6";
}
TEST(Vector3, Scale) {
bool r = false;
Vector3 v1 = Vector3(4, 5, 6);
Vector3 v2 = Vector3(1, 2, 3);
Vector3 v = Vector3::zero;
v = Vector3::Scale(v1, v2);
EXPECT_TRUE(v == Vector3(4, 10, 18)) << "Scale 4 5 6 , 1 2 3";
v2 = Vector3(-1, -2, -3);
v = Vector3::Scale(v1, v2);
EXPECT_TRUE(v == Vector3(-4, -10, -18)) << "Scale 4 5 6 , -1 -2 -3";
v2 = Vector3(4, 5, 6);
v = Vector3::Scale(v1, v2);
EXPECT_TRUE(v == Vector3(16, 25, 36)) << "Scale 4 5 6 , 4 5 6";
}
TEST(Vector3, Multiply) {
bool r = false;
Vector3 v1 = Vector3(4, 5, 6);
float f = 3;
Vector3 v = Vector3::zero;
v = v1 * f;
EXPECT_TRUE(v == Vector3(12, 15, 18)) << "4 5 6 * 3";
f = -3;
v = v1 * f;
EXPECT_TRUE(v == Vector3(-12, -15, -18)) << "4 5 6 * -3";
f = 0;
v = v1 * f;
EXPECT_TRUE(v == Vector3(0, 0, 0)) << "4 5 6 * 0";
f = MY_INFINITY;
v = v1 * f;
EXPECT_TRUE(v == Vector3(MY_INFINITY, MY_INFINITY, MY_INFINITY)) << "4 5 6 * INFINITY";
f = -MY_INFINITY;
v = v1 * f;
EXPECT_TRUE(v == Vector3(-MY_INFINITY, -MY_INFINITY, -MY_INFINITY)) << "4 5 6 * -INFINITY";
}