detect apriltags and call solver
Pass pose info from roborio and apriltag poses to mapping solver.
Apriltag poses get converted to robot frame.
Signed-off-by: Yash Chainani <yashchainani28@gmail.com>
Change-Id: I840c0e3c8ab0d751d2d6de172243fed66d1cbbf6
diff --git a/y2022/vision/target_estimator.cc b/y2022/vision/target_estimator.cc
index 9bbaf75..b84cf21 100644
--- a/y2022/vision/target_estimator.cc
+++ b/y2022/vision/target_estimator.cc
@@ -20,7 +20,7 @@
DEFINE_bool(freeze_angle_to_camera, true,
"If true, don't solve for polar angle to camera");
-DEFINE_uint64(max_num_iterations, 200,
+DEFINE_uint64(max_solver_iterations, 200,
"Maximum number of iterations for the ceres solver");
DEFINE_bool(solver_output, false,
"If true, log the solver progress and results");
@@ -268,7 +268,7 @@
options.gradient_tolerance = 1e-12;
options.function_tolerance = 1e-16;
options.parameter_tolerance = 1e-12;
- options.max_num_iterations = FLAGS_max_num_iterations;
+ options.max_num_iterations = FLAGS_max_solver_iterations;
ceres::Solver::Summary summary;
ceres::Solve(options, &problem, &summary);