From c338c4fb58c494596cfd4c2ff546906541a39125 Mon Sep 17 00:00:00 2001
From: Marius Eggert <eggertm@irs.uni-stuttgart.de>
Date: Mon, 19 Dec 2022 14:24:03 +0100
Subject: [PATCH] fixed usage of sunMagAngleMin

---
 mission/controller/acs/control/SafeCtrl.cpp | 6 ++----
 1 file changed, 2 insertions(+), 4 deletions(-)

diff --git a/mission/controller/acs/control/SafeCtrl.cpp b/mission/controller/acs/control/SafeCtrl.cpp
index 54ae27ee..88f4de9b 100644
--- a/mission/controller/acs/control/SafeCtrl.cpp
+++ b/mission/controller/acs/control/SafeCtrl.cpp
@@ -129,10 +129,8 @@ void SafeCtrl::safeNoMekf(timeval now, double *susDirB, bool susDirBValid, doubl
   /* Only valid if angle between sun direction and magnetic field direction
      is sufficiently large */
 
-  double sinAngle = 0;
-  sinAngle = sin(acos(cos(cosAngleSunMag)));
-
-  if (!(sinAngle > sin(safeModeControllerParameters->sunMagAngleMin * M_PI / 180))) {
+  double angleSunMag = acos(cosAngleSunMag);
+  if (angleSunMag < safeModeControllerParameters->sunMagAngleMin) {
     return;
   }