Mapping and Real-Time Navigation With Application to Small UAS Urgent Landing