added print

2012-01-17 19:25:05 +00:00 · 2012-01-17 19:25:05 +00:00 · 56c3953305
parent 027ea6ec34
commit 56c3953305
1 changed files with 7 additions and 0 deletions
--- a/gtsam/nonlinear/ExtendedKalmanFilter.h
+++ b/gtsam/nonlinear/ExtendedKalmanFilter.h
@ -60,6 +60,13 @@ namespace gtsam {
 		ExtendedKalmanFilter(T x_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 update(const MeasurementFactor& measurementFactor);
 	};