MPSoC Overhaul #892
@ -16,6 +16,10 @@ will consitute of a breaking change warranting a new major release:
|
|||||||
|
|
||||||
# [unreleased]
|
# [unreleased]
|
||||||
|
|
||||||
|
## Fixed
|
||||||
|
|
||||||
|
- Fixed calculation for target rotation rate during pointing modes.
|
||||||
|
|
||||||
## Changed
|
## Changed
|
||||||
|
|
||||||
- Reworked MPSoC handler to be compatible to new MPSoC software image and use
|
- Reworked MPSoC handler to be compatible to new MPSoC software image and use
|
||||||
@ -32,6 +36,8 @@ will consitute of a breaking change warranting a new major release:
|
|||||||
|
|
||||||
# [v7.8.1] 2024-04-11
|
# [v7.8.1] 2024-04-11
|
||||||
|
|
||||||
|
## Fixed
|
||||||
|
|
||||||
- Reverted fix for wrong order in quaternion multiplication for computation of the error quaternion.
|
- Reverted fix for wrong order in quaternion multiplication for computation of the error quaternion.
|
||||||
|
|
||||||
# [v7.8.0] 2024-04-10
|
# [v7.8.0] 2024-04-10
|
||||||
|
@ -232,6 +232,7 @@ void Guidance::targetRotationRate(const double timeDelta, double quatIX[4], doub
|
|||||||
}
|
}
|
||||||
if (timeDelta != 0.0) {
|
if (timeDelta != 0.0) {
|
||||||
QuaternionOperations::rotationFromQuaternions(quatIX, quatIXprev, timeDelta, refSatRate);
|
QuaternionOperations::rotationFromQuaternions(quatIX, quatIXprev, timeDelta, refSatRate);
|
||||||
|
VectorOperations<double>::mulScalar(refSatRate, -1, refSatRate, 3);
|
||||||
} else {
|
} else {
|
||||||
std::memcpy(refSatRate, ZERO_VEC3, 3 * sizeof(double));
|
std::memcpy(refSatRate, ZERO_VEC3, 3 * sizeof(double));
|
||||||
}
|
}
|
||||||
@ -315,9 +316,9 @@ void Guidance::comparePtg(double currentQuat[4], double currentSatRotRate[3], do
|
|||||||
|
|
||||||
// Calculate error satellite rotational rate
|
// Calculate error satellite rotational rate
|
||||||
// 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 targetSatRotRateB[3] = {0, 0, 0};
|
||||||
QuaternionOperations::inverse(errorQuat, errorQuatInv);
|
QuaternionOperations::multiplyVector(currentQuat, targetSatRotRate, targetSatRotRateB);
|
||||||
QuaternionOperations::multiplyVector(errorQuatInv, targetSatRotRate, targetSatRotRateB);
|
VectorOperations<double>::copy(targetSatRotRateB, targetSatRotRate, 3);
|
||||||
// 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