prevent sign jump
Some checks are pending
EIVE/eive-obsw/pipeline/head Build started...

This commit is contained in:
Marius Eggert 2024-03-13 16:59:55 +01:00
parent ad5282ca4a
commit 346f4ff9de

View File

@ -244,6 +244,8 @@ void Guidance::limitReferenceRotation(const double xAxisIX[3], double quatIX[4])
return; return;
} }
QuaternionOperations::preventSignJump(quatIX, quatIXprev);
// check required rotation and return if below limit // check required rotation and return if below limit
double quatXprevX[4] = {0, 0, 0, 0}, quatXprevI[4] = {0, 0, 0, 0}; double quatXprevX[4] = {0, 0, 0, 0}, quatXprevI[4] = {0, 0, 0, 0};
QuaternionOperations::inverse(quatIXprev, quatXprevI); QuaternionOperations::inverse(quatIXprev, quatXprevI);