This commit is contained in:
parent
6efee8d4da
commit
f736489430
@ -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
|
||||||
|
Loading…
x
Reference in New Issue
Block a user