Minor changes, starting A* algorithm