diff options
author | Martin Miller | 2017-03-18 23:01:15 -0500 |
---|---|---|
committer | Martin Miller | 2017-03-18 23:01:15 -0500 |
commit | 0862825c7e37a45c343559b7c18a21fc0bb965f9 (patch) | |
tree | 4f9c8729ff6a137a426b5ed017773bf698f0a641 /src/body.h | |
parent | f098647e69c1fe3a3a20599405962e7e1f3c7c0f (diff) | |
download | refslam-0862825c7e37a45c343559b7c18a21fc0bb965f9.zip refslam-0862825c7e37a45c343559b7c18a21fc0bb965f9.tar.gz |
Start Feature::h() method
Diffstat (limited to 'src/body.h')
-rw-r--r-- | src/body.h | 6 |
1 files changed, 3 insertions, 3 deletions
@@ -6,7 +6,7 @@ using Eigen::Matrix; using Eigen::Vector3d; -using Eigen::Quaternion; +using Eigen::Quaterniond; /* * ===================================================================================== @@ -29,11 +29,11 @@ class Body void vel(const Matrix<double,3,1> &v); /* ==================== OPERATORS ======================================= */ - Matrix<double,9,9> F(const Vector3d &ang, const Quaternion<double> &q); + Matrix<double,9,9> F(const Vector3d &ang, const Quaterniond &q); Matrix<double,1,9> H(); Matrix<double,1,1> h(); void motionModel ( const Vector3d &acc, const Vector3d &ang, - const Quaternion<double> &q, const double dt); + const Quaterniond &q, const double dt); Matrix<double,9,9> Q(double dt); Matrix<double,1,1> R(); Matrix<double,1,1> S(const Matrix<double,9,9> &P); |