Fixed one infinite loop search problem
There is now a case where the computed headway is very wrong resulting
in a collision