Ben Katz / Hobbyking_Cheetah_general

auto-measurements

Dependencies:   FastPWM3 mbed-dev

Fork of Hobbyking_Cheetah_Compact by Ben Katz

Diff: math_ops.cpp

Revision:
26:2b865c00d7e9
Parent:
25:f5741040c4bb
Child:
34:47a55f96fbc4
--- a/math_ops.cpp	Sun Apr 09 03:05:52 2017 +0000
+++ b/math_ops.cpp	Mon May 01 15:22:58 2017 +0000
@@ -30,3 +30,15 @@
         *y = *y * limit/norm;
         }
     }
+
+int float_to_uint(float x, float x_min, float x_max, int bits){
+    float span = x_max - x_min;
+    float offset = x_min;
+    return (int) ((x+offset)*((float)((1<<bits)-1))/span);
+    }
+    
+float uint_to_float(int x_int, float x_min, float x_max, int bits){
+    float span = x_max - x_min;
+    float offset = x_min;
+    return ((float)x_int)*span/((float)((1<<bits)-1)) + offset;
+    }