发明名称 一种陀螺测量系统的故障诊断方法
摘要 一种陀螺测量系统的故障诊断方法,包括以下步骤:(1)确定陀螺属于何种构型,之后计算陀螺之间的夹角关系;(2)确定陀螺平衡方程的权系数;(3)确定判断陀螺排序;(4)根据步骤(3)中确定的判断陀螺排序结果,设计平衡方程;(5)设计故障诊断方法。本发明方法能大幅度提高陀螺故障诊断的概率,工程可实现性强,能适应任何复杂构型的陀螺故障诊断。
申请公布号 CN103234553B 申请公布日期 2015.08.19
申请号 CN201310108771.8 申请日期 2013.03.29
申请人 北京控制工程研究所 发明人 王新民;袁军;张俊玲;姚宁;曹永梅;程莉;周剑敏;赵性颂;王哲;魏懿
分类号 G01C25/00(2006.01)I 主分类号 G01C25/00(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 安丽
主权项 一种陀螺测量系统的故障诊断方法,其特征在于,包括以下步骤:(1)确定陀螺属于何种构型,之后计算陀螺之间的夹角关系;(2)确定陀螺平衡方程的权系数<img file="FDA0000699649440000011.GIF" wi="620" he="85" />R<sub>n</sub>为引入陀螺{i<sub>1</sub>,…,i<sub>n</sub>}n=4,5的安装位置矩阵,且R<sub>n</sub>=[O<sub>gi1</sub>,O<sub>gi2</sub>,...,O<sub>gi(n‑1)</sub>]<sup>T</sup>,O<sub>gij</sub>(j=1,...,n,n=4,5)为陀螺的安装位置;(3)确定判断陀螺排序;所述确定判断陀螺排序的方法如下:(3.1)根据引入陀螺数据的序号,按从小到大排列,得到序列{i<sub>1</sub>,…,i<sub>n</sub>};(3.2)将陀螺分成<img file="FDA0000699649440000012.GIF" wi="157" he="80" />组,记对应评价值为max_minA<sub>1</sub>、max_minA<sub>2</sub>、…、max_minA<sub>N</sub>;(3.3)计算max_minA<sub>k</sub>,k=1,...,N,其中max_minA<sub>k</sub>=max(abs(Q<sub>giRk</sub>))/min(abs(Q<sub>giRk</sub>)+1e‑8),Q<sub>giRk</sub>=[O<sub>gim</sub>·inv(R<sub>k</sub><sup>T</sup>R<sub>k</sub>)R<sub>k</sub><sup>T</sup>,‑1],R<sub>k</sub>为第k组陀螺安装位置矩阵,O<sub>gim</sub>为引入陀螺中不属于第k组陀螺的其他任一陀螺的安装位置;(3.4)取max_minA<sub>k</sub>,k=1,...,N中最小值,并将对应的组合作为确定判断陀螺排序组合,组合里的四个陀螺作为排序后新组合的前四个陀螺,而没有包含的另外一个陀螺作为新组合中的第五个陀螺;(4)根据步骤(3)中确定的判断陀螺排序结果,设计平衡方程;所述根据确定出的判断陀螺排序结果,设计陀螺平衡方程为ε<sub>Δ</sub>=O<sub>giR</sub>·g‑dg<sub>i5'</sub>;其中,O<sub>giR</sub>=O<sub>gi5'</sub>·inv(R<sup>T</sup>R)R<sup>T</sup>,R=[O<sub>gi1'</sub>,O<sub>gi2'</sub>,O<sub>gi3'</sub>,O<sub>gi4'</sub>]<sup>T</sup>,g=[dg<sub>i1'</sub>,dg<sub>i2'</sub>,dg<sub>i3'</sub>,dg<sub>i4'</sub>]<sup>T</sup>,(i<sub>1</sub>',i<sub>2</sub>',i<sub>3</sub>',i<sub>4</sub>',i<sub>5</sub>')为新组合,dg<sub>i1'</sub>,dg<sub>i2'</sub>,dg<sub>i3'</sub>,dg<sub>i4'</sub>,dg<sub>i5'</sub>为陀螺测量输出;(5)设计故障诊断方法;所述故障诊断方法为:当五个陀螺工作时,所述陀螺系统故障诊断方法为:如果五陀螺的平衡方程不满足预设的判断阈值,连续m<sub>fault</sub>次以上则认为有陀螺故障,则先构造由四个陀螺测量输出组成的<img file="FDA0000699649440000022.GIF" wi="216" he="79" />个不同的四陀螺平衡方程,并对平衡方程残差幅值设计不同判断区间,不同判断区间赋予不同的记分分值,连续ΔT秒后对分数最低的对应陀螺记次器加1,如此反复进行,如果判断出有陀螺故障且仅一个陀螺的记次器超过m<sub>faultM</sub>次,则该记次器对应的陀螺故障,否则重新进行故障判断,m<sub>fault</sub>、ΔT和m<sub>faultM</sub>均为预设值;当四个陀螺工作时,所述陀螺系统故障诊断方法为:在判断四个陀螺的平衡方程时,先构造由四个陀螺测量输出组成的4个不同的四陀螺平衡方程,再对平衡方程残差进行判断,如果连续m<sub>fault1</sub>次最大的残差幅值超过允许门限,则有陀螺故障,再根据红外地球敏感器和数字太阳敏感器或者单独采用星敏感器信息定位故障陀螺,由红外地球敏感器和数字太阳敏感器或者单独采用星敏感器信息确定的姿态与各陀螺输出数据的相关性组成4个新的平衡方程,每隔ΔT<sub>1</sub>时间判断一次,如此反复进行,如果陀螺有故障且连续m<sub>fault4</sub>次不满足新平衡方程,则认为新平衡方程对应的陀螺故障,m<sub>fault1</sub>、ΔT<sub>1</sub>和m<sub>fault4</sub>均为预设值。
地址 100080 北京市海淀区北京2729信箱