Bayley Wang
/
foc-ed_in_the_bot_compact
robot
Diff: MathHelpers/MathHelpers.cpp
- 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