diff options
| author | Martin Miller | 2017-03-29 15:17:19 -0500 |
|---|---|---|
| committer | Martin Miller | 2017-03-29 15:17:19 -0500 |
| commit | d9254650bd6b8998dec87695ae4875e9f0a4b2da (patch) | |
| tree | 4f6bfd02d25f18c51dbaa5313b3104e486f241ad /src/state.h | |
| parent | 5a7a8e0fe6923c4323aadf9951c44f06fe0906d2 (diff) | |
| download | refslam-d9254650bd6b8998dec87695ae4875e9f0a4b2da.zip refslam-d9254650bd6b8998dec87695ae4875e9f0a4b2da.tar.gz | |
Add new update methods.
But they don't really work.
Diffstat (limited to 'src/state.h')
| -rw-r--r-- | src/state.h | 7 |
1 files changed, 6 insertions, 1 deletions
diff --git a/src/state.h b/src/state.h index 0e1fe90..11bfa46 100644 --- a/src/state.h +++ b/src/state.h @@ -9,9 +9,11 @@ #include "feature.h" #include "types.h" -#define MAXFEATURES 30 +#define MAXFEATURES 50 //#define FASTMOTIONMODEL // Uncomment this to perform motion model update on all features at once #define FULLS // Comment out to treat each measurement independently. +//#define BLOCKSI +//#define MEAS1 using Eigen::Dynamic; using Eigen::Matrix; using Eigen::MatrixXd; @@ -42,7 +44,10 @@ class State int Hrows( const std::vector<measurement_t> &z ); MatrixXd Q(double dt); MatrixXd R( const std::vector<measurement_t> &z ); + MatrixXd blockSI( const std::vector<measurement_t> &z, const Quaterniond &q); Matrix<double,9,9> Pxx(); + Matrix<double,9,3> Pxy(int id); + Matrix<double,3,3> Pyy(int id); Matrix<double,Dynamic,6> L(); /* ==================== MUTATORS ======================================= */ |