GTSAM is a library of C++ classes that implement smoothing and mapping (SAM) in robotics and vision