tarou yamada
Dependents: OBROT_ALL f3rc_3_auto_encode f3rc_3_auto_lintrace_912 EMG_Realtime_Filter ... more
Diff: Math.cpp
- Revision:
- 0:067c036b09e0
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/Math.cpp Wed Oct 14 03:55:49 2015 +0000
@@ -0,0 +1,25 @@
+#include "Math.h"
+#include "mbed.h"
+
+const float gPI = 3.1415926536f;
+
+float convertRange( float in, float oldMin, float oldMax, float newMin, float newMax ){
+ return ( in - oldMin ) * ( newMax - newMin ) / ( oldMax - oldMin ) + newMin;
+}
+
+float convertRangePlusMinusPi( float deg ){
+ while ( ( deg > gPI ) || ( deg < -gPI ) ){
+ while ( deg > gPI ){
+ deg -= 2.0f * gPI;
+ }
+ while ( deg < -gPI ){
+ deg += 2.0f * gPI;
+ }
+ }
+
+ return deg;
+}
+
+bool isNear( float a, float b, float error ){
+ return ( abs( a - b ) < error );
+}