New Safe Mode Controller #748

Merged
muellerr merged 31 commits from acs-safe-flp-v2 into main 2023-07-26 11:08:12 +02:00
Showing only changes of commit f736489430 - Show all commits

View File

@ -51,7 +51,7 @@ void FusedRotationEstimation::estimateFusedRotationRateSafe(
susDataProcessed->susVecTot.value, fusedRotRateOrthogonal); susDataProcessed->susVecTot.value, fusedRotRateOrthogonal);
VectorOperations<double>::mulScalar( VectorOperations<double>::mulScalar(
fusedRotRateOrthogonal, fusedRotRateOrthogonal,
pow(VectorOperations<double>::norm(susDataProcessed->susVecTot.value, 2), 2), pow(VectorOperations<double>::norm(susDataProcessed->susVecTot.value, 3), -2),
fusedRotRateOrthogonal, 3); fusedRotRateOrthogonal, 3);
// calculate total rotation rate // calculate total rotation rate