timing to lead robot out of self-collision