diff --git a/gtsam_unstable/examples/SmartProjectionFactorExample_kitti.cpp b/gtsam_unstable/examples/SmartProjectionFactorExample_kitti.cpp index d762ed7d7..1b0b32ff9 100644 --- a/gtsam_unstable/examples/SmartProjectionFactorExample_kitti.cpp +++ b/gtsam_unstable/examples/SmartProjectionFactorExample_kitti.cpp @@ -162,6 +162,7 @@ int main(int argc, char** argv) { // Load values from VO camera poses output gtsam::Values::shared_ptr loaded_values = loadPoseValues(input_dir+"camera_poses.txt"); graph.add(Pose3Prior(X(0),loaded_values->at(X(0)), prior_model)); + graph.add(Pose3Prior(X(1),loaded_values->at(X(1)), prior_model)); //graph.print("thegraph"); // Read in kitti dataset