Fixed wrong angle values
Merge pull request #6 from valeRB/master

Fixed wrong angle values
Merge pull request #3 from RoboGroup3/master

Updates