Merge James's controllib bits into a separate library module.

Add a top-level mathlib header to avoid having to dig around for specific headers.

apps/mathlib/math/Dcm.cpp

@@ -37,7 +37,7 @@
  * math direction cosine matrix
  */
 
-#include "test/test.hpp"
+#include "math/test/test.hpp"
 
 #include "Dcm.hpp"
 #include "Quaternion.hpp"

apps/mathlib/math/EulerAngles.cpp

@@ -37,7 +37,7 @@
  * math vector
  */
 
-#include "test/test.hpp"
+#include "math/test/test.hpp"
 
 #include "EulerAngles.hpp"
 #include "Quaternion.hpp"

apps/mathlib/math/Matrix.cpp

@@ -37,7 +37,7 @@
  * matrix code
  */
 
-#include "test/test.hpp"
+#include "math/test/test.hpp"
 #include <math.h>
 
 #include "Matrix.hpp"

apps/mathlib/math/Quaternion.cpp

@@ -37,7 +37,7 @@
  * math vector
  */
 
-#include "test/test.hpp"
+#include "math/test/test.hpp"
 
 
 #include "Quaternion.hpp"

apps/mathlib/math/Vector.cpp

@@ -37,7 +37,7 @@
  * math vector
  */
 
-#include "test/test.hpp"
+#include "math/test/test.hpp"
 
 #include "Vector.hpp"
 

apps/mathlib/math/Vector3.cpp

@@ -37,7 +37,7 @@
  * math vector
  */
 
-#include "test/test.hpp"
+#include "math/test/test.hpp"
 
 #include "Vector3.hpp"