Add quat2dcm implementation.

TODO: normalize input!