robot

Dependencies:   FastPWM3 mbed

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?

UserRevisionLine numberNew 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 }