Skip to content

Instantly share code, notes, and snippets.

@wngreene

wngreene/ext_pose_example.cc

Last active February 20, 2016 21:47
Show Gist options

  • Select an option

    Learn more about clone URLs
  • Save wngreene/dd88d131b929c386df54 to your computer and use it in GitHub Desktop.

Select an option

Learn more about clone URLs
Save wngreene/dd88d131b929c386df54 to your computer and use it in GitHub Desktop.
Download ZIP
lsd_tracker external pose as initial estimate
Raw
ext_pose_example.cc
SE3 frame_to_kf_init = se3FromSim3(curr_tracking_ref_->keyframe->pose->getCamToWorld().inverse() *
sim3FromSE3(pose, 1.0));
frame_to_kf_init.translation() *= curr_tracking_ref_->keyframe->pose->getCamToWorld().scale();
SE3 frame_to_kf_upd = tracker_->trackFrame(curr_tracking_ref_.get(),
trackingNewFrame.get(),
frame_to_kf_init);
@wngreene
Copy link
Copy Markdown
Author

wngreene commented Feb 20, 2016

pose is the external, ground truth pose.

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment