Wall Angle

Adds a function that correct the angle of the robot to the wall.