发明名称 一种液浮摆式加速度计温度控制模型参数辨识方法
摘要 一种液浮摆式加速度计温度控制模型参数辨识方法,首次将液浮摆式加速度计温度控制模型由一阶惯性模型修订为一阶延迟惯性模型,并提出了一种基于最优样本空间的参数辨识,并构造了相对残余误差S<sub>L</sub>作为液浮摆式加速度计温度控制模型参数辨识的回归模型。通过条件判断和迭代计算,得到最优样本空间,实现了纯延迟环节时间常数τ与一阶惯性环节的时间常数T的高精度辨识,为液浮摆式加速度计温度控制系统PID控制参数设计提供了依据,使得液浮摆式加速度计的温度控制精度由一阶惯性模型的±1℃提高到一阶延迟惯性模型的±0.006℃,满足了液浮摆式加速度计的高精度使用要求。
申请公布号 CN104834330A 申请公布日期 2015.08.12
申请号 CN201510205175.0 申请日期 2015.04.27
申请人 北京控制工程研究所 发明人 冯士伟;李勇;武志忠;张沛勇;王月;付明睿;惠欣;马官营;陈小娟;邱金娟
分类号 G05D23/00(2006.01)I;G05B13/04(2006.01)I 主分类号 G05D23/00(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 安丽
主权项 一种液浮摆式加速度计温度控制模型参数辨识方法,其特征在于包括仪表测试阶段、模型建模阶段和参数辨识阶段;所述仪表测试阶段的步骤如下:(1)将液浮摆式加速度计装卡在测试工装上;(2)给液浮摆式加速度计施加阶跃激励P,记录液浮摆式加速度计各采样时刻的阶跃响应数据y(t<sub>1</sub>)、y(t<sub>2</sub>)、…、y(t<sub>n</sub>),n为采样数据量,且n为大于等于2的正整数,t为时间变量,并绘制液浮摆式加速度计阶跃响应曲线,阶跃响应曲线存在一个拐点;所述模型建模阶段步骤如下:(3)根据步骤(2)的液浮摆式加速度计各采样时刻的阶跃响应数据,求取液浮摆式加速度计温度控制模型的增益K,计算公式如下:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mi>K</mi><mo>=</mo><mfrac><mrow><mi>y</mi><mrow><mo>(</mo><msub><mi>t</mi><mi>n</mi></msub><mo>)</mo></mrow><mo>-</mo><mi>y</mi><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>)</mo></mrow></mrow><mi>P</mi></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000706940840000011.GIF" wi="1297" he="141" /></maths>式中,输入的阶跃激励为P,液浮摆式加速度计阶跃响应数据初始值为y(t<sub>0</sub>),液浮摆式加速度计阶跃响应数据稳态值为y(t<sub>n</sub>);(4)对步骤(2)中液浮摆式加速度计温度控制模型阶跃响应数据进行归一化处理,得到液浮摆式加速度计温度控制模型单位阶跃响应数据y*(t<sub>i</sub>),计算公式如下:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mi>y</mi><mo>*</mo><mrow><mo>(</mo><msub><mi>t</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><mi>y</mi><mrow><mo>(</mo><msub><mi>t</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>-</mo><mi>y</mi><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>)</mo></mrow></mrow><mrow><mi>y</mi><mrow><mo>(</mo><msub><mi>t</mi><mi>n</mi></msub><mo>)</mo></mrow><mo>-</mo><mi>y</mi><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>)</mo></mrow></mrow></mfrac><mo>,</mo><mi>i</mi><mo>=</mo><mn>1,2</mn><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><mi>n</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000706940840000012.GIF" wi="1300" he="157" /></maths>式中,y*(t<sub>1</sub>)、y*(t<sub>2</sub>)、y*(t<sub>3</sub>)、…、y*(t<sub>n</sub>)为各采样时刻的单位阶跃响应数据,n为采样数据量,且n为正整数;(5)由于步骤(2)中液浮摆式加速度计阶跃响应曲线存在拐点,将液浮摆式加速度计温度控制模型的传递函数修订为一阶惯性环节与纯延迟环节的串联形式,即液浮摆式加速度计温度控制模型的传递函数G(s)写成如下形式:<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mi>G</mi><mrow><mo>(</mo><mi>s</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mi>K</mi><mrow><mi>Ts</mi><mo>+</mo><mn>1</mn></mrow></mfrac><mo>&CenterDot;</mo><msup><mi>e</mi><mrow><mo>-</mo><mi>&tau;s</mi></mrow></msup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000706940840000021.GIF" wi="1459" he="179" /></maths>式中,s为复变量,液浮摆式加速度计温度控制模型的增益为K,液浮摆式加速度计温度控制模型的一阶惯性环节时间常数为T,液浮摆式加速度计温度控制模型的纯延迟环节时间常数为τ;(6)对步骤(5)中液浮摆式加速度计温度控制模型的传递函数G(s)进行拉式反变换,写出时域表达式y(t):<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mi>y</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mi>K</mi><mrow><mo>(</mo><mn>1</mn><mo>-</mo><msup><mi>e</mi><mrow><mo>-</mo><mrow><mo>(</mo><mfrac><mrow><mi>t</mi><mo>-</mo><mi>&iota;</mi></mrow><mi>T</mi></mfrac><mo>)</mo></mrow></mrow></msup><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000706940840000022.GIF" wi="1453" he="248" /></maths>式中,t为时间变量;(7)对步骤(6)中液浮摆式加速度计温度控制模型时域表达式y(t)进行归一化处理,得到液浮摆式加速度计温度控制模型单位阶跃响应表达式y*(t):<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><mi>y</mi><mo>*</mo><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mn>1</mn><mo>-</mo><msup><mi>e</mi><mrow><mo>-</mo><mrow><mo>(</mo><mfrac><mrow><mi>t</mi><mo>-</mo><mi>&tau;</mi></mrow><mi>T</mi></mfrac><mo>)</mo></mrow></mrow></msup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000706940840000028.GIF" wi="1228" he="138" /></maths>(8)将步骤(7)中液浮摆式加速度计温度控制模型的单位阶跃响应表达式y*(t)在t=t<sub>1</sub>,t<sub>2</sub>,t<sub>3</sub>,…,t<sub>L</sub>(L=2,…,n)时刻进行线性变换并写成矩阵方程形式:Φ×θ=N                        (6)式中,系数矩阵<maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><mi>&Phi;</mi><mo>=</mo><msub><mfenced open='[' close=']'><mtable><mtr><mtd><mn>1</mn></mtd><mtd><mo>-</mo><mi>ln</mi><mrow><mo>(</mo><mn>1</mn><mo>-</mo><mi>y</mi><mo>*</mo><mrow><mo>(</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mn>1</mn></mtd><mtd><mo>-</mo><mi>ln</mi><mrow><mo>(</mo><mn>1</mn><mo>-</mo><mi>y</mi><mo>*</mo><mrow><mo>(</mo><msub><mi>t</mi><mn>2</mn></msub><mo>)</mo></mrow><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mn>1</mn></mtd><mtd><mo>-</mo><mi>ln</mi><mrow><mo>(</mo><mn>1</mn><mo>-</mo><mi>y</mi><mo>*</mo><mrow><mo>(</mo><msub><mi>t</mi><mi>L</mi></msub><mo>)</mo></mrow><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mrow><mi>L</mi><mo>&times;</mo><mn>2</mn></mrow></msub><mo>,</mo><mi>&theta;</mi><mo>=</mo><msub><mfenced open='[' close=']'><mtable><mtr><mtd><mi>&tau;</mi></mtd></mtr><mtr><mtd><mi>T</mi></mtd></mtr></mtable></mfenced><mrow><mn>2</mn><mo>&times;</mo><mn>1</mn></mrow></msub><mo>,</mo><mi>N</mi><mo>=</mo><msub><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>t</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><msub><mi>t</mi><mn>2</mn></msub></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><msub><mi>t</mi><mi>L</mi></msub></mtd></mtr></mtable></mfenced><mrow><mi>L</mi><mo>&times;</mo><mn>1</mn></mrow></msub><mo>,</mo></mrow>]]></math><img file="FDA0000706940840000023.GIF" wi="1129" he="345" /></maths>θ为参数矩阵,N为时间变量矩阵;(9)将步骤(8)中的矩阵方程写成参数辨矩阵:<maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><msub><mover><mi>&theta;</mi><mo>^</mo></mover><mi>L</mi></msub><mo>=</mo><msup><mrow><mo>(</mo><msup><mi>&Phi;</mi><mi>T</mi></msup><mi>&Phi;</mi><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><msup><mi>&Phi;</mi><mi>T</mi></msup><mi>N</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>7</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000706940840000024.GIF" wi="1423" he="125" /></maths>式中,<maths num="0008" id="cmaths0008"><math><![CDATA[<mrow><msub><mover><mi>&theta;</mi><mo>^</mo></mover><mi>L</mi></msub><mo>=</mo><msup><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mover><mi>&tau;</mi><mo>^</mo></mover><mi>L</mi></msub></mtd><mtd><msub><mover><mi>T</mi><mo>^</mo></mover><mi>L</mi></msub></mtd></mtr></mtable></mfenced><mi>T</mi></msup></mrow>]]></math><img file="FDA0000706940840000025.GIF" wi="323" he="115" /></maths>为待辨识参数矩阵,<img file="FDA0000706940840000026.GIF" wi="64" he="85" />为液浮摆式加速度计温度控制模型一阶惯性环节时间常数T的估计值,<img file="FDA0000706940840000027.GIF" wi="61" he="76" />为液浮摆式加速度计温度控制模型的纯延迟环节时间常数τ的估计值,即待辨识参数,L为参加参数辨识的矩阵样本空间的长度;所述参数辨识步骤如下:(10)根据步骤(9)的参数辨识矩阵,选择样本空间长度为L进行参数辨识,初始值L=2,L≤n,将步骤(4)归一化处理后的液浮摆式加速度计温度控制模型单位阶跃响应数据y*(t<sub>i</sub>),i=1,2,3,…,L,代入步骤(9)的公式(7)参数辨识矩阵中,计算出待辨识参数矩阵<maths num="0009" id="cmaths0009"><math><![CDATA[<mrow><msub><mover><mi>&theta;</mi><mo>^</mo></mover><mi>L</mi></msub><mo>=</mo><msup><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mover><mi>&tau;</mi><mo>^</mo></mover><mi>L</mi></msub></mtd><mtd><msub><mover><mi>T</mi><mo>^</mo></mover><mi>L</mi></msub></mtd></mtr></mtable></mfenced><mi>T</mi></msup><mo>;</mo></mrow>]]></math><img file="FDA0000706940840000031.GIF" wi="346" he="111" /></maths>(11)根据步骤(10)计算出的待辨识参数<img file="FDA0000706940840000032.GIF" wi="58" he="76" />进行判断,若计算出的<img file="FDA0000706940840000033.GIF" wi="147" he="77" />则使L的值加1并返回步骤(10)继续进行参数辨识,若计算出的<img file="FDA0000706940840000034.GIF" wi="173" he="81" />则利用步骤(10)中得到的待辨识参数矩阵<maths num="0010" id="cmaths0010"><math><![CDATA[<mrow><msub><mover><mi>&theta;</mi><mo>^</mo></mover><mi>L</mi></msub><mo>=</mo><msup><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mover><mi>&tau;</mi><mo>^</mo></mover><mi>L</mi></msub></mtd><mtd><msub><mover><mi>T</mi><mo>^</mo></mover><mi>L</mi></msub></mtd></mtr></mtable></mfenced><mi>T</mi></msup><mo>,</mo></mrow>]]></math><img file="FDA0000706940840000035.GIF" wi="346" he="116" /></maths>计算液浮摆式加速度计温度控制模型单位阶跃响应数据y*(t<sub>i</sub>)的拟合值y*<sub>L</sub>(t<sub>i</sub>),公式如下:<maths num="0011" id="cmaths0011"><math><![CDATA[<mrow><msubsup><mi>y</mi><mi>L</mi><mo>*</mo></msubsup><mrow><mo>(</mo><msub><mi>t</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>=</mo><mn>1</mn><mo>-</mo><msup><mi>e</mi><mrow><mo>-</mo><mrow><mo>(</mo><mfrac><mrow><msub><mi>t</mi><mi>i</mi></msub><mo>-</mo><msub><mover><mi>&tau;</mi><mo>^</mo></mover><mi>L</mi></msub></mrow><msub><mover><mi>T</mi><mo>^</mo></mover><mi>L</mi></msub></mfrac><mo>)</mo></mrow></mrow></msup><mo>,</mo><mi>i</mi><mo>=</mo><mn>1,2</mn><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><mi>n</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>8</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000706940840000036.GIF" wi="1820" he="232" /></maths>(12)利用步骤(11)中液浮摆式加速度计温度控制模型单位阶跃响应数据y*(t<sub>i</sub>)的拟合值y*<sub>L</sub>(t<sub>i</sub>),i=1,2,3,…,n,和步骤(4)中液浮摆式加速度计温度控制模型单位阶跃响应数据y*(t<sub>i</sub>),i=1,2,3,…,n,计算辨识矩阵样本空间长度为L时的相对残余误差S<sub>L</sub>,公式如下:<maths num="0012" id="cmaths0012"><math><![CDATA[<mrow><msub><mi>S</mi><mi>L</mi></msub><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>n</mi></munderover><msup><mrow><mo>(</mo><mfrac><mrow><msub><mi>y</mi><mi>L</mi></msub><mo>*</mo><mrow><mo>(</mo><msub><mi>t</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>-</mo><mi>y</mi><mo>*</mo><mrow><mo>(</mo><msub><mi>t</mi><mi>i</mi></msub><mo>)</mo></mrow></mrow><mrow><mi>y</mi><mo>*</mo><mrow><mo>(</mo><msub><mi>t</mi><mi>i</mi></msub><mo>)</mo></mrow></mrow></mfrac><mo>)</mo></mrow><mn>2</mn></msup><mo>,</mo><mi>L</mi><mo>&Element;</mo><mo>{</mo><mn>2,3</mn><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><mi>n</mi><mo>}</mo><mo>,</mo><mi>i</mi><mo>=</mo><mn>1,2,3</mn><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><mi>n</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>9</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000706940840000037.GIF" wi="1682" he="181" /></maths>(13)将步骤(12)中的相对残余误差S<sub>L</sub>,存入相对残余误差数组S的第L地址单元中,并进行样本空间长度的判断,若L≠n,则使步骤(10)中的L的值加1并返回步骤(10)继续进行辨识;若L=n,则辨识结束,进行步骤(14);(14)在步骤(13)的相对残余误差数组S中,找出相对残余误差数组的最小值S<sub>Lo</sub>;(15)根据步骤(14)相对残余误差数组S中的最小值S<sub>Lo</sub>在相对残余误差数组S中的位置Lo,得到最优样本空间,Lo即最优样本空间长度;(16)根据步骤(15)的最优样本空间的样本长度Lo,利用步骤(9)中公式(7)进行参数辨识,得到液浮摆式加速度计温度控制模型的纯延迟环节时间常数为τ的最优估计值<img file="FDA0000706940840000041.GIF" wi="70" he="78" />和液浮摆式加速度计温度控制模型一阶惯性环节时间常数T的最优估计值<img file="FDA0000706940840000042.GIF" wi="100" he="85" />(17)根据步骤(15)的相对残余误差数组的最小值S<sub>Lo</sub>和相对残余误差数组的最小值S<sub>Lo</sub>在相对残余误差数组S中的位置Lo,计算参数辨识的平均绝对百分比误差MAPE,公式如下:<maths num="0013" id="cmaths0013"><math><![CDATA[<mrow><mi>MAPE</mi><mo>=</mo><mfrac><msqrt><msub><mi>S</mi><msub><mi>L</mi><mi>O</mi></msub></msub></msqrt><msub><mi>L</mi><mi>O</mi></msub></mfrac><mo>&times;</mo><mn>100</mn><mo>%</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>10</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000706940840000043.GIF" wi="1193" he="169" /></maths>根据参数拟合曲线的平均绝对百分比误差MAPE,确定液浮摆式加速度计温度控制模型的纯延迟环节时间常数为τ的最优估计值<img file="FDA0000706940840000044.GIF" wi="75" he="77" />和液浮摆式加速度计温度控制模型一阶惯性环节时间常数T的最优估计值<img file="FDA0000706940840000045.GIF" wi="74" he="85" />的估计精度;(18)将步骤(16)得到的液浮摆式加速度计温度控制模型的纯延迟环节时间常数为τ的最优估计值<img file="FDA0000706940840000046.GIF" wi="74" he="72" />和液浮摆式加速度计温度控制模型一阶惯性环节时间常数T的最优估计值<img file="FDA0000706940840000047.GIF" wi="97" he="92" />以及步骤(3)中得到液浮摆式加速度计温度控制模型的增益K代入步骤(5)中的公式(3),即得到液浮摆式加速度计温度控制模型的传递函数G(s);(19)将步骤(16)得到的液浮摆式加速度计温度控制模型的纯延迟环节时间常数为τ的优估计值<img file="FDA0000706940840000048.GIF" wi="73" he="77" />和液浮摆式加速度计温度控制模型一阶惯性环节时间常数T的最优估计值<img file="FDA0000706940840000049.GIF" wi="96" he="93" />以及步骤(3)中得到液浮摆式加速度计温度控制模型的增益K代入步骤(6)中的公式(4),即得到液浮摆式加速度计温度控制模型的时域表达式y(t);(20)将步骤(16)得到的液浮摆式加速度计温度控制模型的纯延迟环节时间常数为τ的优估计值<img file="FDA00007069408400000410.GIF" wi="73" he="75" />和液浮摆式加速度计温度控制模型一阶惯性环节时间常数T的最优估计值<img file="FDA00007069408400000411.GIF" wi="104" he="90" />代入步骤(11)中的公式(8),即得到液浮摆式加速度计温度控制模型单位阶跃响应数据y*(t<sub>i</sub>)的最优拟合值y*<sub>Lo</sub>(t<sub>i</sub>),i=1,2,3,…,n,并绘制出最优拟合值y*<sub>Lo</sub>(t<sub>i</sub>)的参数辨识曲线。
地址 100080 北京市海淀区北京2729信箱