Fix Jacobian of motion model.

This fixes a bug that was present in the pyslam code. The Jacobian of the motion
model needs to be replaced with:
F = I + F*dt

1 files changed, 1 insertions, 1 deletions

diff --git a/src/body.h b/src/body.h
index 5ceae0b..8c3dca3 100644
--- a/src/body.h
+++ b/src/body.h
@@ -29,7 +29,7 @@ class Body
         void vel(const Matrix<double,3,1> &v);
 
         /* ====================  OPERATORS     ======================================= */
-        Matrix<double,9,9> F(const Vector3d &ang, const Quaterniond &q);
+        Matrix<double,9,9> F(const Vector3d &ang, const Quaterniond &q, double dt);
         Matrix<double,1,9> H();
         Matrix<double,1,1> h();
         void motionModel ( const Vector3d &acc, const Vector3d &ang,