NRI: FND: Robust and Scalable Planning for Agile and Collaborative Robot Teammates in Complex Environments