Wall following controller behaviour changed when the robot it's too close from a wall or too far from 1 or both walls. Not checked and not refactored either yet.
Wall Following Controller refactored. New version not tried yet
Merge remote-tracking branch 'diego/master'