diff options
Diffstat (limited to 'src/state.h')
-rw-r--r-- | src/state.h | 3 |
1 files changed, 3 insertions, 0 deletions
diff --git a/src/state.h b/src/state.h index 3a17ea5..743f5d8 100644 --- a/src/state.h +++ b/src/state.h @@ -21,6 +21,9 @@ class State /* ==================== OPERATORS ======================================= */ void Pkk1 ( Matrix<double,9,9> &P, const Matrix<double,9,9> &F, const Matrix<double,9,9> &Q ); + void update (Matrix<double,9,1> &X, Matrix<double,9,9> &P, + const Matrix<double,1,9> H, const Matrix<double,1,1> &h, + const Matrix<double,1,1> &z, const Matrix<double,1,1> &R); protected: /* ==================== METHODS ======================================= */ |