fixed torque parallel
All checks were successful
EIVE/eive-obsw/pipeline/pr-develop This commit looks good
All checks were successful
EIVE/eive-obsw/pipeline/pr-develop This commit looks good
This commit is contained in:
parent
673826b131
commit
6b976f1046
@ -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);
|
||||||
|
Loading…
Reference in New Issue
Block a user