diff options
Diffstat (limited to 'src/state.cpp')
| -rw-r--r-- | src/state.cpp | 4 |
1 files changed, 2 insertions, 2 deletions
diff --git a/src/state.cpp b/src/state.cpp index 8b69ca2..0bae8e7 100644 --- a/src/state.cpp +++ b/src/state.cpp @@ -1024,9 +1024,9 @@ State::qhat ( const Quaterniond &q ) void -State::quaternion_covariance ( ) +State::quaternion_covariance ( const Matrix<double,4,4> &covq ) { - P.block<4,4>(6,6) = 1e-12*Matrix<double,4,4>::Identity(); + P.block<4,4>(6,6) = covq; return ; } /* ----- end of method State::quaternion_covariance ----- */ |