This commit is contained in:
parent
f7c997980c
commit
64d105cf87
@ -424,7 +424,7 @@ void Guidance::comparePtg(double currentQuat[4], double currentSatRotRate[3], do
|
|||||||
// Convert target rotational rate into body RF
|
// Convert target rotational rate into body RF
|
||||||
double errorQuatInv[4] = {0, 0, 0, 0}, targetSatRotRateB[3] = {0, 0, 0};
|
double errorQuatInv[4] = {0, 0, 0, 0}, targetSatRotRateB[3] = {0, 0, 0};
|
||||||
QuaternionOperations::inverse(errorQuat, errorQuatInv);
|
QuaternionOperations::inverse(errorQuat, errorQuatInv);
|
||||||
QuaternionOperations::multiplyVector(errorQuat, targetSatRotRate, targetSatRotRateB);
|
QuaternionOperations::multiplyVector(errorQuatInv, targetSatRotRate, targetSatRotRateB);
|
||||||
// Combine the target and reference satellite rotational rates
|
// Combine the target and reference satellite rotational rates
|
||||||
double combinedRefSatRotRate[3] = {0, 0, 0};
|
double combinedRefSatRotRate[3] = {0, 0, 0};
|
||||||
VectorOperations<double>::add(targetSatRotRate, refSatRotRate, combinedRefSatRotRate, 3);
|
VectorOperations<double>::add(targetSatRotRate, refSatRotRate, combinedRefSatRotRate, 3);
|
||||||
|
Loading…
Reference in New Issue
Block a user