output is now target quaternion

This commit is contained in:
Marius Eggert 2023-02-21 10:38:10 +01:00
parent 5349fb45e3
commit 35ad0a40d3

View File

@ -131,6 +131,10 @@ void Guidance::targetQuatPtgSingleAxis(timeval now, double posSatE[3], double ve
} }
} }
} }
// revert calculated quaternion from qBX to qIX
double quatIB[4] = {0, 0, 0, 1};
QuaternionOperations::inverse(quatBI, quatIB);
QuaternionOperations::multiply(quatIB, targetQuat, targetQuat);
} }
void Guidance::targetQuatPtgThreeAxes(timeval now, double posSatE[3], double velSatE[3], void Guidance::targetQuatPtgThreeAxes(timeval now, double posSatE[3], double velSatE[3],