Fixed coverage issues.

matrix/helper_functions.hpp

@@ -6,8 +6,9 @@
 
 namespace matrix
 {
+
 template<typename Type>
-float wrap_pi(Type x)
+Type wrap_pi(Type x)
 {
     if (!isfinite(x)) {
         return x;

test/CMakeLists.txt

@@ -13,6 +13,7 @@ set(tests
 	filter
 	integration
 	squareMatrix
+	helper
 	)
 
 add_custom_target(test_build)

test/helper.cpp

@@ -0,0 +1,18 @@
+#include <assert.h>
+#include <stdio.h>
+
+#include <matrix/helper_functions.hpp>
+
+using namespace matrix;
+
+
+int main()
+{
+    assert(fabs(wrap_pi(4.0) - (4.0 - 2*M_PI)) < 1e-5);
+    assert(fabs(wrap_pi(-4.0) - (-4.0 + 2*M_PI)) < 1e-5);
+    assert(fabs(wrap_pi(3.0) - (3.0)) < 1e-3);
+    wrap_pi(NAN);
+    return 0;
+}
+
+/* vim: set et fenc=utf-8 ff=unix sts=0 sw=4 ts=4 : */