Bayley Wang
/
foc-ed_in_the_bot_compact
robot
MathHelpers/MathHelpers.cpp@19:a6cf15f89f3d, 2016-11-02 (annotated)
- Committer:
- bwang
- Date:
- Wed Nov 02 12:52:00 2016 +0000
- Revision:
- 19:a6cf15f89f3d
- Child:
- 38:07cb4ae6c1bd
formatting changes
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
bwang | 19:a6cf15f89f3d | 1 | #include "MathHelpers.h" |
bwang | 19:a6cf15f89f3d | 2 | |
bwang | 19:a6cf15f89f3d | 3 | float map(float x, float in_min, float in_max, float out_min, float out_max) |
bwang | 19:a6cf15f89f3d | 4 | { |
bwang | 19:a6cf15f89f3d | 5 | return (x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min; |
bwang | 19:a6cf15f89f3d | 6 | } |
bwang | 19:a6cf15f89f3d | 7 | |
bwang | 19:a6cf15f89f3d | 8 | float constrain(float in, float min, float max) |
bwang | 19:a6cf15f89f3d | 9 | { |
bwang | 19:a6cf15f89f3d | 10 | if(in > max) return max; |
bwang | 19:a6cf15f89f3d | 11 | if(in < min) return min; |
bwang | 19:a6cf15f89f3d | 12 | return in; |
bwang | 19:a6cf15f89f3d | 13 | } |
bwang | 19:a6cf15f89f3d | 14 | |
bwang | 19:a6cf15f89f3d | 15 | float fminf(float a, float b) { |
bwang | 19:a6cf15f89f3d | 16 | if(a < b) return a; |
bwang | 19:a6cf15f89f3d | 17 | return b; |
bwang | 19:a6cf15f89f3d | 18 | } |
bwang | 19:a6cf15f89f3d | 19 | |
bwang | 19:a6cf15f89f3d | 20 | float fmaxf(float a, float b) { |
bwang | 19:a6cf15f89f3d | 21 | if(a > b) return a; |
bwang | 19:a6cf15f89f3d | 22 | return b; |
bwang | 19:a6cf15f89f3d | 23 | } |