See: https://amiga.farm-ng.com/docs/examples/controller_track/ And: https://docs.ros.org/en/noetic/api/geometry_msgs/html/msg/PoseArray.html