发明名称 |
一种利用陀螺和喷气时间联合诊断喷管堵塞故障的方法 |
摘要 |
本发明涉及一种利用陀螺和喷气时间联合诊断喷管堵塞故障的方法,该方法包括:(1)每个控制周期,计算陀螺测量输出在卫星x轴,y轴和z轴对应的角速度增量,以及本控制周期推进系统在三个坐标轴的喷气量;(2)当某个坐标轴同时满足在10s内喷气累计量大于m秒,且角速度变化量小于0.001弧度/s两个条件时,则将该轴的陀螺+喷气诊断标志位加1;否则诊断标志位清0;(3)判断陀螺是否满足平衡方程,如果不满足,且陀螺+喷气诊断标志位大于0,则陀螺故障;如果满足,且陀螺+喷气诊断标志位大于0,则判断喷管堵塞,切换一次喷管分支,该方法能够当卫星工作于使用陀螺信息和喷气力矩进行姿态控制情况下,对喷管堵塞进行在轨自主诊断。 |
申请公布号 |
CN102050228B |
申请公布日期 |
2013.06.19 |
申请号 |
CN201010509201.6 |
申请日期 |
2010.10.11 |
申请人 |
北京控制工程研究所 |
发明人 |
袁利;柯旗;魏春岭;杨鸣;朱琦;宋利芳 |
分类号 |
B64G1/52(2006.01)I;F02K1/00(2006.01)I |
主分类号 |
B64G1/52(2006.01)I |
代理机构 |
中国航天科技专利中心 11009 |
代理人 |
范晓毅 |
主权项 |
1.一种利用陀螺和喷气时间联合诊断喷管堵塞故障的方法,其特征在于包括如下步骤:(1)采集每个控制周期内陀螺G<sub>x</sub>,G<sub>y</sub>,G<sub>z</sub>测量输出在卫星笛卡儿坐标系x轴,y轴和z轴对应的角速度增量<img file="FSB00001028975300011.GIF" wi="104" he="53" />同时计算每个控制周期内卫星在x轴,y轴和z轴对应的角速度变化量<maths num="0001"><![CDATA[<math><mrow><msubsup><mi>Δω</mi><mi>i</mi><mi>n</mi></msubsup><mo>=</mo><msubsup><mi>Δg</mi><mi>i</mi><mi>n</mi></msubsup><mo>/</mo><mi>Δt</mi><mo>-</mo><msubsup><mi>Δg</mi><mi>i</mi><mrow><mi>n</mi><mo>-</mo><mn>1</mn></mrow></msubsup><mo>/</mo><mi>Δt</mi><mo>,</mo></mrow></math>]]></maths>其中:陀螺G<sub>x</sub>,G<sub>y</sub>,G<sub>z</sub>分别代表安装在笛卡儿坐标系x轴,y轴和z轴上的陀螺;i代表x轴,y轴或z轴;<img file="FSB00001028975300013.GIF" wi="78" he="54" />代表<img file="FSB00001028975300014.GIF" wi="515" he="60" />代表<img file="FSB00001028975300015.GIF" wi="264" he="60" /><img file="FSB00001028975300016.GIF" wi="108" he="54" />Δt代表控制周期;n代表第n个控制周期,且n为正整数;(2)采集每个控制周期内推进系统输出在卫星笛卡儿坐标系x轴,y轴和z轴对应的喷气量<img file="FSB000010289753000116.GIF" wi="53" he="55" />;对x轴,y轴和z轴的角速度变化量<img file="FSB00001028975300017.GIF" wi="88" he="54" />和喷气量<img file="FSB000010289753000117.GIF" wi="56" he="57" />连续累加到10s,得到角速度变化量累加值<img file="FSB00001028975300018.GIF" wi="160" he="160" />和喷气量累加值<img file="FSB00001028975300019.GIF" wi="154" he="160" />当x轴,y轴和z轴中第i轴在所述10s内同时满足如下两个条件时,令陀螺+喷气诊断标志位加1,否则陀螺+喷气诊断标志位为0:喷气量累加值<img file="FSB000010289753000110.GIF" wi="217" he="160" />秒,角速度变化量的累加值<img file="FSB000010289753000111.GIF" wi="346" he="160" />弧度/s,其中:m的值域为2到3之间;(3)若陀螺G<sub>x</sub>,G<sub>y</sub>,G<sub>z</sub>和G<sub>s</sub>输出的角速度增量<img file="FSB000010289753000112.GIF" wi="378" he="60" />和<img file="FSB000010289753000113.GIF" wi="78" he="53" />不满足平衡方程<img file="FSB000010289753000114.GIF" wi="744" he="82" />且陀螺+喷气诊断标志位大于0,则判断第i轴陀螺故障;其中:<img file="FSB000010289753000115.GIF" wi="79" he="54" />为卫星上斜装陀螺G<sub>s</sub>输出的角速度增量;δ为平衡方程的判断阀值,值域范围为0.0035Δt~0.00875Δt,Δt为控制周期;α为斜装陀螺G<sub>s</sub>与x轴,y轴和z轴的夹角,α=54.73°;(4)若陀螺G<sub>x</sub>,G<sub>y</sub>,G<sub>z</sub>和G<sub>s</sub>输出的角速度增量<img file="FSB00001028975300021.GIF" wi="378" he="60" />和<img file="FSB00001028975300022.GIF" wi="79" he="54" />满足平衡方程<img file="FSB00001028975300023.GIF" wi="742" he="80" />且陀螺+喷气诊断标志位大于0,则判断有喷管堵塞,切换一次自锁阀。 |
地址 |
100080 北京市2729信箱 |