Improve wall follow algorithm

When backing off, continue until there is nothing in front or to side.