fixed and centralized the quaternion disparity angle computation

Hm, I don't understand.
It is in the wrong file because this file is obviously meant to be eigen dependent. But that function is not. It doesn't hurt to much at the moment, though. But once we have further tools independent of eigen we should give them a better place. That was the idea of that TODO.