cansat-d_2018
otamesi
Dependencies: mbed
Math.cpp@41:7c537a922510, 2019-02-16 (annotated)
- Committer:
- seangshim
- Date:
- Sat Feb 16 05:40:24 2019 +0000
- Revision:
- 41:7c537a922510
- Parent:
- 18:2a47ed430cfe
nei
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| seangshim | 18:2a47ed430cfe | 1 | #include "Math.h" |
| seangshim | 18:2a47ed430cfe | 2 | #include "mbed.h" |
| seangshim | 18:2a47ed430cfe | 3 | |
| seangshim | 18:2a47ed430cfe | 4 | const float gPI = 3.1415926536f; |
| seangshim | 18:2a47ed430cfe | 5 | |
| seangshim | 18:2a47ed430cfe | 6 | float convertRange( float in, float oldMin, float oldMax, float newMin, float newMax ){ |
| seangshim | 18:2a47ed430cfe | 7 | return ( in - oldMin ) * ( newMax - newMin ) / ( oldMax - oldMin ) + newMin; |
| seangshim | 18:2a47ed430cfe | 8 | } |
| seangshim | 18:2a47ed430cfe | 9 | |
| seangshim | 18:2a47ed430cfe | 10 | float convertRangePlusMinusPi( float deg ){ |
| seangshim | 18:2a47ed430cfe | 11 | while ( ( deg > gPI ) || ( deg < -gPI ) ){ |
| seangshim | 18:2a47ed430cfe | 12 | while ( deg > gPI ){ |
| seangshim | 18:2a47ed430cfe | 13 | deg -= 2.0f * gPI; |
| seangshim | 18:2a47ed430cfe | 14 | } |
| seangshim | 18:2a47ed430cfe | 15 | while ( deg < -gPI ){ |
| seangshim | 18:2a47ed430cfe | 16 | deg += 2.0f * gPI; |
| seangshim | 18:2a47ed430cfe | 17 | } |
| seangshim | 18:2a47ed430cfe | 18 | } |
| seangshim | 18:2a47ed430cfe | 19 | |
| seangshim | 18:2a47ed430cfe | 20 | return deg; |
| seangshim | 18:2a47ed430cfe | 21 | } |
| seangshim | 18:2a47ed430cfe | 22 | |
| seangshim | 18:2a47ed430cfe | 23 | bool isNear( float a, float b, float error ){ |
| seangshim | 18:2a47ed430cfe | 24 | return ( abs( a - b ) < error ); |
| seangshim | 18:2a47ed430cfe | 25 | } |