Fixed quaternion integration error