robot

Dependencies:   FastPWM3 mbed

Revision:
19:a6cf15f89f3d
Child:
38:07cb4ae6c1bd
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/MathHelpers/MathHelpers.cpp	Wed Nov 02 12:52:00 2016 +0000
@@ -0,0 +1,23 @@
+#include "MathHelpers.h"
+
+float map(float x, float in_min, float in_max, float out_min, float out_max)
+{
+    return (x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min;
+}
+
+float constrain(float in, float min, float max)
+{
+    if(in > max) return max;
+    if(in < min) return min;
+    return in;
+}
+
+float fminf(float a, float b) {
+    if(a < b) return a;
+    return b;
+}
+
+float fmaxf(float a, float b) {
+    if(a > b) return a;
+    return b;
+}
\ No newline at end of file