Fixed indentation a bit
Now following the distance we initially have from the wall, should stop excessive turning away in the beginning