Major updates, start orientation, start documentation.

test/orientation_test.cc

@@ -0,0 +1,46 @@
+#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();
+}

test/vector_test.cc

@@ -1,6 +1,5 @@
-#include <iostream>
 #include <gtest/gtest.h>
-#include <wrnav/geom/vector.h>
+#include <wrmath/geom/vector.h>
 
 using namespace std;
 using namespace wr;
@@ -82,6 +81,8 @@ TEST(Vector3FloatTests, UnitVector)
 	geom::Vector3f	unit {0.6651669556972103, 0.7069150218815566, 0.24046636539587804};
 
 	EXPECT_EQ(vec3.unitVector(), unit);
+	EXPECT_FALSE(vec3.isUnitVector());
+	EXPECT_TRUE(unit.isUnitVector());
 }
 
 
@@ -96,6 +97,37 @@ TEST(Vector3FloatTests, Angle)
 	EXPECT_NEAR(c.angle(d), 1.052, 0.001);
 }
 
+TEST(Vector3FloatTests, ParallelOrthogonalVectors)
+{
+	geom::Vector3f	a {-2.029, 9.97, 4.172};
+	geom::Vector3f	b {-9.231, -6.639, -7.245};
+	geom::Vector3f	c {-2.328, -7.284, -1.214};
+	geom::Vector3f	d {-1.821, 1.072, -2.94};
+	geom::Vector3f	e {-2.0, 1.0, 3.0};
+	geom::Vector3f	f {-6.0, 3.0, 9.0};
+
+	EXPECT_FALSE(a.isParallel(b));
+	EXPECT_FALSE(a.isOrthogonal(b));
+
+	EXPECT_FALSE(c.isParallel(d));
+	EXPECT_TRUE(c.isOrthogonal(d));
+
+	EXPECT_TRUE(e.isParallel(f));
+	EXPECT_FALSE(e.isOrthogonal(f));
+}
+
+
+TEST(Vector3FloatTests, Projections)
+{
+	geom::Vector4f	a {3.009, -6.172, 3.692, -2.510};
+	geom::Vector4f	b {6.404, -9.144, 2.759, 8.718};
+	geom::Vector4f	c {1.9685, -2.8108, 0.8481, 2.6798};
+	geom::Vector4f	d {1.0405, -3.3612, 2.8439, -5.1898};
+
+	ASSERT_EQ(a.projectParallel(b), c);
+	ASSERT_EQ(a.projectOrthogonal(b), d);
+}
+
 
 TEST(Vector3DoubleTests, Magnitude)
 {
@@ -173,6 +205,8 @@ TEST(Vector3DoubleTests, UnitVector)
 	geom::Vector3d	unit {0.6651669556972103, 0.7069150218815566, 0.24046636539587804};
 
 	EXPECT_EQ(vec3.unitVector(), unit);
+	EXPECT_FALSE(vec3.isUnitVector());
+	EXPECT_TRUE(unit.isUnitVector());
 }
 
 
@@ -188,6 +222,38 @@ TEST(Vector3DoubleTests, Angle)
 }
 
 
+TEST(Vector3DoubleTests, ParallelOrthogonalVectors)
+{
+	geom::Vector3d	a {-2.029, 9.97, 4.172};
+	geom::Vector3d	b {-9.231, -6.639, -7.245};
+	geom::Vector3d	c {-2.328, -7.284, -1.214};
+	geom::Vector3d	d {-1.821, 1.072, -2.94};
+	geom::Vector3d	e {-2.0, 1.0, 3.0};
+	geom::Vector3d	f {-6.0, 3.0, 9.0};
+
+	EXPECT_FALSE(a.isParallel(b));
+	EXPECT_FALSE(a.isOrthogonal(b));
+
+	EXPECT_FALSE(c.isParallel(d));
+	EXPECT_TRUE(c.isOrthogonal(d));
+
+	EXPECT_TRUE(e.isParallel(f));
+	EXPECT_FALSE(e.isOrthogonal(f));
+}
+
+
+TEST(Vector3DoubleTests, Projections)
+{
+	geom::Vector4d	a {3.009, -6.172, 3.692, -2.510};
+	geom::Vector4d	b {6.404, -9.144, 2.759, 8.718};
+	geom::Vector4d	c {1.9685, -2.8108, 0.8481, 2.6798};
+	geom::Vector4d	d {1.0405, -3.3612, 2.8439, -5.1898};
+
+	ASSERT_EQ(a.projectParallel(b), c);
+	ASSERT_EQ(a.projectOrthogonal(b), d);
+}
+
+
 int
 main(int argc, char **argv)
 {