Fixed distance to goal check to make the correct comparison.

(this time, hopefully)