Add fake z kalman update

1 files changed, 2 insertions, 1 deletions

diff --git a/src/body.h b/src/body.h
index b5b2aae..04196d2 100644
--- a/src/body.h
+++ b/src/body.h
@@ -28,8 +28,9 @@ class Body
         Matrix<double,9,9> F(const Matrix<double,9,1> &X, const Vector3d &ang, const Quaternion<double> &q);
         void skewSymmetric(const Vector3d &x, Matrix<double,3,3> &y);
         void H(Matrix<double, 1,9> &H);
-        void h(const Matrix<double,9,1> &X, Matrix<double,1,1> &h);
+        Matrix<double,1,1> h(const Matrix<double,9,1> &X);
         Matrix<double,9,9> Q(double dt);
+        Matrix<double,1,1> R();
 
     protected:
         /* ====================  METHODS       ======================================= */