diff --git a/examples/SFMExample.cpp b/examples/SFMExample.cpp index 207651957..75d14cd72 100644 --- a/examples/SFMExample.cpp +++ b/examples/SFMExample.cpp @@ -85,8 +85,8 @@ int main(int argc, char* argv[]) { // Simulated measurements from each camera pose, adding them to the factor graph for (size_t i = 0; i < poses.size(); ++i) { + SimpleCamera camera(poses[i], *K); for (size_t j = 0; j < points.size(); ++j) { - SimpleCamera camera(poses[i], *K); Point2 measurement = camera.project(points[j]); graph.push_back(GenericProjectionFactor(measurement, measurementNoise, Symbol('x', i), Symbol('l', j), K)); } diff --git a/gtsam_unstable/examples/ExpressionExample.cpp b/gtsam_unstable/examples/ExpressionExample.cpp index 90de1a146..8e3309b02 100644 --- a/gtsam_unstable/examples/ExpressionExample.cpp +++ b/gtsam_unstable/examples/ExpressionExample.cpp @@ -67,11 +67,11 @@ int main(int argc, char* argv[]) { // Simulated measurements from each camera pose, adding them to the factor graph for (size_t i = 0; i < poses.size(); ++i) { + Pose3_ x('x', i); + SimpleCamera camera(poses[i], K); for (size_t j = 0; j < points.size(); ++j) { - SimpleCamera camera(poses[i], K); Point2 measurement = camera.project(points[j]); // Below an expression for the prediction of the measurement: - Pose3_ x('x', i); Point3_ p('l', j); Expression prediction = uncalibrate(cK, project(transform_to(x, p))); // Again, here we use a BADFactor