fix frontier allocation
fix frontier allocation

CARMinesDouai/MultiRobotExplorationPackages,CARMinesDouai/MultiRobotExplorationPackages,CARMinesDouai/MultiRobotExplorationPackages,CARMinesDouai/MultiRobotExplorationPackages,CARMinesDouai/MultiRobotExplorationPackages,CARMinesDouai/MultiRobotExplorationPackages