ѧ
JOURNAL OF ASTRONAUTICS
1999 2ڡNo.2 1999



ߵϵͳȷȫ̬
ϼ͸
Ԫţݷ
ժҪ̽ݷʱĹϼ͸뷽,żȷϦ2鷨,ϸƵݶʱļȻϸоļ㹫ʽ,ɳ˶Թݵĸ㷨,ʹƯһ΢С,÷׼ȷⲢݡ
ʡϡ⡡롡ż
THE SOFT FAULT DETECTING AND LSOLATING TO 
ENSURE THE ENTIRE ATTITUDE MEASURING OF 
A STRAPDOWN INERTIAL NAVIGATION SYSTEM
Qin Yongyuan Niu Huifang
(Dept.of Automatic Control Northwestern Polytechnical University.Xi'an.710072)
AbstractIn the federated filter design,the reliability of a strapdown inertial navigation system should be guaranteed absolutely because it is used as a common reference system.The paper investigates the way to detect and to isolate at most two faulty inertial components.The soft fault detection algorithm based on chi-square test is reviewed.The parity judgement function to isolate two faulty inertial components based on maximun likelyhood test is deduced in detail.The algorithm to search the faulty components is induced.The fault detection and isolation of the scewed redundant ring laser gyro cluster is simulated on the computer.The results show that the searching scheme can detect and isolate faulty components correctly even if the soft faults are as tiny as the gyro drifts.
Key wordsSoft fault Detection Isolation Parity vector
1
Ҫ̬Ϣ,ݱбúݴʧЧӲ,żУЧظʧЧ,ܱ仯,üȻϸ롣ֻͨоһʱĸ뷽2,Ȼݶйϵĸʲɺӡ̽ݷʱļ͸뷽
2Եϵļ͸㷨2
ĽٶΪ=ۦx y zT,ߵmб,Ưѵõ,鶼ʱĲΪ:
Z=H+š(1)
ZRm,Ϊֵ˹,Ϊҡ
ż
P=VZ(2)
VΪ(m-3)mľ,ȷ:
(3)
Ȼ,鹤ʱ,
P=Vš (4)
Pͳ:
(5)
DɶΪm-3Ħ2ֲTDΪĳһֵ,޹(H0)DԽTDΪ,ȡС,ɵ¹о׼:
DTD,жһݳ;
DTD,жݹ
j,Ǹ¼ΪHj,̳ⷽ:
Z=H++ejf(6)
ʽejΪZͬά,jΪ1,ȫΪ,fʾϴС,ȷף2ݸ˹ϸо:
(7)
ʽ,VjΪVĵj,Vj=VTjVj
(7)ʽֱD1,D2,,Dm,Dk(k=1,2,,m)Ϊ,жkݳϡ
3ݶʱļ͸㷨
ij,Ǹ¼ΪHij,i,j=1,2,,m,ij,Ϊ:
bf=eifi+ejfj(8)
ܴ,ɰݳϵ֮,ϸо(7)ʽ㡣
Сӽ,fifj=f,(8)ʽд:
bf=(ei+ej)f(9)

bf=(ei-ej)f(10)
(9)ʽʾʱ
P=V+f(Vi+Vj)(11)
f(Vi+Vj)Ϊȷ,ŷֲ̬,PҲֲ̬,ҾֵΪf(Vi+Vj),Ϊ2IPܶΪ:
(12)
ɴ˵ȻΪ:

ʽҲǹf߷,fȡ
(13)
ʱ,Ȼﵽֵ,ΪfļȻơʱ,ܶҲﵽ:
(14)
Ҫʹʽﵽ,дﵽ,ݶҹϴСӽͬʱĹϸоΪ:
(15)
ͬɵõijҹϴСӽ෴ʱĹϸоΪ:
(16)
4ϸķ
̽ݳϺоֵָʾĹʵʹݼĶӦϵΪ:ἤݵֱʮķ,ݴ16,(1)ʽH8p92(3)ʽ2,P(2)ʽ졣ͷڱ14,ڵΪ뺯ֵָʾĹݺ,*űʾжȷ
1ݳʱоֵָʾ

AD
123456
C
0.01BDj(1)*(2)*(3)*(4)*(5)*(6)*
D+i,j(3,5)(2,3)(1,5)(2,5)(1,3)(1,2)
D-i,j(1,5)(1,6)(2,6)(1,4)(4,6)(2,3)
-0.01Dj(1)*(2)*(3)*(4)*(5)*(6)*
D+i,j(3,5)(2,3)(1,5)(2,5)(1,3)(1,2)
D-i,j(1,5)(1,6)(2,6)(1,4)(4,6)(2,3)

ע:A(/h)BоCоֵָʾݺšDʵʹݺ
2ݳҹʱ
ֵָʾ

ABD
23456
1DjC
(1)*(1)*(1)*(1)*(1)*
D+i,j(1,6)(2,5)(1,6)(3,4)(1,6)
D-i,j(1,5)(1,4)(1,3)(1,2)(1,5)
2Dj(2)*(2)*(2)*(2)*(2)*
D+i,j(1,5)(2,4)(2,4)(2,6)
D-i,j(1,2)(1,6)(1,2)(4,5)
3Dj(3)*(3)*(3)*(3)*(3)*
D+i,j(1,5)(1,4)(1,5)
D-i,j(2,6)(3,6)(2,4)
4Dj(4)*(4)*(4)*(4)*(4)*
D+i,j(1,3)(4,6)
D-i,j(1,4)(2,3)
5Dj(5)*(5)*(5)*(5)*(5)*
D+i,j(1,3)
D-i,j(2,4)

ע:Aݺ,0.05/hBоCоֵָʾݺšDݺ,0.005/h
3ݳҹͬͬʱоֵָʾ
ABD
23456
1DjC
(6);(5)(5);(4)(6);(3)(3);(2)(6);(1)
D+i,j(1,2)*(1,3)*;(4,5)(1,4)*(1,5)*;(2,3)(1,6)*;(3,5)
D-i,j(5,6)(1,4);(2,4);(3,4);(4,5)(3,6)(2,6);(1,2);(2,5)(5,6);(1,3);(2,6)
2Dj(2);(3)(2);(4)(4);(1)(2);(6)
D+i,j(2,3)*;(1,5)(2,4)*(2,5)*(2,6)*
D-i,j(2,5);(3,5);(2,6)(1,6)(1,4)(4,5)
3Dj(2);(1)(1);(6)(2);(5)
D+i,j(3,4)*(1,6);(3,5)*(3,6)*
D-i,j(1,2)(1,3);(5,6);(1,5)(2,5)
4Dj(4);(5)(6);(4)
D+i,j(1,3);(4,5)*(4,6)*
D-i,j(1,4);(3,4);(2,4);(3,5)(2,3)
5Dj(4);(3)
D+i,j(5,6)*
D-i,j(3,4)*
ע:Aݺ,0.1/hBоCоֵָʾݺ
Dݺ,0.1/h
4ݳҹͬ෴ʱоֵָʾ
ABD
23456
1DjC
(1);(2)(1);(3)(1);(4)(1);(5)(4);(1)
D+i,j(3,4)(1,6);(3,4)(2,5)(1,2);(2,5);(3,5)(2,4)
D-i,j(1,2)*(1,3)*;(2,6)(1,4)*(1,5)*;(3,6);(1,6)*
2Dj(6);(4)(5);(3)(2);(5)(3);(1)
D+i,j(4,6)(3,6);(1,3);(1,5)(3,6)(1,5);(1,4);(3,5)
D-i,j(2,3)*(2,4)*;(3,5)(2,5)*(2,6)*;(1,3)
3Dj(3);(4)(5);(3)(3);(6)
D+i,j(5,6)(3,6);(1,3);(5,6)(1,4)
D-i,j(3,4)*(3,5)*;(2,4)(3,6)*
4Dj(2);(6)(1);(5)
D+i,j(2,6)(2,5);(1,2);(1,3);(1,6)
D-i,j(4,5)*(1,5);(4,6)*
5Dj(5);(6)
D+i,j(1,2)
D-i,j(5,6)*
ע:Aݺ,0.1/hBоCоֵָʾݺ
Dݺ,-0.1/h
5ͽ
ɿ:ֻһ,ʱ,DjֵָʾĹݺŹ̶,ȷָʾ;ҹӽʱ,D+i,jD-i,jֵָʾĹж,һȷ,˳ָʾĹʵʵĹݡϷ,ɵöԹ͸ͼͼ1ʾ

ͼ1ݹоݵͼ
ߵλҵѧԶϵ..710072)
ο
1Patton R J,Chen J.Robust Fault Detection and Isolation (FDI) Systems.Control and Dynamic Systems,1996,174:171-224
2Potter J E,Suman M C.Thresholdless Redundancy Management with Arrays of Skewed Instruments.AGARDOGRAPH-224,1977:15-115-25
3Kerr T H.Decentralized Filtering and Redundancy Management for Multisensor Navigation.IEEE Trans.on Aerospace and Electronic Systems,1987,23(1):83-118
4Frank P M.Advances in Observer-based Fault Diagnosis.Proc.Int.Conf.on Fault Diagnosis,TOOLDIAG'93,Toulouse:817-836
5Lou X,Willsky A S,Verghses G C.Optimally Robust Redundancy Relations for Failure Detection in Uncertain Systems.Automatica,1986,22(2):333-344
6Watanabe K,Himmelblau D M.Instrument Fault Detection in Systems with Uncertainties.Int.J.Syst.Sci.,1982,13(2):137-158
7Daly K C.Generalized Likelihood Test for FDI in Redundant Sensor Configurations.Journal of Guidance and Control,1979,2(1):9-17
8Թ.Եԭ.չҵ,1987һ:91-92
ΪջĿ
ո:1996111,޻:1998219
