Modified pose estimation, with boundaries for the angles
Added modified pose estimation file
Merge pull request #2 from valeRB/master

Updated code for pose estimation