isoCalculate.c
737 字节
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
#include "isoCalculate.h"
float shortARCCalculate(float cur,float target){
float A,B;
if( !((cur >= -180.0f ) && ( cur <= 180.0f ) && (target >= -180.0f ) && ( target <= 180.0f )) ){
return 0;
}
if( cur >= target ){
A = 360.0f - cur + target;
B = target - cur;
if( A > -B ){
return B;
}else{
return A;
}
}else{
A = target - cur;
B = -360.0f - cur + target;
if( A > -B ){
return B;
}else{
return A;
}
}
}
float keepIn180UpDown(float num){
if( num > 180.0f ){
num = num - 360.0f;
}
if( num < - 180.0f ){
num = num + 360.0f;
}
return num;
}