Environment TODO list:

[GreatAlexander]

• Create new agents using planner_wrapper.
• Process tracker/robot_comms data and feed to planner_wrapper.
• Implement bumper_wrapper and appropriate robot safety protocols.
• Environment to load goals/plans from Experiment topic.
• Enable "Virtual" environment for modelling without planning agent (i.e. robot).