public override void Rotate(Vector3d versor, double angle) { var rotationQuaternion = new Quaternion(versor, angle); SetRotationStatus((rotationQuaternion * RotationStatus).Normalize()); SetRotationMatrix(RotationStatus.ConvertToMatrix()); SetInverseInertiaTensor( (RotationMatrix * MassInfo.InverseBaseInertiaTensor) * RotationMatrix.Transpose()); }