string groundtruth_file = "/home/liqiang/slambook2/ch4/example/groundtruth.txt";//groundtruth_file 存储位置
typedef vector<Sophus::SE3d, Eigen::aligned_allocator<Sophus::SE3d>> TrajectoryType;
void DrawTrajectory(const Traj
string groundtruth_file = "/home/liqiang/slambook2/ch4/example/groundtruth.txt";//groundtruth_file 存储位置
typedef vector<Sophus::SE3d, Eigen::aligned_allocator<Sophus::SE3d>> TrajectoryType;
void DrawTrajectory(const Traj