12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

added print

release/4.3a0
Frank Dellaert 2012-01-17 19:25:05 +00:00
parent 027ea6ec34
commit 56c3953305
1 changed files with 7 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
gtsam/nonlinear/ExtendedKalmanFilter.h
View File

@ -60,6 +60,13 @@ namespace gtsam {
ExtendedKalmanFilter(T x_initial, ExtendedKalmanFilter(T x_initial,
noiseModel::Gaussian::shared_ptr P_initial); noiseModel::Gaussian::shared_ptr P_initial);
/// print
void print(const std::string& s="") const {
std::cout << s << "\n";
x_.print(s+"x");
priorFactor_->print(s+"density");
}
T predict(const MotionFactor& motionFactor); T predict(const MotionFactor& motionFactor);
T update(const MeasurementFactor& measurementFactor); T update(const MeasurementFactor& measurementFactor);
}; };