Updated the Quat to DCM function to be a bit more efficient that trawling through eulers as an intermediary