From dde8b7dee5be62217b12a3abe971112ba746b7ac Mon Sep 17 00:00:00 2001 From: tosh Date: Wed, 27 Mar 2013 17:00:21 +0100 Subject: [PATCH] fixes horizontal angle normalization --- shared/src/AngleUtils.h | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/shared/src/AngleUtils.h b/shared/src/AngleUtils.h index 5e5a0aa2ed..d241fa3fe6 100644 --- a/shared/src/AngleUtils.h +++ b/shared/src/AngleUtils.h @@ -68,12 +68,12 @@ void angleHorizontalPolar(float& azimuth, float& altitude) if (altitude > Unit::half_pi()) { altitude = Unit::pi() - altitude; - azimuth = -azimuth; + azimuth += Unit::pi(); } else if (altitude < -Unit::half_pi()) { altitude = -Unit::pi() - altitude; - azimuth = -azimuth; + azimuth += Unit::pi(); } azimuth = angleUnsignedNormal(azimuth); }