diff --git a/gtsam/slam/GeneralSFMFactor.h b/gtsam/slam/GeneralSFMFactor.h index 674d4e3f9..4f1f48958 100644 --- a/gtsam/slam/GeneralSFMFactor.h +++ b/gtsam/slam/GeneralSFMFactor.h @@ -83,7 +83,7 @@ namespace gtsam { boost::optional H1=boost::none, boost::optional H2=boost::none) const { try { - Point2 reprojError(camera.project2(point,H1,H2) - z_); + Point2 reprojError(camera.project2(point,H1,H2) - measured_); return reprojError.vector(); } catch( CheiralityException& e) {