If robot gets a return signal, go to initial condition position