diff --git a/gtsam/geometry/triangulation.h b/gtsam/geometry/triangulation.h index ea6c5c041..3b6c2c4b3 100644 --- a/gtsam/geometry/triangulation.h +++ b/gtsam/geometry/triangulation.h @@ -18,7 +18,7 @@ #pragma once -#include +#include #include #include #include @@ -75,8 +75,8 @@ std::pair triangulationGraph( static SharedNoiseModel prior_model(noiseModel::Isotropic::Sigma(6, 1e-6)); for (size_t i = 0; i < measurements.size(); i++) { const Pose3& pose_i = poses[i]; - PinholeBaseK camera_i(pose_i, sharedCal); - graph.push_back(TriangulationFactor > // + PinholeCamera camera_i(pose_i, sharedCal); + graph.push_back(TriangulationFactor > // (camera_i, measurements[i], unit2, landmarkKey)); } return std::make_pair(graph, values); @@ -108,13 +108,13 @@ std::pair triangulationGraph( return std::make_pair(graph, values); } -/// PinholeBaseK specific version +/// PinholeCamera specific version template std::pair triangulationGraph( - const std::vector >& cameras, + const std::vector >& cameras, const std::vector& measurements, Key landmarkKey, const Point3& initialEstimate) { - return triangulationGraph > // + return triangulationGraph > // (cameras, measurements, landmarkKey, initialEstimate); } @@ -170,12 +170,12 @@ Point3 triangulateNonlinear(const std::vector& cameras, return optimize(graph, values, Symbol('p', 0)); } -/// PinholeBaseK specific version +/// PinholeCamera specific version template Point3 triangulateNonlinear( - const std::vector >& cameras, + const std::vector >& cameras, const std::vector& measurements, const Point3& initialEstimate) { - return triangulateNonlinear > // + return triangulateNonlinear > // (cameras, measurements, initialEstimate); } @@ -278,10 +278,10 @@ Point3 triangulatePoint3(const std::vector& cameras, /// Pinhole-specific version template Point3 triangulatePoint3( - const std::vector >& cameras, + const std::vector >& cameras, const std::vector& measurements, double rank_tol = 1e-9, bool optimize = false) { - return triangulatePoint3 > // + return triangulatePoint3 > // (cameras, measurements, rank_tol, optimize); }