diff --git a/gtsam/inference/FactorGraph-inl.h b/gtsam/inference/FactorGraph-inl.h index 14208c679..173f67c2e 100644 --- a/gtsam/inference/FactorGraph-inl.h +++ b/gtsam/inference/FactorGraph-inl.h @@ -22,11 +22,9 @@ #pragma once -#include -#include -#include -#include -#include +#include +#include +#include #include #include @@ -36,9 +34,11 @@ #include #include -#include -#include -#include +#include +#include +#include +#include +#include #define INSTANTIATE_FACTOR_GRAPH(F) \ template class FactorGraph; \ @@ -55,7 +55,7 @@ namespace gtsam { cout << "size: " << size() << endl; for (size_t i = 0; i < factors_.size(); i++) { stringstream ss; - ss << "factor " << i; + ss << "factor " << i << ": "; if (factors_[i] != NULL) factors_[i]->print(ss.str()); } } diff --git a/gtsam/slam/PriorFactor.h b/gtsam/slam/PriorFactor.h index 5bb22506f..33f3d1aef 100644 --- a/gtsam/slam/PriorFactor.h +++ b/gtsam/slam/PriorFactor.h @@ -15,8 +15,8 @@ **/ #pragma once -#include #include +#include namespace gtsam { @@ -63,7 +63,7 @@ namespace gtsam { /** print */ virtual void print(const std::string& s) const { - std::cout << s << ": PriorFactor(" << (std::string) this->key_ << ")\n"; + std::cout << s << "PriorFactor(" << (std::string) this->key_ << ")\n"; prior_.print(" prior"); this->noiseModel_->print(" noise model"); }