发明名称 一种基于扰动补偿思想的RLV进场着陆段制导律获取方法
摘要 一种基于扰动补偿思想的RLV进场着陆段制导律获取方法,首先根据RLV着陆段标称轨迹计算高度偏差及侧向距离偏差;然后,根据标称轨迹的跟踪偏差,利用李雅普诺夫定理得到期望的航迹倾角和方向角,即虚拟控制律;最后,采用反步设计法提出了可保证制导回路具有稳定性的制导获取方法。设计过程中,通过分析气动数据,得到制导回路的不确定性上界,并引入补偿项对其进行抑制,使制导系统对扰动等不确定性具有渐近稳定性。本发明方法能够有效的克服RLV制导系统所受不确定性的影响,从而提高制导精度。
申请公布号 CN106292701A 申请公布日期 2017.01.04
申请号 CN201610675801.7 申请日期 2016.08.16
申请人 北京控制工程研究所 发明人 严晗;何英姿
分类号 G05D1/10(2006.01)I;G05B13/04(2006.01)I 主分类号 G05D1/10(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 陈鹏
主权项 一种基于扰动补偿思想的RLV进场着陆段制导律获取方法,其特征在于,包括如下步骤:步骤一、根据获取的RLV的当前高度h、RLV距机场跑道的侧向距离s及预先确定的RLV着陆标称轨迹h<sub>c</sub>,计算获得RLV的高度偏差<img file="FDA0001080383220000011.GIF" wi="190" he="71" />和侧向偏差<img file="FDA0001080383220000012.GIF" wi="123" he="65" />步骤二、根据RLV着陆标称轨迹h<sub>c</sub>和RLV质点运动学方程<img file="FDA0001080383220000013.GIF" wi="371" he="150" />建立着陆标称轨迹跟踪误差微分方程<img file="FDA0001080383220000014.GIF" wi="369" he="165" />其中,v为RLV的速度,γ为RLV的航迹倾角,χ为RLV的方向角;步骤三、设计虚拟控制律一为<img file="FDA0001080383220000015.GIF" wi="483" he="310" />使得RLV跟踪步骤一所预先确定的RLV着陆标称轨迹;其中,c<sub>1</sub>,c<sub>2</sub>为待确定的设计参数,c<sub>1</sub>,c<sub>2</sub>根据李雅普诺夫函数<img file="FDA0001080383220000016.GIF" wi="306" he="118" />收敛至零点的收敛速度确定;γ<sup>*</sup>为期望的航迹倾角,χ<sup>*</sup>为期望的方向角;V<sub>1</sub>为着陆标称轨迹跟踪误差;c<sub>1</sub>&gt;0,c<sub>2</sub>&gt;0;步骤四、在RLV着陆标称轨迹上选取N个特征点,分别计算每个特征点的升力不确定性Δ<sup>+</sup>=|L<sup>+</sup>‑L<sub>0</sub>|、Δ<sup>‑</sup>=|L<sup>‑</sup>‑L<sub>0</sub>|,并确定不确定性上界Δ<sub>M</sub>;其中,N为正整数;L<sub>0</sub>为特征点对应的标称升力;L<sup>+</sup>为特征点对应的考虑气动数据最大正向偏差的升力;L<sup>‑</sup>为特征点对应的考虑气动数据最大负向偏差的升力;步骤五,根据RLV质点动力学方程<img file="FDA0001080383220000021.GIF" wi="542" he="271" />及步骤三中设计的虚拟控制律一,获得航迹倾角和方向角的误差方程为<maths num="0001"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><mover><mover><mi>&gamma;</mi><mo>~</mo></mover><mo>&CenterDot;</mo></mover><mo>=</mo><mo>-</mo><mfrac><mrow><mi>g</mi><mi> </mi><mi>cos</mi><mi>&gamma;</mi></mrow><mi>v</mi></mfrac><mo>-</mo><msup><mover><mi>&gamma;</mi><mo>&CenterDot;</mo></mover><mo>*</mo></msup><mo>+</mo><mfrac><mrow><mi>L</mi><mi> </mi><mi>cos</mi><mi>&sigma;</mi></mrow><mrow><mi>m</mi><mi>v</mi></mrow></mfrac><mo>+</mo><msub><mi>&Delta;</mi><mi>&gamma;</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><mover><mover><mi>&chi;</mi><mo>~</mo></mover><mo>&CenterDot;</mo></mover><mo>=</mo><mo>-</mo><msup><mover><mi>&chi;</mi><mo>&CenterDot;</mo></mover><mo>*</mo></msup><mo>+</mo><mfrac><mrow><mi>L</mi><mi> </mi><mi>sin</mi><mi>&sigma;</mi></mrow><mrow><mi>m</mi><mi>v</mi><mi> </mi><mi>cos</mi><mi>&gamma;</mi></mrow></mfrac><mo>+</mo><msub><mi>&Delta;</mi><mi>&chi;</mi></msub></mrow></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>]]></math><img file="FDA0001080383220000022.GIF" wi="694" he="272" /></maths>其中,g为重力加速度,L为RLV的升力,σ为RLV的倾侧角,Δ<sub>γ</sub>为纵向通道中风产生的干扰力及因气动数据不确定性而产生的不确定项,Δ<sub>χ</sub>为横向通道中风产生的干扰力及因气动数据不确定性而产生的不确定项,m为RLV的质量;RLV的航迹倾角γ对期望的航迹倾角γ<sup>*</sup>的误差<img file="FDA0001080383220000023.GIF" wi="222" he="63" />RLV的方向角χ对期望的方向角χ<sup>*</sup>的误差<img file="FDA0001080383220000024.GIF" wi="242" he="63" />步骤六、设计虚拟控制律二为<maths num="0002"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><msup><mi>u</mi><mo>*</mo></msup><mn>1</mn></msub><mo>=</mo><mi>L</mi><mi> </mi><mi>cos</mi><mi>&sigma;</mi><mo>=</mo><mi>m</mi><mi>v</mi><mrow><mo>(</mo><mo>-</mo><msub><mi>k</mi><mn>1</mn></msub><mover><mi>&gamma;</mi><mo>~</mo></mover><mo>+</mo><mfrac><mrow><mi>g</mi><mi> </mi><mi>cos</mi><mi>&gamma;</mi></mrow><mi>v</mi></mfrac><mo>-</mo><mover><mi>h</mi><mo>~</mo></mover><mi>v</mi><mo>+</mo><msup><mover><mi>&gamma;</mi><mo>&CenterDot;</mo></mover><mo>*</mo></msup><mo>-</mo><mi>sgn</mi><mo>(</mo><mover><mi>&gamma;</mi><mo>~</mo></mover><mo>)</mo><msub><mi>&Delta;</mi><mi>M</mi></msub><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><msup><mi>u</mi><mo>*</mo></msup><mn>2</mn></msub><mo>=</mo><mi>L</mi><mi> </mi><mi>sin</mi><mi>&sigma;</mi><mo>=</mo><mi>m</mi><mi>v</mi><mi> </mi><mi>cos</mi><mi>&gamma;</mi><mrow><mo>(</mo><mo>-</mo><msub><mi>k</mi><mn>2</mn></msub><mover><mi>&chi;</mi><mo>~</mo></mover><mo>-</mo><mi>s</mi><mi>v</mi><mi> </mi><mi>cos</mi><mi>&gamma;</mi><mo>+</mo><msup><mover><mi>&chi;</mi><mo>&CenterDot;</mo></mover><mo>*</mo></msup><mo>-</mo><mi>sgn</mi><mo>(</mo><mover><mi>&chi;</mi><mo>~</mo></mover><mo>)</mo><msub><mi>&Delta;</mi><mi>M</mi></msub><mo>)</mo></mrow></mrow></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA0001080383220000025.GIF" wi="1222" he="239" /></maths>使得RLV的航迹倾角γ和方向角χ跟踪步骤三设计的虚拟控制律一;其中,k<sub>1</sub>,k<sub>2</sub>为待确定的设计参数,k<sub>1</sub>&gt;0,k<sub>2</sub>&gt;0;k<sub>1</sub>,k<sub>2</sub>根据李雅普诺夫函数<img file="FDA0001080383220000026.GIF" wi="406" he="118" />收敛至零点的收敛速度确定;u<sup>*</sup><sub>1</sub>为期望的纵向升力分量;u<sup>*</sup><sub>2</sub>为期望的侧向升力分量;步骤七、利用饱和函数<img file="FDA0001080383220000027.GIF" wi="451" he="287" />代替步骤六中虚拟控制律二中的sgn函数,获得<img file="FDA0001080383220000028.GIF" wi="1235" he="238" />δ为正数;步骤八、根据步骤七中获得的u<sup>*</sup><sub>1</sub>、u<sup>*</sup><sub>2</sub>计算期望的升力L<sup>*</sup>和期望的倾侧角<img file="FDA0001080383220000031.GIF" wi="505" he="254" />并根据期望的升力L<sup>*</sup>、标称气动数据及当前飞行状态反插值获得期望的攻角α<sup>*</sup>;步骤九、将步骤八获得的期望的攻角α<sup>*</sup>和期望的倾侧角σ<sup>*</sup>作为最终制导律,实现RLV对着陆标称轨迹的跟踪。
地址 100080 北京市海淀区北京2729信箱