Add relocation

Now if the robot is to close to the wall, less then 4 cm, than before the next move it moves to the center