#include <gtest/gtest.h>
#include <wrmath/geom/vector.h>
#include <wrmath/geom/orientation.h>

using namespace std;
using namespace wr;


TEST(Orientation2f, Heading)
{
	geom::Vector2f	a {2.0, 2.0};

	EXPECT_FLOAT_EQ(geom::Heading2f(a), geom::DegreesToRadiansF(45));
}


TEST(Orientation3f, Heading)
{
	geom::Vector3f	a {2.0, 2.0, 2.0};

	EXPECT_FLOAT_EQ(geom::Heading3f(a), geom::DegreesToRadiansF(45));
}


TEST(Orientation2d, Heading)
{
	geom::Vector2d	a {2.0, 2.0};

	EXPECT_NEAR(geom::Heading2d(a), geom::DegreesToRadiansF(45), 0.000001);
}


TEST(Orientation3d, Heading)
{
	geom::Vector3d	a {2.0, 2.0, 2.0};

	EXPECT_NEAR(geom::Heading3d(a), geom::DegreesToRadiansF(45), 0.000001);
}


int
main(int argc, char **argv)
{
	::testing::InitGoogleTest(&argc, argv);
	return RUN_ALL_TESTS();
}