Revert ACS Safe Mode Controller to FLP Design #466
@ -123,7 +123,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<double>::multiplyScalar(*inertiaMatrix, gainOrtho, *orthoFactor, 3, 3);
|
||||
MatrixOperations<double>::multiplyScalar(*inertiaMatrix, -gainOrtho, *orthoFactor, 3, 3);
|
||||
MatrixOperations<double>::multiply(*orthoFactor, satRotRateOrthogonalB, cmdOrtho, 3, 3, 1);
|
||||
}
|
||||
|
||||
|
Loading…
x
Reference in New Issue
Block a user