https://programtalk.com/python-examples/geometry_msgs.msg.PoseStamped/
转载于:https://www.cnblogs.com/sea-stream/p/11129929.html