/**
 * @file TestComputeRotationMatrix.cpp
 * @date 2015-04-23
 *
 * \copyright
 * Copyright (c) 2012-2021, OpenGeoSys Community (http://www.opengeosys.org)
 *            Distributed under a Modified BSD License.
 *              See accompanying file LICENSE.txt or
 *              http://www.opengeosys.org/project/license
 */

#include <gtest/gtest.h>

#include "GeoLib/AnalyticalGeometry.h"

auto test3equal =
    [](double a, double b, double c, Eigen::Vector3d const& result)
{
    EXPECT_EQ(a, result[0]);
    EXPECT_EQ(b, result[1]);
    EXPECT_EQ(c, result[2]);
};

TEST(GeoLib, ComputeRotationMatrixToXYnegative)
{
    Eigen::Vector3d const n({0.0, -1.0, 0.0});
    Eigen::Matrix3d const rot_mat = GeoLib::computeRotationMatrixToXY(n);

    EXPECT_EQ(1.0, rot_mat(0, 0));
    EXPECT_EQ(0.0, rot_mat(0, 1));
    EXPECT_EQ(0.0, rot_mat(0, 2));
    EXPECT_EQ(0.0, rot_mat(1, 0));
    EXPECT_EQ(0.0, rot_mat(1, 1));
    EXPECT_EQ(1.0, rot_mat(1, 2));
    EXPECT_EQ(0.0, rot_mat(2, 0));
    EXPECT_EQ(-1.0, rot_mat(2, 1));
    EXPECT_EQ(0.0, rot_mat(2, 2));

    Eigen::Vector3d const x({0.0, 1.0, 0.0});
    test3equal(0, 0, -1, rot_mat * x);

    Eigen::Vector3d const x0({10.0, 1.0, 0.0});
    test3equal(10, 0, -1, rot_mat * x0);

    Eigen::Vector3d const x1({10.0, 0.0, 10.0});
    test3equal(10, 10, 0, rot_mat * x1);
}

TEST(GeoLib, ComputeRotationMatrixToXYpositive)
{
    Eigen::Vector3d const n{0.0, 1.0, 0.0};
    Eigen::Matrix3d const rot_mat = GeoLib::computeRotationMatrixToXY(n);

    EXPECT_EQ(1.0, rot_mat(0, 0));
    EXPECT_EQ(0.0, rot_mat(0, 1));
    EXPECT_EQ(0.0, rot_mat(0, 2));
    EXPECT_EQ(0.0, rot_mat(1, 0));
    EXPECT_EQ(0.0, rot_mat(1, 1));
    EXPECT_EQ(-1.0, rot_mat(1, 2));
    EXPECT_EQ(0.0, rot_mat(2, 0));
    EXPECT_EQ(1.0, rot_mat(2, 1));
    EXPECT_EQ(0.0, rot_mat(2, 2));

    Eigen::Vector3d const x(0.0, 1.0, 0.0);
    test3equal(0, 0, 1, rot_mat * x);

    Eigen::Vector3d const x0(10.0, 1.0, 0.0);
    test3equal(10, 0, 1, rot_mat * x0);

    Eigen::Vector3d const x1(10.0, 0.0, 10.0);
    test3equal(10, -10, 0, rot_mat * x1);
}