Improve GS PTG #876

Merged
meggert merged 5 commits from gs-ptr-improv into main 2024-03-18 11:04:02 +01:00
Showing only changes of commit 346f4ff9de - Show all commits

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);