diff --git a/gtsam/linear/JacobianFactor.cpp b/gtsam/linear/JacobianFactor.cpp index ce3803703..e13da78e1 100644 --- a/gtsam/linear/JacobianFactor.cpp +++ b/gtsam/linear/JacobianFactor.cpp @@ -16,6 +16,7 @@ * @created Dec 8, 2010 */ +#include #include #include #include @@ -242,7 +243,7 @@ namespace gtsam { void JacobianFactor::permuteWithInverse(const Permutation& inversePermutation) { // Build a map from the new variable indices to the old slot positions. - typedef map, boost::fast_pool_allocator > > SourceSlots; + typedef FastMap SourceSlots; SourceSlots sourceSlots; for(size_t j=0; j= nrFrontals); assertInvariants(); - static const bool debug = false; + const bool debug = ISDEBUG("JacobianFactor::eliminate"); if(debug) cout << "Eliminating " << nrFrontals << " frontal variables" << endl; if(debug) this->print("Eliminating JacobianFactor: "); @@ -553,7 +554,7 @@ namespace gtsam { /* ************************************************************************* */ JacobianFactor::shared_ptr JacobianFactor::Combine(const FactorGraph& factors, const VariableSlots& variableSlots) { - static const bool debug = false; + const bool debug = ISDEBUG("JacobianFactor::Combine"); if(debug) factors.print("Combining factors: "); diff --git a/gtsam/linear/JacobianFactor.h b/gtsam/linear/JacobianFactor.h index 38cd88caf..caf678171 100644 --- a/gtsam/linear/JacobianFactor.h +++ b/gtsam/linear/JacobianFactor.h @@ -126,7 +126,7 @@ namespace gtsam { virtual void permuteWithInverse(const Permutation& inversePermutation); /** - * return the number of rows in the corresponding linear system + * return the number of columns in the corresponding linear system */ size_t size1() const { return Ab_.size1(); }