Fixing bug in angle projection

21965b75 · Dipl.-Ing. Jonas Stienen · 342f2263 · 21965b75
Commit 21965b75 authored Dec 07, 2017 by Dipl.-Ing. Jonas Stienen
Hide whitespace changes
Inline Side-by-side

Showing with 1 addition and 1 deletion

src/ITANumericUtils.cpp src/ITANumericUtils.cpp +1 -1

No files found.
--- a/src/ITANumericUtils.cpp
+++ b/src/ITANumericUtils.cpp
@@ -256,7 +256,7 @@ float anglef_proj_NPI_PI( const float alpha )

 float anglef_proj_NPIH_PIH( const float alpha )
 {
-	float alpha_temp = fmodf( alpha, PI_F );
+	float alpha_temp = fmodf( alpha + PI_F / 2.0f, PI_F ) - PI_F / 2.0f;
 	if( alpha_temp < -PI_F/2.0f )
 		alpha_temp += PI_F;
 	return alpha_temp;