fixed wrong sign for ortho torque calculation

This commit is contained in:
2023-04-13 20:21:12 +02:00
parent 9861772c38
commit 7f3f99c6aa

@ -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);
}