Always returns start and end nodes when a path is found in astar
Merge branch 'fix_empty_result_astar' into develop_patched