batch_pose_estimator solve the relative pose between vicon and slam frames Dependencies: mg_msgs: https://github.com/radionavlab/px4_control.git