diff --git a/mission/controller/acs/control/SafeCtrl.cpp b/mission/controller/acs/control/SafeCtrl.cpp index 1d2244ae..ce44dbef 100644 --- a/mission/controller/acs/control/SafeCtrl.cpp +++ b/mission/controller/acs/control/SafeCtrl.cpp @@ -116,7 +116,7 @@ void SafeCtrl::calculateRotationalRateTorque(const double *sunDirB, const double double &errorAngle, const double gainParallel, const double gainOrtho) { // calculate torque for parallel rotational rate - VectorOperations::mulScalar(cmdParallel, -gainParallel, cmdParallel, 3); + VectorOperations::mulScalar(satRotRateParallelB, -gainParallel, cmdParallel, 3); // calculate torque for orthogonal rotational rate VectorOperations::mulScalar(satRotRateOrthogonalB, -gainOrtho, cmdOrtho, 3);