From 7fa3b5cc96a1e7d91a6bd3e5338dcbb3acf8c8c6 Mon Sep 17 00:00:00 2001 From: lcarlone Date: Sat, 6 Nov 2021 19:43:45 -0400 Subject: [PATCH] added variable in loop --- gtsam/slam/SmartProjectionRigFactor.h | 5 +++-- 1 file changed, 3 insertions(+), 2 deletions(-) diff --git a/gtsam/slam/SmartProjectionRigFactor.h b/gtsam/slam/SmartProjectionRigFactor.h index 4bfd56695..f4a72694c 100644 --- a/gtsam/slam/SmartProjectionRigFactor.h +++ b/gtsam/slam/SmartProjectionRigFactor.h @@ -232,12 +232,13 @@ class SmartProjectionRigFactor : public SmartProjectionFactor { typename Base::Cameras cameras; cameras.reserve(nonUniqueKeys_.size()); // preallocate for (size_t i = 0; i < nonUniqueKeys_.size(); i++) { + const typename Base::Camera& camera_i = cameraRig_[cameraIds_[i]]; const Pose3 world_P_sensor_i = values.at(nonUniqueKeys_[i]) // = world_P_body - * cameraRig_[cameraIds_[i]].pose(); // = body_P_cam_i + * camera_i.pose(); // = body_P_cam_i cameras.emplace_back(world_P_sensor_i, make_shared( - cameraRig_[cameraIds_[i]].calibration())); + camera_i.calibration())); } return cameras; }