diff --git a/mission/controller/acs/control/SafeCtrl.cpp b/mission/controller/acs/control/SafeCtrl.cpp index 0b732556..544e5402 100644 --- a/mission/controller/acs/control/SafeCtrl.cpp +++ b/mission/controller/acs/control/SafeCtrl.cpp @@ -124,7 +124,7 @@ void SafeCtrl::calculateRotationalRateTorque(const double *sunDirB, const double // calculate torque for orthogonal rotational rate double orthoFactor[3][3] = {{0, 0, 0}, {0, 0, 0}, {0, 0, 0}}; MatrixOperations::multiplyScalar(*inertiaMatrix, gainOrtho, *orthoFactor, 3, 3); - MatrixOperations::multiply(*orthoFactor, satRotRateOrthogonalB, cmdAlign, 3, 3, 1); + MatrixOperations::multiply(*orthoFactor, satRotRateOrthogonalB, cmdOrtho, 3, 3, 1); } void SafeCtrl::calculateAngleErrorTorque(const double *sunDirB, const double *sunDirRefB,