428 lines
12 KiB
C++
428 lines
12 KiB
C++
#include "gtest/gtest.h"
|
|
#include "pimathvector.h"
|
|
#include "pimathmatrix.h"
|
|
|
|
const uint size = 3u;
|
|
|
|
bool cmpVectorWithValue(PIMathVectorT<size, double> vector, double val, int num) {
|
|
bool b = true;
|
|
for(int i = 0; i < num; i++) {
|
|
if(vector[i] != val) {
|
|
b = false;
|
|
}
|
|
}
|
|
return b;
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, size) {
|
|
PIMathVectorT<size, double> vector;
|
|
ASSERT_TRUE(vector.size() == 3u);
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, fill) {
|
|
PIMathVectorT<size, double> vector;
|
|
ASSERT_TRUE(cmpVectorWithValue(vector.fill(5.0), 5.0, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, set) {
|
|
PIMathVectorT<size, double> vector;
|
|
PIMathVectorT<size, double> vector1;
|
|
PIMathVectorT<size, double> vector2;
|
|
ASSERT_TRUE(cmpVectorWithValue(vector.set(vector1.fill(5.0), vector2.fill(3.0)), -2.0, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, MoveVal) {
|
|
PIMathVectorT<size, double> vector;
|
|
ASSERT_TRUE(cmpVectorWithValue(vector.move(4.0), 4.0, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, MoveVector) {
|
|
PIMathVectorT<size, double> vector;
|
|
PIMathVectorT<size, double> vector1;
|
|
ASSERT_TRUE(cmpVectorWithValue(vector.move(vector1.fill(5.0)), 5.0, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, lengthSqr) {
|
|
PIMathVectorT<size, double> vector;
|
|
vector.fill(1.0);
|
|
ASSERT_EQ(3.0, vector.lengthSqr());
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, length) {
|
|
PIMathVectorT<size, double> vector;
|
|
vector.fill(1.0);
|
|
ASSERT_DOUBLE_EQ(sqrt(3.0), vector.length());
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, manhattanLength) {
|
|
PIMathVectorT<size, double> vector;
|
|
vector.fill(5.0);
|
|
ASSERT_DOUBLE_EQ(15.0, vector.manhattanLength());
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, angleCos) {
|
|
PIMathVectorT<size, double> vector;
|
|
PIMathVectorT<size, double> vec;
|
|
vector[0] = 1.0;
|
|
vector[1] = 1.0;
|
|
vec[1] = 1.0;
|
|
ASSERT_DOUBLE_EQ(cos(0.78539816339744830961566084581988), vector.angleCos(vec));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, angleSin) {
|
|
PIMathVectorT<size, double> vector;
|
|
PIMathVectorT<size, double> vec;
|
|
vector[0] = 1.0;
|
|
vector[1] = 1.0;
|
|
vec[1] = 1.0;
|
|
ASSERT_DOUBLE_EQ(cos(0.78539816339744830961566084581988), vector.angleSin(vec));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, angleRad) {
|
|
PIMathVectorT<size, double> vector;
|
|
PIMathVectorT<size, double> vec;
|
|
vector[0] = 1.0;
|
|
vector[1] = 1.0;
|
|
vec[1] = 1.0;
|
|
ASSERT_DOUBLE_EQ(0.78539816339744830961566084581988, vector.angleRad(vec));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, angleDeg) {
|
|
PIMathVectorT<size, double> vector;
|
|
PIMathVectorT<size, double> vec;
|
|
vector[0] = 1.0;
|
|
vector[1] = 1.0;
|
|
vec[1] = 1.0;
|
|
ASSERT_DOUBLE_EQ(45.0, vector.angleDeg(vec));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, angleElevation) {
|
|
PIMathVectorT<size, double> vector;
|
|
PIMathVectorT<size, double> vec;
|
|
vector[0] = 1.0;
|
|
vector[1] = 1.0;
|
|
vec[1] = 1.0;
|
|
ASSERT_DOUBLE_EQ(-45.0, vector.angleElevation(vec));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, projection) {
|
|
PIMathVectorT<size, double> vector;
|
|
PIMathVectorT<size, double> vec;
|
|
vec[0] = 1.0;
|
|
vector[0] = 1.0;
|
|
vector[1] = 1.0;
|
|
auto vecProj = vector.projection(vec);
|
|
ASSERT_TRUE(vecProj == vec);
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, normalize) {
|
|
PIMathVectorT<size, double> vector;
|
|
vector.fill(5.0);
|
|
ASSERT_TRUE(cmpVectorWithValue(vector.normalize(), 5.0 / sqrt(75.0), 3u));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, normalized) {
|
|
PIMathVectorT<size, double> vector;
|
|
vector.fill(5.0);
|
|
ASSERT_TRUE(cmpVectorWithValue(vector.normalized(), 5.0 / sqrt(75.0), 3u));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, cross1) {
|
|
PIMathVectorT<size, double> vector1;
|
|
PIMathVectorT<size, double> vector2;
|
|
vector1.fill(6.0);
|
|
vector2.fill(1.72);
|
|
ASSERT_TRUE(cmpVectorWithValue(vector1.cross(vector2), 0.0, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, cross2) {
|
|
PIMathVectorT<size, double> vector1;
|
|
PIMathVectorT<size, double> vector2;
|
|
vector1[0] = 1.0;
|
|
vector2[1] = 1.0;
|
|
ASSERT_TRUE(((vector1 * vector2)[0] == 0.0) && ((vector1 * vector2)[1] == 0.0) && ((vector1 * vector2)[2] == 1.0));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, dot) {
|
|
PIMathVectorT<size, double> vector1;
|
|
PIMathVectorT<size, double> vector2;
|
|
vector1.fill(6.0);
|
|
vector2.fill(5.0);
|
|
ASSERT_EQ(vector1.dot(vector2), 90.0);
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, isNullTrue) {
|
|
PIMathVectorT<size, double> vector;
|
|
ASSERT_TRUE(vector.isNull());
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, isNullFalse) {
|
|
PIMathVectorT<size, double> vector;
|
|
vector[0] = 6.273;
|
|
ASSERT_FALSE(vector.isNull());
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, isOrthoTrue) {
|
|
PIMathVectorT<size, double> vector;
|
|
PIMathVectorT<size, double> vect;
|
|
vector[0] = 2.0;
|
|
vect[1] = 1.0;
|
|
ASSERT_TRUE(vector.isOrtho(vect));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, isOrthoFalse) {
|
|
PIMathVectorT<size, double> vector;
|
|
PIMathVectorT<size, double> vect;
|
|
vector[0] = 2.0;
|
|
vect[0] = 5.0;
|
|
vect[1] = 1.0;
|
|
ASSERT_FALSE(vector.isOrtho(vect));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, at) {
|
|
PIMathVectorT<size, double> vector;
|
|
vector.fill(5.5);
|
|
for(uint i = 0; i < 3u; i++){
|
|
if(vector.at(i) != 5.5){
|
|
ASSERT_TRUE(false);
|
|
}
|
|
}
|
|
ASSERT_TRUE(true);
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_AssignmentValue) {
|
|
PIMathVectorT<size, double> vector;
|
|
vector = 3.0;
|
|
ASSERT_TRUE(cmpVectorWithValue(vector, 3.0, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_AssignmentVector) {
|
|
PIMathVectorT<size, double> vector;
|
|
PIMathVectorT<size, double> vec;
|
|
vec = 5.0;
|
|
vector = vec;
|
|
ASSERT_TRUE(cmpVectorWithValue(vector, 5.0, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_EqualTrue) {
|
|
PIMathVectorT<size, double> vector;
|
|
PIMathVectorT<size, double> vec;
|
|
vector[0] = 5.12;
|
|
vector[1] = 7.34;
|
|
vec[0] = 5.12;
|
|
vec[1] = 7.34;
|
|
ASSERT_TRUE(vec == vector);
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_EqualFalse) {
|
|
PIMathVectorT<size, double> vector;
|
|
PIMathVectorT<size, double> vec;
|
|
vector[0] = 5.12;
|
|
vector[1] = 7.34;
|
|
vec[0] = 5.12;
|
|
vec[1] = 0.34;
|
|
ASSERT_FALSE(vec == vector);
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_Not_EqualTrue) {
|
|
PIMathVectorT<size, double> vector;
|
|
PIMathVectorT<size, double> vec;
|
|
vector[0] = 5.12;
|
|
vector[1] = 7.34;
|
|
vec[0] = 5.12;
|
|
vec[1] = 0.34;
|
|
ASSERT_TRUE(vec != vector);
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_Not_EqualFalse) {
|
|
PIMathVectorT<size, double> vector;
|
|
PIMathVectorT<size, double> vec;
|
|
vector[0] = 5.12;
|
|
vector[1] = 7.34;
|
|
vec[0] = 5.12;
|
|
vec[1] = 7.34;
|
|
ASSERT_FALSE(vec != vector);
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_Addition_Aassignment) {
|
|
PIMathVectorT<size, double> vector1;
|
|
PIMathVectorT<size,double> vector2;
|
|
vector1.fill(6.0);
|
|
vector2.fill(1.72);
|
|
vector1 += vector2;
|
|
ASSERT_TRUE(cmpVectorWithValue(vector1, 7.72, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_Subtraction_Assignment) {
|
|
PIMathVectorT<size, double> vector1;
|
|
PIMathVectorT<size,double> vector2;
|
|
vector1.fill(6.0);
|
|
vector2.fill(1.72);
|
|
vector1 -= vector2;
|
|
ASSERT_TRUE(cmpVectorWithValue(vector1, 4.28, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_Multiplication_AssignmentValue) {
|
|
PIMathVectorT<size, double> vector1;
|
|
vector1.fill(6.0);
|
|
vector1 *= 4.0;
|
|
ASSERT_TRUE(cmpVectorWithValue(vector1, 24.0, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_Multiplication_AssignmentVector) {
|
|
PIMathVectorT<size, double> vector1;
|
|
PIMathVectorT<size,double> vector2;
|
|
vector1.fill(6.0);
|
|
vector2.fill(1.72);
|
|
vector1 *= vector2;
|
|
ASSERT_TRUE(cmpVectorWithValue(vector1, 10.32, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_Division_AssignmentValue) {
|
|
PIMathVectorT<size, double> vector1;
|
|
vector1.fill(6.0);
|
|
vector1 /= 4.0;
|
|
ASSERT_TRUE(cmpVectorWithValue(vector1, 1.5, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_Division_AssignmentVector) {
|
|
PIMathVectorT<size, double> vector1;
|
|
PIMathVectorT<size,double> vector2;
|
|
vector1.fill(6.0);
|
|
vector2.fill(1.5);
|
|
vector1 /= vector2;
|
|
ASSERT_TRUE(cmpVectorWithValue(vector1, 4.0, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_Addition) {
|
|
PIMathVectorT<size, double> vector1;
|
|
PIMathVectorT<size,double> vector2;
|
|
vector1.fill(6.0);
|
|
vector2.fill(1.72);
|
|
ASSERT_TRUE(cmpVectorWithValue(vector1 + vector2, 7.72, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_Subtraction) {
|
|
PIMathVectorT<size, double> vector1;
|
|
PIMathVectorT<size,double> vector2;
|
|
vector1.fill(6.0);
|
|
vector2.fill(1.72);
|
|
ASSERT_TRUE(cmpVectorWithValue(vector1 - vector2, 4.28, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_MultiplicationValue) {
|
|
PIMathVectorT<size, double> vector1;
|
|
PIMathVectorT<size,double> vector2;
|
|
vector1.fill(6.0);
|
|
ASSERT_TRUE(cmpVectorWithValue(vector1 * 4.0, 24.0, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_MultiplicationVector1) {
|
|
PIMathVectorT<size, double> vector1;
|
|
PIMathVectorT<size,double> vector2;
|
|
vector1.fill(6.0);
|
|
vector2.fill(1.72);
|
|
ASSERT_TRUE(cmpVectorWithValue((vector1 * vector2), 0.0, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_MultiplicationVector2) {
|
|
PIMathVectorT<size, double> vector1;
|
|
PIMathVectorT<size,double> vector2;
|
|
vector1[0] = 1.0;
|
|
vector2[1] = 1.0;
|
|
ASSERT_TRUE(((vector1 * vector2)[0] == 0.0) && ((vector1 * vector2)[1] == 0.0) && ((vector1 * vector2)[2] == 1.0));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_DivisionVal) {
|
|
PIMathVectorT<size, double> vector1;
|
|
vector1.fill(6.0);
|
|
ASSERT_TRUE(cmpVectorWithValue(vector1 / 4.0, 1.5, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_DivisionVector) {
|
|
PIMathVectorT<size, double> vector1;
|
|
PIMathVectorT<size, double> vector2;
|
|
vector1.fill(6.0);
|
|
vector2.fill(4.0);
|
|
ASSERT_TRUE(cmpVectorWithValue(vector1 / vector2, 1.5, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_MultiplVect) {
|
|
PIMathVectorT<size, double> vector1;
|
|
PIMathVectorT<size,double> vector2;
|
|
vector1.fill(6.0);
|
|
vector2.fill(5.0);
|
|
ASSERT_TRUE(cmpVectorWithValue(vector1 & vector2, 30.0, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, operator_absDotProduct) {
|
|
PIMathVectorT<size, double> vector1;
|
|
PIMathVectorT<size,double> vector2;
|
|
vector1.fill(6.0);
|
|
vector2.fill(5.0);
|
|
ASSERT_TRUE(90.0 == (vector1 ^ vector2));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, transposed) {
|
|
PIMathVectorT<size, double> vector;
|
|
vector.fill(6.0);
|
|
auto matrix = vector.transposed();
|
|
for(int i = 0; i < size; i++){
|
|
if(matrix[0][i] != 6.0)
|
|
{
|
|
ASSERT_TRUE(false);
|
|
}
|
|
}
|
|
ASSERT_TRUE(true);
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, filled) {
|
|
auto vector = PIMathVectorT<size, double>::filled(6.0);
|
|
ASSERT_TRUE(cmpVectorWithValue(vector, 6.0, 3));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, distToLine) {
|
|
PIMathVectorT<size, double> vect;
|
|
PIMathVectorT<size, double> vector1;
|
|
PIMathVectorT<size, double> vector2;
|
|
vect.fill(6.0);
|
|
vector1[0] = 1.0;
|
|
vector2[1] = -1.0;
|
|
ASSERT_DOUBLE_EQ(vect.distToLine(vector1, vector2), sqrt(2.0)/2.0);
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, turnTo) {
|
|
PIMathVectorT<size, double> vect;
|
|
vect.fill(6.0);
|
|
auto vector = vect.turnTo<2u, double>();
|
|
ASSERT_TRUE((vector.size() == 2) && (vector.size() == 2));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, LogicalOrTrue) {
|
|
PIMathVectorT<size, double> vector1;
|
|
PIMathVectorT<size,double> vector2;
|
|
vector1.fill(6.0);
|
|
vector2.fill(1.72);
|
|
ASSERT_TRUE(vector1 || vector2);
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, LogicalOrFalse) {
|
|
PIMathVectorT<size, double> vector1;
|
|
PIMathVectorT<size,double> vector2;
|
|
vector1[0] = 1.0;
|
|
vector2[1] = 1.0;
|
|
ASSERT_FALSE(vector1 || vector2);
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, sqrt) {
|
|
PIMathVectorT<size, double> vector1;
|
|
vector1.fill(36.0);
|
|
ASSERT_TRUE(cmpVectorWithValue(sqrt(vector1), 6.0, 3u));
|
|
}
|
|
|
|
TEST(PIMathVectorT_Test, sqr) {
|
|
PIMathVectorT<size, double> vector1;
|
|
vector1.fill(6.0);
|
|
ASSERT_TRUE(cmpVectorWithValue(sqr(vector1), 36.0, 3u));
|
|
}
|