Add simox::deg2rad and simox::rad2deg

SimoxUtility/CMakeLists.txt

@@ -50,8 +50,12 @@ SET(SOURCES
 
 SET(INCLUDES
     SimoxUtility.h
+
     eigen/OrientedBox.h
     eigen/XYConstrainedOrientedBox.h
+
+    math/convert/deg2rad.h
+    math/convert/rad2deg.h
 )
 
 macro(simox_subdirs result curdir)

SimoxUtility/math.h

+#pragma once
+
+// This file is generated!
+
+#include "math/convert.h"

SimoxUtility/math/convert.h

+#pragma once
+
+// This file is generated!
+
+#include "convert/deg2rad.h"
+#include "convert/rad2deg.h"

SimoxUtility/math/convert/deg2rad.h

+#pragma once
+
+#include <boost/math/constants/constants.hpp>
+
+namespace simox
+{
+    template<class FloatT>
+    FloatT deg2rad(FloatT rad)
+    {
+        return rad / 180.f * boost::math::constants::pi<FloatT>();
+    }
+}

SimoxUtility/math/convert/rad2deg.h

+#pragma once
+
+#include <boost/math/constants/constants.hpp>
+
+namespace simox
+{
+    template<class FloatT>
+    FloatT rad2deg(FloatT rad)
+    {
+        return rad * 180.f / boost::math::constants::pi<FloatT>();
+    }
+}