发明名称 | 深空探测器软着陆自主障碍规避控制方法 | ||
摘要 | 深空探测器软着陆自主障碍规避控制方法,涉及一种对深空探测器的控制方法。针对现有深空探测器存在控制精度不高、可靠性差的问题,本发明提供一种深空探测器软着陆自主障碍规避控制方法,探测器通过自带的导航传感器测得探测器当前的位置r、速度,,信息,通过自带的障碍检测装置测得障碍的位置x<SUB>l</SUB>,y<SUB>l</SUB>,障碍的大小z<SUB>l</SUB>信息,探测器的控制器根据测得的上述信息利用所述公式进行计算,得到探测器喷嘴三个方向上控制力p<SUB>x</SUB>、p<SUB>y</SUB>、p<SUB>z</SUB>的大小,探测器受p<SUB>x</SUB>、p<SUB>y</SUB>、p<SUB>z</SUB>控制力的作用,即可保证其沿安全的下降轨迹着陆到目标星体表面。本发明所述方法可以很好的完成探测器在危险地形中的障碍规避任务,并且算法简单、计算量小、控制精度高、可靠性高。 | ||
申请公布号 | CN1851597A | 申请公布日期 | 2006.10.25 |
申请号 | CN200610010048.6 | 申请日期 | 2006.05.17 |
申请人 | 哈尔滨工业大学 | 发明人 | 崔平远;崔祜涛;张泽旭;徐敏强;徐瑞;朱圣英 |
分类号 | G05D1/00(2006.01) | 主分类号 | G05D1/00(2006.01) |
代理机构 | 哈尔滨市松花江专利商标事务所 | 代理人 | 张伟 |
主权项 | 1.一种深空探测器软着陆自主障碍规避控制方法,其特征在于探测器通过自带的导航传感器测得探测器当前的位置r、速度<img file="A2006100100480002C1.GIF" wi="35" he="40" /><img file="A2006100100480002C2.GIF" wi="39" he="45" /><img file="A2006100100480002C3.GIF" wi="20" he="34" />信息,通过自带的障碍检测装置测得障碍的位置x<sub>i</sub>,y<sub>i</sub>,障碍的大小z<sub>i</sub>信息,探测器的控制器根据测得的上述信息利用下述公式进行计算,得到探测器喷嘴三个方向上控制力p<sub>x</sub>、p<sub>y</sub>、p<sub>z</sub>的大小,探测器受p<sub>x</sub>、p<sub>y</sub>、p<sub>z</sub>控制力的作用,即可保证其沿安全的下降轨迹着陆到目标星体表面;所述公式为:<maths num="001"><![CDATA[ <math><mrow><msub><mi>P</mi><mi>x</mi></msub><mo>=</mo><mo>-</mo><msub><mi>U</mi><mi>x</mi></msub><mi>m</mi><mo>+</mo><mn>2</mn><msub><mrow><mo>(</mo><msub><mi>ω</mi><mi>e</mi></msub><mo>×</mo><mfrac><mi>δr</mi><mi>δt</mi></mfrac><mo>)</mo></mrow><mi>x</mi></msub><mi>m</mi><mo>+</mo><msub><mrow><mo>(</mo><msub><mi>ω</mi><mi>e</mi></msub><mo>×</mo><mrow><mo>(</mo><msub><mi>ω</mi><mi>e</mi></msub><mo>×</mo><mi>r</mi><mo>)</mo></mrow><mo>)</mo></mrow><mi>x</mi></msub><mi>m</mi><mo>-</mo><msub><mi>k</mi><mi>x</mi></msub><mover><mi>x</mi><mo>·</mo></mover><mo>/</mo><mn>2</mn><mo>+</mo><munderover><mi>Σ</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>n</mi></munderover><msub><mi>k</mi><mn>1</mn></msub><mo>|</mo><msub><mi>z</mi><mi>i</mi></msub><mo>|</mo><msup><mi>e</mi><mrow><mo>(</mo><mfrac><mrow><msup><mrow><mo>(</mo><mi>x</mi><mo>-</mo><msub><mi>x</mi><mi>i</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mi>y</mi><mo>-</mo><msub><mi>y</mi><mi>i</mi></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow><msup><mi>σ</mi><mn>2</mn></msup></mfrac><mo>)</mo></mrow></msup><mfrac><mrow><mo>(</mo><mi>x</mi><mo>-</mo><msub><mi>x</mi><mi>i</mi></msub><mo>)</mo></mrow><msup><mi>σ</mi><mn>2</mn></msup></mfrac><mo>-</mo><msub><mi>p</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>x</mi><mo>-</mo><msub><mi>x</mi><mi>i</mi></msub><mo>)</mo></mrow></mrow></math>]]></maths><maths num="002"><![CDATA[ <math><mrow><msub><mi>P</mi><mi>y</mi></msub><mo>=</mo><mo>-</mo><msub><mi>U</mi><mi>y</mi></msub><mi>m</mi><mo>+</mo><mn>2</mn><msub><mrow><mo>(</mo><msub><mi>ω</mi><mi>e</mi></msub><mo>×</mo><mfrac><mi>δr</mi><mi>δt</mi></mfrac><mo>)</mo></mrow><mi>y</mi></msub><mi>m</mi><mo>+</mo><msub><mrow><mo>(</mo><msub><mi>ω</mi><mi>e</mi></msub><mo>×</mo><mrow><mo>(</mo><msub><mi>ω</mi><mi>e</mi></msub><mo>×</mo><mi>r</mi><mo>)</mo></mrow><mo>)</mo></mrow><mi>y</mi></msub><mi>m</mi><mo>-</mo><msub><mi>k</mi><mi>y</mi></msub><mover><mi>y</mi><mo>·</mo></mover><mo>/</mo><mn>2</mn><mo>+</mo><munderover><mi>Σ</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>n</mi></munderover><msub><mi>k</mi><mn>1</mn></msub><mo>|</mo><msub><mi>z</mi><mi>i</mi></msub><mo>|</mo><msup><mi>e</mi><mrow><mo>(</mo><mfrac><mrow><msup><mrow><mo>(</mo><mi>x</mi><mo>-</mo><msub><mi>x</mi><mi>i</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mi>y</mi><mo>-</mo><msub><mi>y</mi><mi>i</mi></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow><msup><mi>σ</mi><mn>2</mn></msup></mfrac><mo>)</mo></mrow></msup><mfrac><mrow><mo>(</mo><mrow><mo>y</mo><mi>y</mi><mo>-</mo><msub><mi>y</mi><mi>i</mi></msub><mo>)</mo></mrow></mrow><msup><mi>σ</mi><mn>2</mn></msup></mfrac><mo>-</mo><msub><mi>p</mi><mn>2</mn></msub><mrow><mrow><mo>(</mo><mo>y</mo><mo></mo></mrow><mo>-</mo><msub><mi>y</mi><mi>i</mi></msub><mo>)</mo></mrow></mrow></math>]]></maths><maths num="003"><![CDATA[ <math><mrow><msub><mi>P</mi><mi>z</mi></msub><mo>=</mo><mo>-</mo><msub><mi>U</mi><mi>z</mi></msub><mi>m</mi><mo>+</mo><mn>2</mn><msub><mrow><mo>(</mo><msub><mi>ω</mi><mi>e</mi></msub><mo>×</mo><mfrac><mi>δr</mi><mi>δt</mi></mfrac><mo>)</mo></mrow><mi>z</mi></msub><mi>m</mi><mo>+</mo><msub><mrow><mo>(</mo><msub><mi>ω</mi><mi>e</mi></msub><mo>×</mo><mrow><mo>(</mo><msub><mi>ω</mi><mi>e</mi></msub><mo>×</mo><mi>r</mi><mo>)</mo></mrow><mo>)</mo></mrow><mi>z</mi></msub><mi>m</mi><mo>-</mo><msub><mi>k</mi><mi>z</mi></msub><mover><mi>z</mi><mo>·</mo></mover><mo>/</mo><mn>2</mn><mo>-</mo><msub><mi>p</mi><mn>3</mn></msub><mrow><mo>(</mo><mi>z</mi><mo>-</mo><msub><mi>z</mi><mi>i</mi></msub><mo>)</mo></mrow><mi></mi></mrow></math>]]></maths>其中:U为天体引力加速度;m为探测器质量;ω<sub>e</sub>为动坐标系旋转角速度,r为探测器质心在惯性坐标系中的矢径;k<sub>x</sub>,k<sub>y</sub>,k<sub>z</sub>是正数,它由李亚普诺夫函数值期望下降速度决定;K<sub>1</sub>是正数,它是危险地形势函数相对于能量函数的权重;σ是正数,它的数值决定于危险地形势的形状;p<sub>1</sub>,p<sub>2</sub>,p<sub>3</sub>是正数,它是位置项相对于速度项的权重。 | ||
地址 | 150001黑龙江省哈尔滨市南岗区西大直街92号 |