diff --git a/slam/simulated2D.h b/slam/simulated2D.h index df0778089..39d30470b 100644 --- a/slam/simulated2D.h +++ b/slam/simulated2D.h @@ -57,14 +57,14 @@ namespace gtsam { template struct GenericPrior: public NonlinearFactor1 { typedef boost::shared_ptr > shared_ptr; - typedef typename PoseKey::Value_t Point; - Point z_; + typedef typename Key::Value_t Pose; + Pose z_; - GenericPrior(const Point& z, const SharedGaussian& model, const Key& key) : + GenericPrior(const Pose& z, const SharedGaussian& model, const Key& key) : NonlinearFactor1 (model, key), z_(z) { } - Vector evaluateError(const Point& x, boost::optional H = + Vector evaluateError(const Pose& x, boost::optional H = boost::none) const { return (prior(x, H) - z_).vector(); } @@ -77,7 +77,7 @@ namespace gtsam { template struct GenericOdometry: public NonlinearFactor2 { typedef boost::shared_ptr > shared_ptr; - typedef typename PoseKey::Value_t Pose; + typedef typename Key::Value_t Pose; Pose z_; GenericOdometry(const Pose& z, const SharedGaussian& model, @@ -99,8 +99,8 @@ namespace gtsam { class GenericMeasurement: public NonlinearFactor2 { public: typedef boost::shared_ptr > shared_ptr; - typedef typename PoseKey::Value_t Pose; - typedef typename PointKey::Value_t Point; + typedef typename XKey::Value_t Pose; + typedef typename LKey::Value_t Point; Point z_;