Fix issue that I was comparing a double for equality
fix test for distance in collision avoidance
tweak collision avoidance steering and braking values
fix initial destination in steering test script