Add the cayley and inverse cayley mapping. By now these formulas use the matrix representation of a skew matrix/rotation which is not very pretty. I will replace it by a quaternion counterpart when I figured out how to do it properly 

[[Imported from SVN: r7943]]