This commit is contained in:
parent
6efee8d4da
commit
f736489430
@ -51,7 +51,7 @@ void FusedRotationEstimation::estimateFusedRotationRateSafe(
|
||||
susDataProcessed->susVecTot.value, fusedRotRateOrthogonal);
|
||||
VectorOperations<double>::mulScalar(
|
||||
fusedRotRateOrthogonal,
|
||||
pow(VectorOperations<double>::norm(susDataProcessed->susVecTot.value, 2), 2),
|
||||
pow(VectorOperations<double>::norm(susDataProcessed->susVecTot.value, 3), -2),
|
||||
fusedRotRateOrthogonal, 3);
|
||||
|
||||
// calculate total rotation rate
|
||||
|
Loading…
x
Reference in New Issue
Block a user