Corrected a bug in the forward behavior where the travelled distance wasn't being computed properly.
Tuned values. The controllers of the distance to the wall and the angle towards it should be stated explicitly.