added dist sq. weird bug of going right straight anyway