Added check to only use odometry for robots, ignoring tracker data, added automatic tracker assignment for when only one robot is used during setup
Added TrackOtherAgents_ to only add new agents after setup, this stops the youbot planner generating an extra agent for itself
Goals are initialised and cycled from within planner, Experiment procedure is nearly fully ported onto multi-robot functionality, improved readability by replacing iter->second with planner