首先编译

mkdir catkin_ws
cd catkin_ws
mkdir src
cd src
git clone  https://github.com/uzh-rpg/rpg_trajectory_evaluation.git
git clone https://github.com/catkin/catkin_simple.git
cd ..
catkin_make 

首先将rosbag转换为需要的文件，通过bag_to_pose.py

python2 /home/kwanwaipang/catkin_ws/src/rpg_trajectory_evaluation/scripts/dataset_tools/bag_to_pose.py /home/kwanwaipang/dataset/gwphku/amcl_vicon_2021-11-04-11-18-50.bag /amcl_pose --msg_type PoseWithCovarianceStamped --output stamped_traj_estimate.txt

python2 /home/kwanwaipang/catkin_ws/src/rpg_trajectory_evaluation/scripts/dataset_tools/bag_to_pose.py /home/kwanwaipang/dataset/gwphku/amcl_vicon_2021-11-04-11-18-50.bag /turtlebot2/viconros/mocap/pos --msg_type PoseStamped --output stamped_groundtruth.txt



通过rostopic info即可查看topic类型

 

参考资料

https://github.com/uzh-rpg/rpg_trajectory_evaluation