robotics navigation simulation pathfinding path-planning artificial-intelligence ai-planning heuristics search-algorithms graph-search dynamic-environments autonomous-agents dstarlite heuristic-search robot-navigation shortest-path-algorithm path-planning-algorithm dstar-algorithm dstar-lite real-time-navigation