Added new recursive Waypointsystem and helperfunctions
The current task of a group is now stored in the variable space (four at the moment: IDLE, PATROL, FLEE, SAD)