Increased tolerance, commented out some logs, printed distance to goal in arewethereyet