Revert ACS Safe Mode Controller to FLP Design #466
@ -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<double>::mulScalar(cmdParallel, -gainParallel, cmdParallel, 3);
|
||||
VectorOperations<double>::mulScalar(satRotRateParallelB, -gainParallel, cmdParallel, 3);
|
||||
|
||||
// calculate torque for orthogonal rotational rate
|
||||
VectorOperations<double>::mulScalar(satRotRateOrthogonalB, -gainOrtho, cmdOrtho, 3);
|
||||
|
Loading…
x
Reference in New Issue
Block a user