Improve backward wall follow code

Improve backward wall follow code.
Only follow in one direction to help reduce stalls.