Improve wall follow algorithm

When stalled in corner, try backing off, then try forwards again.