debugged the aStarSearch, add neighbours testing abilities.