This commit is contained in:
2023-04-06 10:37:59 +02:00
parent 57b01a5d2c
commit 205a672680
4 changed files with 6 additions and 35 deletions

View File

@ -1,14 +1,10 @@
#include "SafeCtrl.h"
#include <fsfw/globalfunctions/constants.h>
#include <fsfw/globalfunctions/math/MatrixOperations.h>
#include <fsfw/globalfunctions/math/QuaternionOperations.h>
#include <fsfw/globalfunctions/math/VectorOperations.h>
#include <fsfw/globalfunctions/sign.h>
#include <math.h>
#include "../util/MathOperations.h"
SafeCtrl::SafeCtrl(AcsParameters *acsParameters_) { acsParameters = acsParameters_; }
SafeCtrl::~SafeCtrl() {}
@ -16,15 +12,15 @@ SafeCtrl::~SafeCtrl() {}
uint8_t SafeCtrl::safeCtrlStrategy(const bool magFieldValid, const ReturnValue_t mekfValid,
const bool satRotRateValid, const bool sunDirValid) {
if (not magFieldValid) {
return SafeModeStrategy::SAFECTRL_NO_MAG_FIELD_FOR_CONTROL;
return acs::SafeModeStrategy::SAFECTRL_NO_MAG_FIELD_FOR_CONTROL;
} else if (mekfValid) {
return SafeModeStrategy::SAFECTRL_USE_MEKF;
return acs::SafeModeStrategy::SAFECTRL_ACTIVE_MEKF;
} else if (satRotRateValid and sunDirValid) {
return SafeModeStrategy::SAFECTRL_USE_NONMEKF;
return acs::SafeModeStrategy::SAFECTRL_WITHOUT_MEKF;
} else if (satRotRateValid and not sunDirValid) {
return SafeModeStrategy::SAFECTRL_USE_DAMPING;
return acs::SafeModeStrategy::SAFECTRL_ECLIPSE_DAMPING;
} else {
return SafeModeStrategy::SAFECTRL_NO_SENSORS_FOR_CONTROL;
return acs::SafeModeStrategy::SAFECTRL_NO_SENSORS_FOR_CONTROL;
}
}