Fixed dumb error with A star implementation.