fixed and centralized the quaternion disparity angle computation

Is this still a relevant comment? It is in a file called gtest_eigen.hpp