DCM now represents rotation from reference to local frame
sped up simulation