diff --git a/gtsam/slam/SmartFactorBase.h b/gtsam/slam/SmartFactorBase.h index ed60b1a4b..d9e7b9819 100644 --- a/gtsam/slam/SmartFactorBase.h +++ b/gtsam/slam/SmartFactorBase.h @@ -76,6 +76,7 @@ public: typedef boost::shared_ptr shared_ptr; /// shorthand for a pinhole camera + typedef CAMERA Camera; typedef std::vector Cameras; /** @@ -134,13 +135,14 @@ public: * The noise is assumed to be the same for all measurements */ // **************************************************************************************************** -// void add(const SfM_Track& trackToAdd, const SharedNoiseModel& noise) { -// for (size_t k = 0; k < trackToAdd.number_measurements(); k++) { -// this->measured_.push_back(trackToAdd.measurements[k].second); -// this->keys_.push_back(trackToAdd.measurements[k].first); -// this->noise_.push_back(noise); -// } -// } + template + void add(const SFM_TRACK& trackToAdd, const SharedNoiseModel& noise) { + for (size_t k = 0; k < trackToAdd.number_measurements(); k++) { + this->measured_.push_back(trackToAdd.measurements[k].second); + this->keys_.push_back(trackToAdd.measurements[k].first); + this->noise_.push_back(noise); + } + } /** return the measurements */ const std::vector& measured() const {