fixed torque parallel
All checks were successful
EIVE/eive-obsw/pipeline/pr-develop This commit looks good

This commit is contained in:
Marius Eggert 2023-04-13 16:28:54 +02:00
parent 673826b131
commit 6b976f1046

View File

@ -116,7 +116,7 @@ void SafeCtrl::calculateRotationalRateTorque(const double *sunDirB, const double
double &errorAngle, const double gainParallel, double &errorAngle, const double gainParallel,
const double gainOrtho) { const double gainOrtho) {
// calculate torque for parallel rotational rate // calculate torque for parallel rotational rate
VectorOperations<double>::mulScalar(cmdParallel, -gainParallel, cmdParallel, 3); VectorOperations<double>::mulScalar(satRotRateParallelB, -gainParallel, cmdParallel, 3);
// calculate torque for orthogonal rotational rate // calculate torque for orthogonal rotational rate
VectorOperations<double>::mulScalar(satRotRateOrthogonalB, -gainOrtho, cmdOrtho, 3); VectorOperations<double>::mulScalar(satRotRateOrthogonalB, -gainOrtho, cmdOrtho, 3);