Collision avoidance is bugged but wander visit are fixed