fixed and centralized the quaternion disparity angle computation
Merge pull request #47 from ethz-asl/fix/correctQuaternionDisparityAngle

fixed and centralized the quaternion disparity angle computation