Skip to content
Snippets Groups Projects
Commit 74c44db3 authored by Joan Solà Ortega's avatar Joan Solà Ortega
Browse files

Improve callback debug info

parent bda0d1bc
No related branches found
No related tags found
1 merge request!233WIP: Apriltag
Pipeline #2247 failed
...@@ -693,6 +693,8 @@ FrameBasePtr Problem::setPrior(const Eigen::VectorXs& _prior_state, const Eigen: ...@@ -693,6 +693,8 @@ FrameBasePtr Problem::setPrior(const Eigen::VectorXs& _prior_state, const Eigen:
// emplace feature and constraint // emplace feature and constraint
init_capture->emplaceFeatureAndConstraint(); init_capture->emplaceFeatureAndConstraint();
WOLF_DEBUG("Set prior callback: KF", origin_keyframe->id(), " Callback emitted with ts = ", origin_keyframe->getTimeStamp());
// Notify all processors about the prior KF // Notify all processors about the prior KF
for (auto sensor : hardware_ptr_->getSensorList()) for (auto sensor : hardware_ptr_->getSensorList())
for (auto processor : sensor->getProcessorList()) for (auto processor : sensor->getProcessorList())
......
...@@ -27,6 +27,7 @@ class ProcessorTrackerLandmarkApriltag_class : public testing::Test{ ...@@ -27,6 +27,7 @@ class ProcessorTrackerLandmarkApriltag_class : public testing::Test{
// prc_apr = std::static_pointer_cast<ProcessorTrackerLandmarkApriltag>(prc); // prc_apr = std::static_pointer_cast<ProcessorTrackerLandmarkApriltag>(prc);
// this is a workaround while the factory is not there... // this is a workaround while the factory is not there...
ProcessorParamsTrackerLandmarkApriltagPtr params = std::make_shared<ProcessorParamsTrackerLandmarkApriltag>(); ProcessorParamsTrackerLandmarkApriltagPtr params = std::make_shared<ProcessorParamsTrackerLandmarkApriltag>();
params->name = "Apriltag";
params->tag_family_ = "tag36h11"; params->tag_family_ = "tag36h11";
prc_apr = std::make_shared<ProcessorTrackerLandmarkApriltag>(params); prc_apr = std::make_shared<ProcessorTrackerLandmarkApriltag>(params);
prc = prc_apr; prc = prc_apr;
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment