Update left wall follow algorithm

Update left wall follow algorithm.