#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));
}