From f2a48a3a12475b52e9fa525541eeebf0b3f7c7e8 Mon Sep 17 00:00:00 2001 From: Martin Miller Date: Sat, 18 Mar 2017 15:15:47 -0500 Subject: Update P during imuCallback --- src/body.h | 3 ++- 1 file changed, 2 insertions(+), 1 deletion(-) (limited to 'src/body.h') diff --git a/src/body.h b/src/body.h index 1fc88ff..b5b2aae 100644 --- a/src/body.h +++ b/src/body.h @@ -25,10 +25,11 @@ class Body /* ==================== OPERATORS ======================================= */ void motionModel ( Matrix &X, const Vector3d &acc, const Vector3d &ang, const Quaternion &q, const double dt); - void F(const Matrix &X, const Vector3d &ang, const Quaternion &q); + Matrix F(const Matrix &X, const Vector3d &ang, const Quaternion &q); void skewSymmetric(const Vector3d &x, Matrix &y); void H(Matrix &H); void h(const Matrix &X, Matrix &h); + Matrix Q(double dt); protected: /* ==================== METHODS ======================================= */ -- cgit v1.1