https://www.programcreek.com/python/example/70252/geometry_msgs.msg.PoseStamped https://programtalk.com/python-examples/