(多分)全部+フライトピン+新しい加速度
Dependencies: mbed
Math.cpp@40:d0b0d2a26cac, 2018-12-16 (annotated)
- Committer:
- seangshim
- Date:
- Sun Dec 16 02:11:48 2018 +0000
- Revision:
- 40:d0b0d2a26cac
- Parent:
- 18:2a47ed430cfe
new
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 | } |