Normalize quaternion in quat2dcm.
Switch to Euler angles. Plot some nice error surfaces.