df

Dependencies:   mbed

Fork of APP1 by Team APP

Revision:
6:3facf0329142
Child:
9:12519f9dd3cd
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Utility.cpp	Sun Jan 15 02:04:23 2017 +0000
@@ -0,0 +1,24 @@
+#include "Utility.hpp"
+
+#include <cmath>
+
+namespace utility
+{
+    bool is_almost_equal(double a, double b, double tolerance)
+    {
+        double difference = std::abs(a-b);
+        return (difference <= tolerance);
+    }
+    
+    //Return angle between 0 and 360 degree
+    double wrap_angle(double angle)
+    {
+        return angle - 360 * std::floor( angle / 360 );
+    } 
+    
+    double degree_from_radian(const double angle_radian)
+    {
+        const double angle_degree = angle_radian * 180.0 / PI;
+        return wrap_angle(angle_degree);
+    }
+};
\ No newline at end of file