mirror of
https://github.com/introlab/rtabmap.git
synced 2026-10-06 18:17:47 +08:00
Extract images: added timestamp.jpg/.png filname options (to match RGBD-SLAM pose format). Fixed wrong calibration file when first node is an intermdediate node. Export poses: ignore intermediate nodes when output frame is camera or scan.
This commit is contained in:
@@ -125,6 +125,12 @@ bool exportPoses(
|
||||
// Format: stamp x y z qx qy qz qw
|
||||
Eigen::Quaternionf q = pose.getQuaternionf();
|
||||
|
||||
if(iter == poses.begin())
|
||||
{
|
||||
// header
|
||||
fprintf(fout, "# timestamp x y z qx qy qz qw\n");
|
||||
}
|
||||
|
||||
UASSERT(uContains(stamps, iter->first));
|
||||
fprintf(fout, "%f %f %f %f %f %f %f %f\n",
|
||||
stamps.at(iter->first),
|
||||
|
||||
Reference in New Issue
Block a user