Astar optimize (reach point nearby when can't reach)