diff --git a/gtsam/slam/PriorFactor.h b/gtsam/slam/PriorFactor.h index 8bb7a3ab8..5b085652f 100644 --- a/gtsam/slam/PriorFactor.h +++ b/gtsam/slam/PriorFactor.h @@ -18,6 +18,8 @@ #include #include +#include + namespace gtsam { /** @@ -70,10 +72,14 @@ namespace gtsam { /** implement functions needed for Testable */ /** print */ - virtual void print(const std::string& s, const KeyFormatter& keyFormatter = DefaultKeyFormatter) const { + virtual void print(const std::string& s, const KeyFormatter& keyFormatter = + DefaultKeyFormatter) const { std::cout << s << "PriorFactor on " << keyFormatter(this->key()) << "\n"; traits::Print(prior_, " prior mean: "); - this->noiseModel_->print(" noise model: "); + if (this->noiseModel_) + this->noiseModel_->print(" noise model: "); + else + std::cout << "no noise model" << std::endl; } /** equals */