sigonasr2/AngleNorming
1
0
Fork 0
generated from sigonasr2/CPlusPlusProjectTemplate
Code Issues Pull Requests Projects Releases Wiki Activity

Include new angle_diff calculation code (shortened a statement)

Browse Source 
Co-authored-by: sigonasr2 <sigonasr2@gmail.com>
This commit is contained in:
sigonasr2 2022-11-17 17:27:54 -07:00
parent 722d293fb8
commit f47d7703a1
1 changed files with 7 additions and 10 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

17
main.cpp
View File

@ -14,16 +14,13 @@ float angle_difference(float angle_1, float angle_2)
{ {
angle_1=(angle_1<0)?angle_1+360:fmod(angle_1,360); angle_1=(angle_1<0)?angle_1+360:fmod(angle_1,360);
angle_2=(angle_2<0)?angle_2+360:fmod(angle_2,360); angle_2=(angle_2<0)?angle_2+360:fmod(angle_2,360);
float angle_diff = angle_1-angle_2; float angle_diff = angle_1 - angle_2;
if (abs(angle_diff)>180) {
if (angle_1>180) { if (angle_diff > 180)
angle_1-=360; angle_diff -= 360;
} else if (angle_diff < -180)
if (angle_2>180) { angle_diff += 360;
angle_2-=360;
}
angle_diff = angle_1-angle_2;
}
return -angle_diff; return -angle_diff;
} }