Toward Efficient Task Assignment and Motion Planning for Large Scale Underwater Mission