First commit: turtlebot task_manager implementation of Dummy and navigate_to_pose