Add missing inline, Add quaternion normalization in integrate method