raulmur / ORB_SLAM2

Real-Time SLAM for Monocular, Stereo and RGB-D Cameras, with Loop Detection and Relocalization Capabilities
Other
9.42k stars 4.69k forks source link

Plot Camera Trajectory from CameraTrajectory.txt #820

Open sumitsarkar1 opened 5 years ago

sumitsarkar1 commented 5 years ago

Hi.. I am totally new to VSLAM algorithms and would want to plot the path followed by the moving camera. The output of running a rgb-d on TUM data set produces a CameraTrajectory.txt file. The file is in the format : time_stamp tx ty tz qx qy qz qw . I am aware of that the rotation is in Quarternion form but cannot figure out how to plot the full 3D plot of the camera path from these four values tx,ty,tz,qx,qy,qz,qw . I need a time_stamp x y z format.

thohemp commented 5 years ago

https://github.com/MichaelGrupp/evo