https://github.com/thien94/vision_to_mavros
通过话题“/mavros/vision_pose/pose”向PX4发送位置数据
mavros会自动将输入的ENU坐标值或者body系坐标值转换到NED坐标系中
listener.waitForTransform("/turtle2", "/turtle1", ros::Time(0), ros::Duration(3.0));
listener.lookupTransform("/turtle2", "/turtle1", ros: