Added another p controller for the case in which the robot is too close to a wall
Merge pull request #21 from marro10/master

Added another p controller for the case in which the robot is too close ...