SetYaw was using radians instead of degrees
Merge pull request #5 from monchi59/master

SetYaw was using radians instead of degrees