Assignment for Combat Formations -- Simultaneous Localization and Planning for