diff --git a/gtsam/slam/InitializePose3.cpp b/gtsam/slam/InitializePose3.cpp index f18380b20..c0e2ef6d9 100644 --- a/gtsam/slam/InitializePose3.cpp +++ b/gtsam/slam/InitializePose3.cpp @@ -235,7 +235,7 @@ Values computeOrientationsGradient(const NonlinearFactorGraph& pose3Graph, const std::cout << "nr of gradient iterations " << it << std::endl; // Return correct rotations - const Rot3& Rref = inverseRot.at(keyAnchor); + const Rot3& Rref = Rot3(); // inverseRot.at(keyAnchor); Values estimateRot; BOOST_FOREACH(const Values::ConstKeyValuePair& key_value, inverseRot) { Key key = key_value.key;