wall-following controller tunned, better behavior but requires more tests. An error was found on the signs of the wall-follow ctrl
At this point the left rotation is fine but the right rotation has problems with negative angles. The wallfollowing is oscillating less but it requires tunning (Possible solutions: 1) decrease a little the the gain and MINDIST; 2) Implement cases).
Merge branch 'master' into temp