Add trajectory saving if present as ros param#43

tianyilim wants to merge 12 commits into

thien94:masterthien94/orb_slam3_ros_wrapper:masterfrom

tianyilim:mastertianyilim/orb_slam3_ros_wrapper:masterCopy head branch name to clipboard