From 51cc3e61ef5b78c2c625e1a2c0556e81bc5d58bc Mon Sep 17 00:00:00 2001 From: mederic_fourmy <mederic.fourmy@gmail.com> Date: Mon, 21 Jan 2019 17:07:12 +0100 Subject: [PATCH] Renamed yaml camera file Dinesh LAAS --- ...ms.yaml => camera_Dinesh_LAAS_params.yaml} | 0 ...era_Dinesh_LAAS_params_notangentrect.yaml} | 0 src/examples/test_apriltag.cpp | 27 ++++++++++--------- 3 files changed, 14 insertions(+), 13 deletions(-) rename src/examples/{camera_apriltag_params.yaml => camera_Dinesh_LAAS_params.yaml} (100%) rename src/examples/{camera_apriltag_params_notangentrect.yaml => camera_Dinesh_LAAS_params_notangentrect.yaml} (100%) diff --git a/src/examples/camera_apriltag_params.yaml b/src/examples/camera_Dinesh_LAAS_params.yaml similarity index 100% rename from src/examples/camera_apriltag_params.yaml rename to src/examples/camera_Dinesh_LAAS_params.yaml diff --git a/src/examples/camera_apriltag_params_notangentrect.yaml b/src/examples/camera_Dinesh_LAAS_params_notangentrect.yaml similarity index 100% rename from src/examples/camera_apriltag_params_notangentrect.yaml rename to src/examples/camera_Dinesh_LAAS_params_notangentrect.yaml diff --git a/src/examples/test_apriltag.cpp b/src/examples/test_apriltag.cpp index a35b3d7ce..5cd2dc8e2 100644 --- a/src/examples/test_apriltag.cpp +++ b/src/examples/test_apriltag.cpp @@ -63,7 +63,7 @@ int main(int argc, char *argv[]) WOLF_INFO( "==================== Configure Problem ======================" ) SensorBasePtr sen = problem->installSensor("CAMERA", "camera", (Vector7s()<<0,0,0,0,0,0,1).finished(), wolf_root + "/src/examples/camera_logitech_c300_640_480.yaml"); -// SensorBasePtr sen = problem->installSensor("CAMERA", "camera", (Vector7s()<<0,0,0,0,0,0,1).finished(), wolf_root + "/src/examples/camera_apriltag_params_notangentrect.yaml"); +// SensorBasePtr sen = problem->installSensor("CAMERA", "camera", (Vector7s()<<0,0,0,0,0,0,1).finished(), wolf_root + "/src/examples/camera_Dinesh_LAAS_params_notangentrect.yaml"); SensorCameraPtr sen_cam = std::static_pointer_cast<SensorCamera>(sen); ProcessorBasePtr prc = problem->installProcessor("TRACKER LANDMARK APRILTAG", "apriltags", "camera", wolf_root + "/src/examples/processor_tracker_landmark_apriltag.yaml"); @@ -95,6 +95,7 @@ int main(int argc, char *argv[]) } else { FrameBasePtr F1 = problem->setPrior((Vector7s()<<0,0,0,0,0,0,1).finished(), covariance, 0.0, 0.1); + F1->fix(); } // first argument is the name of the program. @@ -169,22 +170,22 @@ int main(int argc, char *argv[]) - WOLF_INFO( "==================== Provide perturbed prior ======================" ) - for (auto kf : problem->getTrajectoryPtr()->getFrameList()) - { - Vector7s x; - if (kf->isKey()) - { - x.setRandom(); - x.tail(4).normalize(); - kf->setState(x); - } - } +// WOLF_INFO( "==================== Provide perturbed prior ======================" ) +// for (auto kf : problem->getTrajectoryPtr()->getFrameList()) +// { +// Vector7s x; +// if (kf->isKey()) +// { +// x.setRandom(); +// x.tail(4).normalize(); +// kf->setState(x); +// } +// } WOLF_INFO( "==================== Solve problem ======================" ) std::string report = ceres_manager->solve(SolverManager::ReportVerbosity::FULL); // 0: nothing, 1: BriefReport, 2: FullReport WOLF_DEBUG(report); - problem->print(3,1,1,1); + problem->print(3,0,1,1); -- GitLab