Trajectory controller to follow a given trajectory while using the topics subscribed by the youbot_oodl driver