http://docs.ros.org/en/api/geometry_msgs/html/msg/PoseStamped.html https://blog.csdn.net/sinat_16643223/article/details/114542703 http://docs.ros.org/en/diamondback/api/geometry_msgs/html/PoseStamped_8h.html