发明名称 基于运动状态综合识别的高速飞行器自适应控制方法
摘要 本发明公开了一种基于运动状态综合识别的高速飞行器自适应控制方法,用于解决现有基于特征模型的高超声速飞行器鲁棒控制方法收敛时间长的技术问题。技术方案是首先建立高速飞行器模型,并进行小扰动线性化,获得高速飞行器运动状态的特征模型;再由快速可测量在线构建面向控制的特征模型的特征状态量;然后根据得到的特征模型,设计自校正自适应控制方法。由于通过运动状态综合识别方法来快速获得面向控制的特征模型的特征状态量,因此不需要进行在线辨识;其次,自校正自适应控制策略可根据对象的实时动态特性直接进行在线生成控制器参数,使控制器的参数在实际飞行过程中能根据实际情况进行及时地调整。
申请公布号 CN103197543A 申请公布日期 2013.07.10
申请号 CN201310057400.1 申请日期 2013.02.25
申请人 西北工业大学 发明人 林鹏;周军;王立祺;王霄婷;葛振振
分类号 G05B13/04(2006.01)I 主分类号 G05B13/04(2006.01)I
代理机构 西北工业大学专利中心 61204 代理人 王鲜凯
主权项 1.一种基于运动状态综合识别的高速飞行器自适应控制方法,其特征在于包括以下步骤:步骤一、将高速飞行器视为刚体,其纵向运动模型为<img file="FDA00002853859000011.GIF" wi="1271" he="423" />对纵向运动模型进行小扰动线性化,获取短时间周期的姿态低阶扰动模型;取弹道某点V<sub>0</sub>,θ<sub>0</sub>,h<sub>0</sub>处的线性化参考点为α<sub>0</sub>及其配平舵偏δ<sub>z0</sub>,俯仰角速度<img file="FDA00002853859000012.GIF" wi="201" he="74" />则有<maths num="0001"><![CDATA[<math><mrow><mfenced open='' close='}'><mtable><mtr><mtd><mover><mi>&alpha;</mi><mo>&CenterDot;</mo></mover><mo>=</mo><msubsup><mi>&omega;</mi><mi>Oz</mi><mi>B</mi></msubsup></mtd></mtr><mtr><mtd><msubsup><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mi>Oz</mi><mi>B</mi></msubsup><mo>=</mo><msub><mi>a</mi><mrow><mi>pd</mi><mn>1</mn></mrow></msub><msubsup><mi>&omega;</mi><mi>Oz</mi><mi>B</mi></msubsup><mo>+</mo><msub><mi>a</mi><mrow><mi>pd</mi><mn>2</mn></mrow></msub><mrow><mo>(</mo><mi>&alpha;</mi><mo>-</mo><msub><mi>&alpha;</mi><mn>0</mn></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>b</mi><mi>pd</mi></msub><mrow><mo>(</mo><msub><mi>&delta;</mi><mi>z</mi></msub><mo>-</mo><msub><mi>&delta;</mi><mrow><mi>z</mi><mn>0</mn></mrow></msub><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow></math>]]></maths>定义高速飞行器纵向运动的特征状态量为:<maths num="0002"><![CDATA[<math><mrow><mfenced open='' close='}'><mtable><mtr><mtd><msub><mi>a</mi><mrow><mi>p</mi><mn>2</mn></mrow></msub><mo>=</mo><msub><mi>a</mi><mrow><mi>pd</mi><mn>2</mn></mrow></msub><mrow><mo>(</mo><mn>1</mn><mo>-</mo><msub><mi>&alpha;</mi><mn>0</mn></msub><mo>/</mo><mi>&alpha;</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msub><mi>b</mi><mi>p</mi></msub><mo>=</mo><msub><mi>b</mi><mi>pd</mi></msub><mrow><mo>(</mo><mn>1</mn><mo>-</mo><msub><mi>&delta;</mi><mrow><mi>z</mi><mn>0</mn></mrow></msub><mo>/</mo><msub><mi>&delta;</mi><mi>z</mi></msub><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow></math>]]></maths>根据式(2)和式(3),得到高速飞行器纵向运动的特征模型:<maths num="0003"><![CDATA[<math><mrow><mfenced open='' close='}'><mtable><mtr><mtd><mover><mi>&alpha;</mi><mo>&CenterDot;</mo></mover><mo>=</mo><msubsup><mi>&omega;</mi><mi>Oz</mi><mi>B</mi></msubsup></mtd></mtr><mtr><mtd><msubsup><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mi>Oz</mi><mi>B</mi></msubsup><mo>=</mo><msub><mi>a</mi><mrow><mi>pd</mi><mn>1</mn></mrow></msub><msubsup><mi>&omega;</mi><mi>Oz</mi><mi>B</mi></msubsup><mo>+</mo><msub><mi>a</mi><mrow><mi>p</mi><mn>2</mn></mrow></msub><mi>&alpha;</mi><mo>+</mo><msub><mi>b</mi><mi>p</mi></msub><msub><mi>&delta;</mi><mi>z</mi></msub></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow></math>]]></maths>步骤二、由传感器得到的飞行姿态量<img file="FDA00002853859000016.GIF" wi="474" he="98" />舵偏矢量<img file="FDA00002853859000017.GIF" wi="266" he="95" />飞行弹道状态矢量Γ=[Q,V,H]<sup>T</sup>;因此,a<sub>pd1</sub>为:<maths num="0004"><![CDATA[<math><mrow><msub><mi>a</mi><mrow><mi>pd</mi><mn>1</mn></mrow></msub><mo>=</mo><msub><mover><mi>k</mi><mo>^</mo></mover><mi>z</mi></msub><msup><mi>QSL</mi><mn>2</mn></msup><mo>/</mo><msub><mi>J</mi><mi>z</mi></msub><mi>V</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow></math>]]></maths>式中,<img file="FDA00002853859000019.GIF" wi="54" he="82" />是阻尼力矩系数<img file="FDA000028538590000110.GIF" wi="84" he="66" />的近似值,根据气动阻尼特性将其拟合为可测物理量的函数用于在线计算,或者根据<img file="FDA000028538590000111.GIF" wi="78" he="71" />的变化范围选择为随某可测状态分段变化的常值;计算配平系数μ=-a<sub>p2</sub>b<sub>p</sub>;根据特征模型进一步有<maths num="0005"><![CDATA[<math><mrow><msubsup><mover><mi>&omega;</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mi>Oz</mi><mi>B</mi></msubsup><mo>=</mo><msub><mi>a</mi><mrow><mi>pd</mi><mn>1</mn></mrow></msub><msubsup><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mi>Oz</mi><mi>B</mi></msubsup><mo>+</mo><msub><mi>a</mi><mrow><mi>p</mi><mn>2</mn></mrow></msub><msubsup><mi>&omega;</mi><mi>Oz</mi><mi>B</mi></msubsup><mo>+</mo><msub><mi>b</mi><mi>p</mi></msub><msub><mover><mi>&delta;</mi><mo>&CenterDot;</mo></mover><mi>z</mi></msub><mo>+</mo><msub><mover><mi>a</mi><mo>&CenterDot;</mo></mover><mrow><mi>p</mi><mn>2</mn></mrow></msub><mi>&alpha;</mi><mo>+</mo><msub><mover><mi>b</mi><mo>&CenterDot;</mo></mover><mi>p</mi></msub><msub><mi>&delta;</mi><mi>z</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow></math>]]></maths>在采样周期足够小的情况下,假设参数a<sub>p2</sub>,b<sub>p</sub>变化可忽略不计,从而得到配平系数估算表达式<maths num="0006"><![CDATA[<math><mrow><mi>&mu;</mi><mo>=</mo><mfrac><mrow><mrow><mo>(</mo><msubsup><mover><mi>&omega;</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mi>Oz</mi><mi>B</mi></msubsup><mo>-</mo><msub><mi>a</mi><mrow><mi>pd</mi><mn>1</mn></mrow></msub><msubsup><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mi>Oz</mi><mi>B</mi></msubsup><mo>)</mo></mrow><msub><mi>&delta;</mi><mi>z</mi></msub><mo>-</mo><mrow><mo>(</mo><msubsup><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mi>Oz</mi><mi>B</mi></msubsup><mo>-</mo><msub><mi>a</mi><mrow><mi>pd</mi><mn>1</mn></mrow></msub><msubsup><mi>&omega;</mi><mi>Oz</mi><mi>B</mi></msubsup><mo>)</mo></mrow><msub><mover><mi>&delta;</mi><mo>&CenterDot;</mo></mover><mi>z</mi></msub></mrow><mrow><mrow><mo>(</mo><msubsup><mover><mi>&omega;</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mi>Oz</mi><mi>B</mi></msubsup><mo>-</mo><msub><mi>a</mi><mrow><mi>pd</mi><mn>1</mn></mrow></msub><msubsup><mi>&omega;</mi><mi>Oz</mi><mi>B</mi></msubsup><mo>)</mo></mrow><mi>&alpha;</mi><mrow><mo>(</mo><msubsup><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mi>Oz</mi><mi>B</mi></msubsup><mo>-</mo><msub><mi>a</mi><mrow><mi>pd</mi><mn>1</mn></mrow></msub><msubsup><mi>&omega;</mi><mi>Oz</mi><mi>B</mi></msubsup><mo>)</mo></mrow><msubsup><mi>&omega;</mi><mi>Oz</mi><mi>B</mi></msubsup></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>7</mn><mo>)</mo></mrow></mrow></math>]]></maths>用配平系数估值来计算特征状态量;<maths num="0007"><![CDATA[<math><mrow><mfenced open='' close='}'><mtable><mtr><mtd><msub><mi>a</mi><mrow><mi>p</mi><mn>2</mn></mrow></msub><mo>=</mo><mfrac><mrow><msubsup><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mi>OZ</mi><mi>B</mi></msubsup><mo>-</mo><msub><mi>a</mi><mrow><mi>pd</mi><mn>1</mn></mrow></msub><msubsup><mi>&omega;</mi><mi>Oz</mi><mi>B</mi></msubsup></mrow><mrow><mi>&alpha;</mi><mo>-</mo><msub><mi>&delta;</mi><mi>z</mi></msub><mo>/</mo><mi>&mu;</mi></mrow></mfrac></mtd></mtr><mtr><mtd><msub><mi>b</mi><mi>p</mi></msub><mo>=</mo><mfrac><msub><mi>a</mi><mrow><mi>p</mi><mn>2</mn></mrow></msub><mi>&mu;</mi></mfrac></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>8</mn><mo>)</mo></mrow><mo>;</mo></mrow></math>]]></maths>步骤三、根据所得到特征模型的特征参数,将式(4)写成传递函数的形式:<maths num="0008"><![CDATA[<math><mrow><msub><mi>G</mi><mi>T</mi></msub><mrow><mo>(</mo><mi>s</mi><mo>)</mo></mrow><mo>=</mo><mfrac><msub><mi>b</mi><mi>p</mi></msub><mrow><msup><mi>s</mi><mn>2</mn></msup><mo>+</mo><msub><mi>a</mi><mrow><mi>pd</mi><mn>1</mn></mrow></msub><mi>s</mi><mo>+</mo><msub><mi>a</mi><mrow><mi>p</mi><mn>2</mn></mrow></msub></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>9</mn><mo>)</mo></mrow></mrow></math>]]></maths>假定此时控制对象的等价二阶特征方程为:<maths num="0009"><![CDATA[<math><mrow><msub><mi>G</mi><mn>0</mn></msub><mrow><mo>(</mo><mi>s</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><msub><mi>K</mi><mn>0</mn></msub><msubsup><mi>&omega;</mi><mn>0</mn><mn>2</mn></msubsup></mrow><mrow><msup><mi>s</mi><mn>2</mn></msup><mo>+</mo><mn>2</mn><msub><mi>&xi;</mi><mn>0</mn></msub><msub><mi>&omega;</mi><mn>0</mn></msub><mi>s</mi><mo>+</mo><msubsup><mi>&omega;</mi><mn>0</mn><mn>2</mn></msubsup></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>10</mn><mo>)</mo></mrow></mrow></math>]]></maths>联立式(9)和式(10),即得高速飞行器的特征增益K<sub>0</sub>、特征频率ω<sub>0</sub>和特征阻尼ξ<sub>0</sub>;选用PD反馈校正器,设校正器传递函数H<sub>T</sub>(s)=K<sub>p</sub>+K<sub>d</sub>s(11)式中,K<sub>p</sub>为比例增益系数,K<sub>d</sub>为微分增益系数;则该校正回路的闭环传递函数是:<maths num="0010"><![CDATA[<math><mrow><mi>&Phi;</mi><mrow><mo>(</mo><mi>s</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><msub><mi>G</mi><mi>T</mi></msub><mrow><mo>(</mo><mi>s</mi><mo>)</mo></mrow></mrow><mrow><mn>1</mn><mo>+</mo><msub><mi>H</mi><mi>T</mi></msub><mrow><mo>(</mo><mi>s</mi><mo>)</mo></mrow><msub><mi>G</mi><mi>T</mi></msub><mrow><mo>(</mo><mi>s</mi><mo>)</mo></mrow></mrow></mfrac><mo>=</mo><mfrac><msub><mi>b</mi><mi>p</mi></msub><mrow><msup><mi>s</mi><mn>2</mn></msup><mo>+</mo><mrow><mo>(</mo><msub><mi>K</mi><mi>d</mi></msub><mo>+</mo><msub><mi>a</mi><mrow><mi>pd</mi><mn>1</mn></mrow></msub><mo>)</mo></mrow><mi>s</mi><mo>+</mo><mrow><mo>(</mo><msub><mi>K</mi><mi>p</mi></msub><mo>+</mo><msub><mi>a</mi><mrow><mi>p</mi><mn>2</mn></mrow></msub><mo>)</mo></mrow></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>12</mn><mo>)</mo></mrow></mrow></math>]]></maths>设被控对象的期望频率、期望阻尼分别为ω<sub>q</sub>和ξ<sub>q</sub>,则有<maths num="0011"><![CDATA[<math><mrow><msub><mi>K</mi><mi>p</mi></msub><mo>=</mo><mfrac><mrow><msubsup><mi>&omega;</mi><mi>q</mi><mn>2</mn></msubsup><mo>-</mo><msub><mi>a</mi><mrow><mi>p</mi><mn>2</mn></mrow></msub></mrow><msub><mi>b</mi><mi>p</mi></msub></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>13</mn><mo>)</mo></mrow></mrow></math>]]></maths><maths num="0012"><![CDATA[<math><mrow><msub><mi>K</mi><mi>d</mi></msub><mo>=</mo><mfrac><mrow><mn>2</mn><msub><mi>&omega;</mi><mi>q</mi></msub><msub><mi>&xi;</mi><mi>q</mi></msub><mo>-</mo><msub><mi>a</mi><mrow><mi>pd</mi><mn>1</mn></mrow></msub></mrow><msub><mi>b</mi><mi>p</mi></msub></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>14</mn><mo>)</mo></mrow></mrow></math>]]></maths>该反馈校正系统的闭环增益<maths num="0013"><![CDATA[<math><mrow><msub><mi>K</mi><mi>q</mi></msub><mo>=</mo><mfrac><msub><mi>b</mi><mi>p</mi></msub><msubsup><mi>&omega;</mi><mi>q</mi><mn>2</mn></msubsup></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>15</mn><mo>)</mo></mrow></mrow></math>]]></maths>因此,增益补偿系数<maths num="0014"><![CDATA[<math><mrow><msub><mi>K</mi><mi>g</mi></msub><mo>=</mo><mfrac><mn>1</mn><msub><mi>K</mi><mi>q</mi></msub></mfrac><mo>=</mo><mfrac><msubsup><mi>&omega;</mi><mi>q</mi><mn>2</mn></msubsup><msub><mi>b</mi><mi>p</mi></msub></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>16</mn><mo>)</mo></mrow><mo>.</mo></mrow></math>]]></maths>
地址 710072 陕西省西安市友谊西路127号