Added some comments about how to correct the angle
Merge pull request #3 from valeRB/master

Added some comments about how to correct the angle
Fixed a small issue with final angle
Merge pull request #4 from valeRB/master

Fixed a small issue with final angle
Merge pull request #2 from RoboGroup3/master

Updates from Valeria