Efficient search and hierarchical motion planning by dynamically maintaining single-source shortest paths trees | IEEE Journals & Magazine | IEEE Xplore