removed inertia matrix for safe mode

This commit is contained in:
2023-04-14 11:37:23 +02:00
parent 7f3f99c6aa
commit 53cccc3c13
5 changed files with 23 additions and 35 deletions

View File

@ -17,21 +17,20 @@ class SafeCtrl {
const uint8_t mekfEnabled, const uint8_t dampingEnabled);
void safeMekf(const double *magFieldB, const double *satRotRateB, const double *sunDirModelI,
const double *quatBI, const double *sunDirRefB, const double inertiaMatrix[3][3],
double *magMomB, double &errorAngle);
const double *quatBI, const double *sunDirRefB, double *magMomB,
double &errorAngle);
void safeNonMekf(const double *magFieldB, const double *satRotRateB, const double *sunDirB,
const double *sunDirRefB, const double inertiaMatrix[3][3], double *magMomB,
double &errorAngle);
const double *sunDirRefB, double *magMomB, double &errorAngle);
void safeRateDamping(const double *magFieldB, const double *satRotRateB, const double *sunDirRefB,
const double inertiaMatrix[3][3], double *magMomB, double &errorAngle);
double *magMomB, double &errorAngle);
void splitRotationalRate(const double *satRotRateB, const double *sunDirB);
void calculateRotationalRateTorque(const double *sunDirB, const double *sunDirRefB,
double &errorAngle, const double gainParallel,
const double gainOrtho, const double inertiaMatrix[3][3]);
const double gainOrtho);
void calculateAngleErrorTorque(const double *sunDirB, const double *sunDirRefB,
const double gainAlign);