@@ -170,144 +170,144 @@ class Values {
170170
171171 // The order is important: Vector has to precede Point2/Point3 so `atVector`
172172 // can work for those fixed-size vectors.
173- void insert (size_t j, Vector vector);
174- void insert (size_t j, Matrix matrix);
175- void insert (size_t j, const gtsam::Point2& point2);
176- void insert (size_t j, const gtsam::Point3& point3);
177- void insert (size_t j, const gtsam::Rot2& rot2);
178- void insert (size_t j, const gtsam::Pose2& pose2);
179- void insert (size_t j, const gtsam::SO3& R);
180- void insert (size_t j, const gtsam::SO4& Q);
181- void insert (size_t j, const gtsam::SOn& P);
182- void insert (size_t j, const gtsam::Rot3& rot3);
183- void insert (size_t j, const gtsam::Pose3& pose3);
184- void insert (size_t j, const gtsam::Unit3& unit3);
185- void insert (size_t j, const gtsam::Cal3_S2& cal3_s2);
186- void insert (size_t j, const gtsam::Cal3DS2& cal3ds2);
187- void insert (size_t j, const gtsam::Cal3Bundler& cal3bundler);
188- void insert (size_t j, const gtsam::Cal3Fisheye& cal3fisheye);
189- void insert (size_t j, const gtsam::Cal3Unified& cal3unified);
190- void insert (size_t j, const gtsam::EssentialMatrix& essential_matrix);
191- void insert (size_t j, const gtsam::PinholeCamera<gtsam::Cal3_S2>& camera);
192- void insert (size_t j, const gtsam::PinholeCamera<gtsam::Cal3Bundler>& camera);
193- void insert (size_t j, const gtsam::PinholeCamera<gtsam::Cal3Fisheye>& camera);
194- void insert (size_t j, const gtsam::PinholeCamera<gtsam::Cal3Unified>& camera);
195- void insert (size_t j, const gtsam::PinholePose<gtsam::Cal3_S2>& camera);
196- void insert (size_t j, const gtsam::PinholePose<gtsam::Cal3Bundler>& camera);
197- void insert (size_t j, const gtsam::PinholePose<gtsam::Cal3Fisheye>& camera);
198- void insert (size_t j, const gtsam::PinholePose<gtsam::Cal3Unified>& camera);
199- void insert (size_t j, const gtsam::imuBias::ConstantBias& constant_bias);
200- void insert (size_t j, const gtsam::NavState& nav_state);
201- void insert (size_t j, double c);
202- void insert (size_t j, const gtsam::ParameterMatrix<1 >& X);
203- void insert (size_t j, const gtsam::ParameterMatrix<2 >& X);
204- void insert (size_t j, const gtsam::ParameterMatrix<3 >& X);
205- void insert (size_t j, const gtsam::ParameterMatrix<4 >& X);
206- void insert (size_t j, const gtsam::ParameterMatrix<5 >& X);
207- void insert (size_t j, const gtsam::ParameterMatrix<6 >& X);
208- void insert (size_t j, const gtsam::ParameterMatrix<7 >& X);
209- void insert (size_t j, const gtsam::ParameterMatrix<8 >& X);
210- void insert (size_t j, const gtsam::ParameterMatrix<9 >& X);
211- void insert (size_t j, const gtsam::ParameterMatrix<10 >& X);
212- void insert (size_t j, const gtsam::ParameterMatrix<11 >& X);
213- void insert (size_t j, const gtsam::ParameterMatrix<12 >& X);
214- void insert (size_t j, const gtsam::ParameterMatrix<13 >& X);
215- void insert (size_t j, const gtsam::ParameterMatrix<14 >& X);
216- void insert (size_t j, const gtsam::ParameterMatrix<15 >& X);
173+ void insert (gtsam::Key j, Vector vector);
174+ void insert (gtsam::Key j, Matrix matrix);
175+ void insert (gtsam::Key j, const gtsam::Point2& point2);
176+ void insert (gtsam::Key j, const gtsam::Point3& point3);
177+ void insert (gtsam::Key j, const gtsam::Rot2& rot2);
178+ void insert (gtsam::Key j, const gtsam::Pose2& pose2);
179+ void insert (gtsam::Key j, const gtsam::SO3& R);
180+ void insert (gtsam::Key j, const gtsam::SO4& Q);
181+ void insert (gtsam::Key j, const gtsam::SOn& P);
182+ void insert (gtsam::Key j, const gtsam::Rot3& rot3);
183+ void insert (gtsam::Key j, const gtsam::Pose3& pose3);
184+ void insert (gtsam::Key j, const gtsam::Unit3& unit3);
185+ void insert (gtsam::Key j, const gtsam::Cal3_S2& cal3_s2);
186+ void insert (gtsam::Key j, const gtsam::Cal3DS2& cal3ds2);
187+ void insert (gtsam::Key j, const gtsam::Cal3Bundler& cal3bundler);
188+ void insert (gtsam::Key j, const gtsam::Cal3Fisheye& cal3fisheye);
189+ void insert (gtsam::Key j, const gtsam::Cal3Unified& cal3unified);
190+ void insert (gtsam::Key j, const gtsam::EssentialMatrix& essential_matrix);
191+ void insert (gtsam::Key j, const gtsam::PinholeCamera<gtsam::Cal3_S2>& camera);
192+ void insert (gtsam::Key j, const gtsam::PinholeCamera<gtsam::Cal3Bundler>& camera);
193+ void insert (gtsam::Key j, const gtsam::PinholeCamera<gtsam::Cal3Fisheye>& camera);
194+ void insert (gtsam::Key j, const gtsam::PinholeCamera<gtsam::Cal3Unified>& camera);
195+ void insert (gtsam::Key j, const gtsam::PinholePose<gtsam::Cal3_S2>& camera);
196+ void insert (gtsam::Key j, const gtsam::PinholePose<gtsam::Cal3Bundler>& camera);
197+ void insert (gtsam::Key j, const gtsam::PinholePose<gtsam::Cal3Fisheye>& camera);
198+ void insert (gtsam::Key j, const gtsam::PinholePose<gtsam::Cal3Unified>& camera);
199+ void insert (gtsam::Key j, const gtsam::imuBias::ConstantBias& constant_bias);
200+ void insert (gtsam::Key j, const gtsam::NavState& nav_state);
201+ void insert (gtsam::Key j, double c);
202+ void insert (gtsam::Key j, const gtsam::ParameterMatrix<1 >& X);
203+ void insert (gtsam::Key j, const gtsam::ParameterMatrix<2 >& X);
204+ void insert (gtsam::Key j, const gtsam::ParameterMatrix<3 >& X);
205+ void insert (gtsam::Key j, const gtsam::ParameterMatrix<4 >& X);
206+ void insert (gtsam::Key j, const gtsam::ParameterMatrix<5 >& X);
207+ void insert (gtsam::Key j, const gtsam::ParameterMatrix<6 >& X);
208+ void insert (gtsam::Key j, const gtsam::ParameterMatrix<7 >& X);
209+ void insert (gtsam::Key j, const gtsam::ParameterMatrix<8 >& X);
210+ void insert (gtsam::Key j, const gtsam::ParameterMatrix<9 >& X);
211+ void insert (gtsam::Key j, const gtsam::ParameterMatrix<10 >& X);
212+ void insert (gtsam::Key j, const gtsam::ParameterMatrix<11 >& X);
213+ void insert (gtsam::Key j, const gtsam::ParameterMatrix<12 >& X);
214+ void insert (gtsam::Key j, const gtsam::ParameterMatrix<13 >& X);
215+ void insert (gtsam::Key j, const gtsam::ParameterMatrix<14 >& X);
216+ void insert (gtsam::Key j, const gtsam::ParameterMatrix<15 >& X);
217217
218218 template <T = {gtsam::Point2,
219219 gtsam::Point3}>
220- void insert (size_t j, const T& val);
221-
222- void update (size_t j, const gtsam::Point2& point2);
223- void update (size_t j, const gtsam::Point3& point3);
224- void update (size_t j, const gtsam::Rot2& rot2);
225- void update (size_t j, const gtsam::Pose2& pose2);
226- void update (size_t j, const gtsam::SO3& R);
227- void update (size_t j, const gtsam::SO4& Q);
228- void update (size_t j, const gtsam::SOn& P);
229- void update (size_t j, const gtsam::Rot3& rot3);
230- void update (size_t j, const gtsam::Pose3& pose3);
231- void update (size_t j, const gtsam::Unit3& unit3);
232- void update (size_t j, const gtsam::Cal3_S2& cal3_s2);
233- void update (size_t j, const gtsam::Cal3DS2& cal3ds2);
234- void update (size_t j, const gtsam::Cal3Bundler& cal3bundler);
235- void update (size_t j, const gtsam::Cal3Fisheye& cal3fisheye);
236- void update (size_t j, const gtsam::Cal3Unified& cal3unified);
237- void update (size_t j, const gtsam::EssentialMatrix& essential_matrix);
238- void update (size_t j, const gtsam::PinholeCamera<gtsam::Cal3_S2>& camera);
239- void update (size_t j, const gtsam::PinholeCamera<gtsam::Cal3Bundler>& camera);
240- void update (size_t j, const gtsam::PinholeCamera<gtsam::Cal3Fisheye>& camera);
241- void update (size_t j, const gtsam::PinholeCamera<gtsam::Cal3Unified>& camera);
242- void update (size_t j, const gtsam::PinholePose<gtsam::Cal3_S2>& camera);
243- void update (size_t j, const gtsam::PinholePose<gtsam::Cal3Bundler>& camera);
244- void update (size_t j, const gtsam::PinholePose<gtsam::Cal3Fisheye>& camera);
245- void update (size_t j, const gtsam::PinholePose<gtsam::Cal3Unified>& camera);
246- void update (size_t j, const gtsam::imuBias::ConstantBias& constant_bias);
247- void update (size_t j, const gtsam::NavState& nav_state);
248- void update (size_t j, Vector vector);
249- void update (size_t j, Matrix matrix);
250- void update (size_t j, double c);
251- void update (size_t j, const gtsam::ParameterMatrix<1 >& X);
252- void update (size_t j, const gtsam::ParameterMatrix<2 >& X);
253- void update (size_t j, const gtsam::ParameterMatrix<3 >& X);
254- void update (size_t j, const gtsam::ParameterMatrix<4 >& X);
255- void update (size_t j, const gtsam::ParameterMatrix<5 >& X);
256- void update (size_t j, const gtsam::ParameterMatrix<6 >& X);
257- void update (size_t j, const gtsam::ParameterMatrix<7 >& X);
258- void update (size_t j, const gtsam::ParameterMatrix<8 >& X);
259- void update (size_t j, const gtsam::ParameterMatrix<9 >& X);
260- void update (size_t j, const gtsam::ParameterMatrix<10 >& X);
261- void update (size_t j, const gtsam::ParameterMatrix<11 >& X);
262- void update (size_t j, const gtsam::ParameterMatrix<12 >& X);
263- void update (size_t j, const gtsam::ParameterMatrix<13 >& X);
264- void update (size_t j, const gtsam::ParameterMatrix<14 >& X);
265- void update (size_t j, const gtsam::ParameterMatrix<15 >& X);
266-
267- void insert_or_assign (size_t j, const gtsam::Point2& point2);
268- void insert_or_assign (size_t j, const gtsam::Point3& point3);
269- void insert_or_assign (size_t j, const gtsam::Rot2& rot2);
270- void insert_or_assign (size_t j, const gtsam::Pose2& pose2);
271- void insert_or_assign (size_t j, const gtsam::SO3& R);
272- void insert_or_assign (size_t j, const gtsam::SO4& Q);
273- void insert_or_assign (size_t j, const gtsam::SOn& P);
274- void insert_or_assign (size_t j, const gtsam::Rot3& rot3);
275- void insert_or_assign (size_t j, const gtsam::Pose3& pose3);
276- void insert_or_assign (size_t j, const gtsam::Unit3& unit3);
277- void insert_or_assign (size_t j, const gtsam::Cal3_S2& cal3_s2);
278- void insert_or_assign (size_t j, const gtsam::Cal3DS2& cal3ds2);
279- void insert_or_assign (size_t j, const gtsam::Cal3Bundler& cal3bundler);
280- void insert_or_assign (size_t j, const gtsam::Cal3Fisheye& cal3fisheye);
281- void insert_or_assign (size_t j, const gtsam::Cal3Unified& cal3unified);
282- void insert_or_assign (size_t j, const gtsam::EssentialMatrix& essential_matrix);
283- void insert_or_assign (size_t j, const gtsam::PinholeCamera<gtsam::Cal3_S2>& camera);
284- void insert_or_assign (size_t j, const gtsam::PinholeCamera<gtsam::Cal3Bundler>& camera);
285- void insert_or_assign (size_t j, const gtsam::PinholeCamera<gtsam::Cal3Fisheye>& camera);
286- void insert_or_assign (size_t j, const gtsam::PinholeCamera<gtsam::Cal3Unified>& camera);
287- void insert_or_assign (size_t j, const gtsam::PinholePose<gtsam::Cal3_S2>& camera);
288- void insert_or_assign (size_t j, const gtsam::PinholePose<gtsam::Cal3Bundler>& camera);
289- void insert_or_assign (size_t j, const gtsam::PinholePose<gtsam::Cal3Fisheye>& camera);
290- void insert_or_assign (size_t j, const gtsam::PinholePose<gtsam::Cal3Unified>& camera);
291- void insert_or_assign (size_t j, const gtsam::imuBias::ConstantBias& constant_bias);
292- void insert_or_assign (size_t j, const gtsam::NavState& nav_state);
293- void insert_or_assign (size_t j, Vector vector);
294- void insert_or_assign (size_t j, Matrix matrix);
295- void insert_or_assign (size_t j, double c);
296- void insert_or_assign (size_t j, const gtsam::ParameterMatrix<1 >& X);
297- void insert_or_assign (size_t j, const gtsam::ParameterMatrix<2 >& X);
298- void insert_or_assign (size_t j, const gtsam::ParameterMatrix<3 >& X);
299- void insert_or_assign (size_t j, const gtsam::ParameterMatrix<4 >& X);
300- void insert_or_assign (size_t j, const gtsam::ParameterMatrix<5 >& X);
301- void insert_or_assign (size_t j, const gtsam::ParameterMatrix<6 >& X);
302- void insert_or_assign (size_t j, const gtsam::ParameterMatrix<7 >& X);
303- void insert_or_assign (size_t j, const gtsam::ParameterMatrix<8 >& X);
304- void insert_or_assign (size_t j, const gtsam::ParameterMatrix<9 >& X);
305- void insert_or_assign (size_t j, const gtsam::ParameterMatrix<10 >& X);
306- void insert_or_assign (size_t j, const gtsam::ParameterMatrix<11 >& X);
307- void insert_or_assign (size_t j, const gtsam::ParameterMatrix<12 >& X);
308- void insert_or_assign (size_t j, const gtsam::ParameterMatrix<13 >& X);
309- void insert_or_assign (size_t j, const gtsam::ParameterMatrix<14 >& X);
310- void insert_or_assign (size_t j, const gtsam::ParameterMatrix<15 >& X);
220+ void insert (gtsam::Key j, const T& val);
221+
222+ void update (gtsam::Key j, const gtsam::Point2& point2);
223+ void update (gtsam::Key j, const gtsam::Point3& point3);
224+ void update (gtsam::Key j, const gtsam::Rot2& rot2);
225+ void update (gtsam::Key j, const gtsam::Pose2& pose2);
226+ void update (gtsam::Key j, const gtsam::SO3& R);
227+ void update (gtsam::Key j, const gtsam::SO4& Q);
228+ void update (gtsam::Key j, const gtsam::SOn& P);
229+ void update (gtsam::Key j, const gtsam::Rot3& rot3);
230+ void update (gtsam::Key j, const gtsam::Pose3& pose3);
231+ void update (gtsam::Key j, const gtsam::Unit3& unit3);
232+ void update (gtsam::Key j, const gtsam::Cal3_S2& cal3_s2);
233+ void update (gtsam::Key j, const gtsam::Cal3DS2& cal3ds2);
234+ void update (gtsam::Key j, const gtsam::Cal3Bundler& cal3bundler);
235+ void update (gtsam::Key j, const gtsam::Cal3Fisheye& cal3fisheye);
236+ void update (gtsam::Key j, const gtsam::Cal3Unified& cal3unified);
237+ void update (gtsam::Key j, const gtsam::EssentialMatrix& essential_matrix);
238+ void update (gtsam::Key j, const gtsam::PinholeCamera<gtsam::Cal3_S2>& camera);
239+ void update (gtsam::Key j, const gtsam::PinholeCamera<gtsam::Cal3Bundler>& camera);
240+ void update (gtsam::Key j, const gtsam::PinholeCamera<gtsam::Cal3Fisheye>& camera);
241+ void update (gtsam::Key j, const gtsam::PinholeCamera<gtsam::Cal3Unified>& camera);
242+ void update (gtsam::Key j, const gtsam::PinholePose<gtsam::Cal3_S2>& camera);
243+ void update (gtsam::Key j, const gtsam::PinholePose<gtsam::Cal3Bundler>& camera);
244+ void update (gtsam::Key j, const gtsam::PinholePose<gtsam::Cal3Fisheye>& camera);
245+ void update (gtsam::Key j, const gtsam::PinholePose<gtsam::Cal3Unified>& camera);
246+ void update (gtsam::Key j, const gtsam::imuBias::ConstantBias& constant_bias);
247+ void update (gtsam::Key j, const gtsam::NavState& nav_state);
248+ void update (gtsam::Key j, Vector vector);
249+ void update (gtsam::Key j, Matrix matrix);
250+ void update (gtsam::Key j, double c);
251+ void update (gtsam::Key j, const gtsam::ParameterMatrix<1 >& X);
252+ void update (gtsam::Key j, const gtsam::ParameterMatrix<2 >& X);
253+ void update (gtsam::Key j, const gtsam::ParameterMatrix<3 >& X);
254+ void update (gtsam::Key j, const gtsam::ParameterMatrix<4 >& X);
255+ void update (gtsam::Key j, const gtsam::ParameterMatrix<5 >& X);
256+ void update (gtsam::Key j, const gtsam::ParameterMatrix<6 >& X);
257+ void update (gtsam::Key j, const gtsam::ParameterMatrix<7 >& X);
258+ void update (gtsam::Key j, const gtsam::ParameterMatrix<8 >& X);
259+ void update (gtsam::Key j, const gtsam::ParameterMatrix<9 >& X);
260+ void update (gtsam::Key j, const gtsam::ParameterMatrix<10 >& X);
261+ void update (gtsam::Key j, const gtsam::ParameterMatrix<11 >& X);
262+ void update (gtsam::Key j, const gtsam::ParameterMatrix<12 >& X);
263+ void update (gtsam::Key j, const gtsam::ParameterMatrix<13 >& X);
264+ void update (gtsam::Key j, const gtsam::ParameterMatrix<14 >& X);
265+ void update (gtsam::Key j, const gtsam::ParameterMatrix<15 >& X);
266+
267+ void insert_or_assign (gtsam::Key j, const gtsam::Point2& point2);
268+ void insert_or_assign (gtsam::Key j, const gtsam::Point3& point3);
269+ void insert_or_assign (gtsam::Key j, const gtsam::Rot2& rot2);
270+ void insert_or_assign (gtsam::Key j, const gtsam::Pose2& pose2);
271+ void insert_or_assign (gtsam::Key j, const gtsam::SO3& R);
272+ void insert_or_assign (gtsam::Key j, const gtsam::SO4& Q);
273+ void insert_or_assign (gtsam::Key j, const gtsam::SOn& P);
274+ void insert_or_assign (gtsam::Key j, const gtsam::Rot3& rot3);
275+ void insert_or_assign (gtsam::Key j, const gtsam::Pose3& pose3);
276+ void insert_or_assign (gtsam::Key j, const gtsam::Unit3& unit3);
277+ void insert_or_assign (gtsam::Key j, const gtsam::Cal3_S2& cal3_s2);
278+ void insert_or_assign (gtsam::Key j, const gtsam::Cal3DS2& cal3ds2);
279+ void insert_or_assign (gtsam::Key j, const gtsam::Cal3Bundler& cal3bundler);
280+ void insert_or_assign (gtsam::Key j, const gtsam::Cal3Fisheye& cal3fisheye);
281+ void insert_or_assign (gtsam::Key j, const gtsam::Cal3Unified& cal3unified);
282+ void insert_or_assign (gtsam::Key j, const gtsam::EssentialMatrix& essential_matrix);
283+ void insert_or_assign (gtsam::Key j, const gtsam::PinholeCamera<gtsam::Cal3_S2>& camera);
284+ void insert_or_assign (gtsam::Key j, const gtsam::PinholeCamera<gtsam::Cal3Bundler>& camera);
285+ void insert_or_assign (gtsam::Key j, const gtsam::PinholeCamera<gtsam::Cal3Fisheye>& camera);
286+ void insert_or_assign (gtsam::Key j, const gtsam::PinholeCamera<gtsam::Cal3Unified>& camera);
287+ void insert_or_assign (gtsam::Key j, const gtsam::PinholePose<gtsam::Cal3_S2>& camera);
288+ void insert_or_assign (gtsam::Key j, const gtsam::PinholePose<gtsam::Cal3Bundler>& camera);
289+ void insert_or_assign (gtsam::Key j, const gtsam::PinholePose<gtsam::Cal3Fisheye>& camera);
290+ void insert_or_assign (gtsam::Key j, const gtsam::PinholePose<gtsam::Cal3Unified>& camera);
291+ void insert_or_assign (gtsam::Key j, const gtsam::imuBias::ConstantBias& constant_bias);
292+ void insert_or_assign (gtsam::Key j, const gtsam::NavState& nav_state);
293+ void insert_or_assign (gtsam::Key j, Vector vector);
294+ void insert_or_assign (gtsam::Key j, Matrix matrix);
295+ void insert_or_assign (gtsam::Key j, double c);
296+ void insert_or_assign (gtsam::Key j, const gtsam::ParameterMatrix<1 >& X);
297+ void insert_or_assign (gtsam::Key j, const gtsam::ParameterMatrix<2 >& X);
298+ void insert_or_assign (gtsam::Key j, const gtsam::ParameterMatrix<3 >& X);
299+ void insert_or_assign (gtsam::Key j, const gtsam::ParameterMatrix<4 >& X);
300+ void insert_or_assign (gtsam::Key j, const gtsam::ParameterMatrix<5 >& X);
301+ void insert_or_assign (gtsam::Key j, const gtsam::ParameterMatrix<6 >& X);
302+ void insert_or_assign (gtsam::Key j, const gtsam::ParameterMatrix<7 >& X);
303+ void insert_or_assign (gtsam::Key j, const gtsam::ParameterMatrix<8 >& X);
304+ void insert_or_assign (gtsam::Key j, const gtsam::ParameterMatrix<9 >& X);
305+ void insert_or_assign (gtsam::Key j, const gtsam::ParameterMatrix<10 >& X);
306+ void insert_or_assign (gtsam::Key j, const gtsam::ParameterMatrix<11 >& X);
307+ void insert_or_assign (gtsam::Key j, const gtsam::ParameterMatrix<12 >& X);
308+ void insert_or_assign (gtsam::Key j, const gtsam::ParameterMatrix<13 >& X);
309+ void insert_or_assign (gtsam::Key j, const gtsam::ParameterMatrix<14 >& X);
310+ void insert_or_assign (gtsam::Key j, const gtsam::ParameterMatrix<15 >& X);
311311
312312 template <T = {gtsam::Point2,
313313 gtsam::Point3,
@@ -353,7 +353,7 @@ class Values {
353353 gtsam::ParameterMatrix<13 >,
354354 gtsam::ParameterMatrix<14 >,
355355 gtsam::ParameterMatrix<15 >}>
356- T at (size_t j);
356+ T at (gtsam::Key j);
357357};
358358
359359#include < gtsam/nonlinear/Marginals.h>
@@ -849,9 +849,9 @@ template <T = {gtsam::Point2, gtsam::StereoPoint2, gtsam::Point3, gtsam::Rot2,
849849 gtsam::imuBias::ConstantBias}>
850850virtual class NonlinearEquality : gtsam::NoiseModelFactor {
851851 // Constructor - forces exact evaluation
852- NonlinearEquality (size_t j, const T& feasible);
852+ NonlinearEquality (gtsam::Key j, const T& feasible);
853853 // Constructor - allows inexact evaluation
854- NonlinearEquality (size_t j, const T& feasible, double error_gain);
854+ NonlinearEquality (gtsam::Key j, const T& feasible, double error_gain);
855855
856856 // enabling serialization functionality
857857 void serialize () const ;
0 commit comments