Skip to content

Instantly share code, notes, and snippets.

@wngreene
Last active February 20, 2016 21:47
Show Gist options
  • Save wngreene/dd88d131b929c386df54 to your computer and use it in GitHub Desktop.
Save wngreene/dd88d131b929c386df54 to your computer and use it in GitHub Desktop.
lsd_tracker external pose as initial estimate
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
Author

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