发明名称 基于模型不确定界的行星着陆轨迹跟踪鲁棒控制方法
摘要 本发明涉及一种基于模型不确定界的行星着陆轨迹跟踪鲁棒控制方法,尤其涉及一种在行星着陆过程中探测器受到多源扰动条件下的轨迹跟踪控制方法,属于深空探测制导与控制技术领域。本方法考虑目标天体引力模型与外界干扰等不确定因素对轨迹跟踪的影响,引入模型不确定界的设计理念,通过设计鲁棒反馈控制律,并兼顾控制机构的非线性特性,确保实际状态轨迹与前馈制导设计轨迹的偏离量不超过期望的界,从而优化多源扰动下的行星探测器着陆轨迹跟踪性能;能有效地克服多源扰动和系统不确定性对探测器着陆飞行轨迹的影响,提高了探测器系统的控制性能,使行星探测器着陆飞行控制精度得到了保障。
申请公布号 CN102968124B 申请公布日期 2015.04.15
申请号 CN201210499072.6 申请日期 2012.11.29
申请人 北京理工大学 发明人 高艾;崔平远;徐瑞;朱圣英;胡海静
分类号 G05D1/10(2006.01)I;G05B13/04(2006.01)I 主分类号 G05D1/10(2006.01)I
代理机构 代理人
主权项 基于模型不确定界的行星着陆轨迹跟踪鲁棒控制方法,其特征在于:包括以下步骤:步骤1,在目标天体质心固连坐标系下,建立探测器误差动力学模型:<img file="FDA00002488651900011.GIF" wi="912" he="66" /><img file="FDA00002488651900012.GIF" wi="62" he="50" /><img file="FDA00002488651900013.GIF" wi="614" he="59" />其中,δx=χ‑x为探测器状态误差,χ为真实的探测器状态,x为探测器标称状态,<img file="FDA00002488651900014.GIF" wi="163" he="42" />为探测器的反馈控制输入,φ为真实的引力加速度,g为对真实引力加速度φ的建模,d为外界扰动加速度,ψ=φ(C<sub>r</sub>χ)‑φ(C<sub>r</sub>x)与<img file="FDA00002488651900015.GIF" wi="422" he="58" />为天体引力模型误差,A为系统矩阵,B为输入矩阵,C<sub>r</sub>为状态系数矩阵;步骤2,设定反馈控制输入在给定时间间隔内与前馈控制同时作用;对误差动力学模型离散化,得到<img file="FDA00002488651900016.GIF" wi="1268" he="63" />其中,k为离散时间点,E<sub>k</sub>为离散化后的扰动输入矩阵;步骤3,设定误差约束集<img file="FDA00002488651900017.GIF" wi="37" he="36" />为一个满足<img file="FDA00002488651900018.GIF" wi="481" he="71" />的多胞体:<img file="FDA00002488651900019.GIF" wi="1113" he="71" />其中,δx<sub>max</sub>为允许的最大跟踪误差,p表示多胞体的顶点,q为总的顶点数,a<sub>p</sub>为状态约束系数矩阵;步骤4,将天体引力模型误差ψ、<img file="FDA000024886519000110.GIF" wi="40" he="35" />与外界扰动加速度d描述为如下形式:<img file="FDA000024886519000111.GIF" wi="1213" he="255" />其中,<img file="FDA000024886519000112.GIF" wi="469" he="72" />Ω={Θ|Θ<sup>T</sup>Θ≤γ<sup>2</sup>I,γ&gt;0},γ、σ与δ为设计任务给定的关于允许模型误差界与外界扰动界的指标参数;步骤5,设计反馈控制律δu<sub>k</sub>,使探测器飞行状态控制误差δx<sub>k</sub>在步骤3得到的误差约束集<img file="FDA000024886519000113.GIF" wi="38" he="36" />内,且满足控制机构非线性特性||δu<sub>k</sub>||≤δU<sub>max</sub>,δU<sub>max</sub>为由设计任务给定反馈控制输入的约束界;δu<sub>k</sub>的具体形式为:δu<sub>k</sub>=LQ<sup>‑1</sup>δx<sub>k</sub>其中,矩阵Q=Q<sup>T</sup>&gt;0,矩阵L和Q满足:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mfenced open='[' close=']'><mtable><mtr><mtd><mrow><mo>(</mo><mi>&alpha;</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mi>Q</mi></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><msubsup><mi>QA</mi><mi>k</mi><mi>T</mi></msubsup><mo>+</mo><msup><mi>L</mi><mi>T</mi></msup><msubsup><mi>B</mi><mi>k</mi><mi>T</mi></msubsup></mtd><mtd><msubsup><mi>QC</mi><mi>r</mi><mi>T</mi></msubsup></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mi>&zeta;I</mi></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><msubsup><mi>&zeta;E</mi><mi>k</mi><mi>T</mi></msubsup></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mfrac><mi>&alpha;</mi><mrow><mn>2</mn><msup><mi>&sigma;</mi><mn>2</mn></msup></mrow></mfrac><mi>I</mi></mtd><mtd><mn>0</mn></mtd><mtd><msubsup><mi>E</mi><mi>k</mi><mi>T</mi></msubsup></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mfrac><mi>&alpha;</mi><mrow><mn>2</mn><msup><mi>&delta;</mi><mn>2</mn></msup></mrow></mfrac><mi>I</mi></mtd><mtd><msubsup><mi>E</mi><mi>k</mi><mi>T</mi></msubsup></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><msub><mi>A</mi><mi>k</mi></msub><mi>Q</mi><mo>+</mo><msub><mi>B</mi><mi>k</mi></msub><mi>L</mi></mtd><mtd><msub><mi>&zeta;E</mi><mi>k</mi></msub></mtd><mtd><msub><mi>E</mi><mi>k</mi></msub></mtd><mtd><msub><mi>E</mi><mi>k</mi></msub></mtd><mtd><mo>-</mo><mi>Q</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><msub><mi>C</mi><mi>r</mi></msub><mi>Q</mi></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mfrac><mn>1</mn><msup><mi>&gamma;</mi><mn>2</mn></msup></mfrac><mi>&chi;I</mi></mtd></mtr></mtable></mfenced><mo>&le;</mo><mn>0</mn><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00002488651900021.GIF" wi="1505" he="627" /></maths><maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msubsup><mi>a</mi><mi>p</mi><mi>T</mi></msubsup><msub><mi>Qa</mi><mi>p</mi></msub><mo>&le;</mo><mn>1</mn><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00002488651900022.GIF" wi="897" he="64" /></maths><maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mfenced open='[' close=']'><mtable><mtr><mtd><mi>Q</mi></mtd><mtd><msup><mi>L</mi><mi>T</mi></msup></mtd></mtr><mtr><mtd><mi>L</mi></mtd><mtd><msubsup><mi>&delta;U</mi><mi>max</mi><mn>2</mn></msubsup><mi>I</mi></mtd></mtr></mtable></mfenced><mo>&GreaterEqual;</mo><mn>0</mn><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>7</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00002488651900023.GIF" wi="945" he="139" /></maths>α、ζ为标量,且1&gt;α&gt;0,ζ&gt;0;步骤6,将步骤5得到的控制律δu<sub>k</sub>=LQ<sup>‑1</sup>δx<sub>k</sub>作为反馈控制输入,输入步骤1建立的探测器误差动力学模型,实现行星探测器着陆轨迹跟踪鲁棒控制。
地址 100081 北京市海淀区中关村南大街5号