added goal distance constraint

and fixed a comment. The constraint is set to reject anything farther
than 90% of the max possible distance, because the algorithm kind of
falls apart once it starts stretching that far.