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



Ԫݴϵϵͳ
꿡Ԭ
ժҪݴϵϵͳеĶഫϢں,һڶഫϵϵͳϢںϵԪͨʵ,ַ֤Ŀ,˸оڵ,˿ܽļ;,Ԥδķչơ
ʡϵϵͳԪݴԡϢں
FAULT-TOLERANT INTEGRATED 
NAVIGATION SYSTEM BASED ON NEURONS
Ma Xin
(Department of Automation,SDUT.Jinan.250061)
Yuan Xin
(Department of Automatic Control,NUAA.Nanjing.210016)
AbstractIn this paper,multisensor data fusion of fault-tolerant integrated navigatin system is discussed.A neural approach to data fusion is proposed for multisensor integrated system.The simulation results show that this neural approach to data fusion is available.The paper analyzes the problems still existing,provides a few possibly available methods for these problems,and predicts the future tendency in this field.
Key wordsIntegrated navigation system Neuron Fault-tolerant Data fusion
1
ִĺԵϵͳľȺͿɿ涼ԽԽߵҪ,߲ƺﵽҪľȺͿɿʮ޵ġϵϵͳߵȡɿ,ѳΪչķΪ˳ЧöഫṩϢ,ǲϽϢĺܶ¼оϢںϵľ巽Ŀǰ,Ѱһּ򵥡ЧʵõϢںϷһоҪ⡣
ԪеĲнṹѧϰʽ,ṩһµϢںϷһְԪΪںĵݴϵϵͳ,ͨ,֤˸÷Ч,һ˸оڵ,˿ܽļ;,Ԥδķչơ
2ݴϵϵͳĻ˼
ڶֵ豸ۺϵĵϵͳ,ഫں㷨ԷΪ:һһе˲ȫϢ,ַŵϢʧ,ȱǲ˲Ľ״̫,̫,һϵͳ,ֱӰϵϵͳ,ʹϵʧЧڶ෽ÿֵϵͳһ˲ϢԲֲ״̬,Ȼֲ״̬Ϣݸں,Բһȫֵ״̬,ַһݴھֲ˲н,ںĵļ,ڸֲ״̬ǾֲŽ,ںҪǸֲ״̬ƽԡֲ֪״̬ЭĻ,Ҫʷݽоȷơף1ܽ˸ֹЭķȻ,Ҫ֤ЩЧ,Ҫ״̷̬ǳȷN.A.CarlsonϢԭΪ˲㷨2,3,4,ַϢغԭڸ˲˲ϵͳϢ,㷨򵥡ṹҾкǿݴԡF.N.Chowdhuryһ״̬ƵԪںϷ5,ַҪȷƷ,ǲ߱ݴԡڸ˲ϼ뷽,öԪΪںĵݴϵϵͳԭͼͼ1ʾ˼:ɸõĹ۲ֱ𾭹˲KFi,(i=1,2,3)˲õľֲ״̬Xi,Ȼòв2鷨Ըйϼ,жϴǷ,ӶݴĹ,ϴ,ȷӦѡԪΪں,ںδϴľֲŽȫֵŹƽ⡣

ͼ1Ԫݴϵϵͳṹͼ
3Ԫں
3.1
ɢϵͳģ:
X(k)=(k,k-1)X(k-1)+(k,k-1)W(k-1)(1)
X(k)Rnϵͳ״̬,(k,k-1)Rnn״̬һתƾ,(k,k-1)Rnrϵͳ,W(k-1)Rrǰ,E{W(k)}=0,E{W(k)WT(j)}=Q(k)kj,
ϵͳNֵ,ӦNֲ˲,ÿ˲ɶ˲㡣iֲ˲ģΪ:
(2)
Zi(k)Rmiǵiֵ,Xi(k)Rnɵiֵ۲⵽ϵͳ״̬,Vi(k)RmiжW(k)İ,E{Vi(k)}=0,E{Vi(k)VTi(j)}=Ri(k)kj,ʼ״̬Xi(0)Ƕĸ˹,E{Xi(0)}=Xi0,E{Xi(0)XTi(0)}=Pi(0),ɿ˲̿ɵõֲ״̬
3.2ں㷨
ȫ״̬Nֲ״̬iӦЭPiֵ,
(3)
ΪƵļ,Լ˺ܶȺǱ׼ֲ̬:
(4)
ǵĿľøֲ״̬iӦЭPiʾȫ״̬FЭPF=2Fһ·ֲ,ܶȺf(X|i)ϸܶȺf(X-1,X-2,,X-n)(ΪһȻ)
(5)

ϸܶȺɱʾΪ:
(6)
άΪ:X=(n1),u=(nN1),e=(nNn),S=(nNnN),F=(n1),PF=(nn)
Ȼ,ɵüȻF:
ɡl=(u-eX)TS-1(u-eX)(7)
 (8)
á(9)
(9)ʽɼ,Ϊ˵õȫ״̬ƽ,ڸֲЭϢδ֪,ҪȷƾSȻʽ(9)֪,ʵϲҪ֪S,ֻҪõeTS-1e-1eTS-1ĹֵD=eTS-1e-1eTS-1
򡡡F=Du(10)
Fһ,Nֲ״ֵ̬,SNNά,Dһ1Nʸ,Ϊ١ٶiֲ״̬ƵķǦ2i,Ҹֲ״̬޹,SǶԽ,ʸDĵiԪΪ:
(11)
ȻDԼ:
(12)
Ӷ,Ϊ˵õȫ״̬ƽ,ֻҪȨ,Ʒ
3.3ԪΪں
ڶԸֲ״̬ںϴǰ,òв2鷨Ըйϼ6ݡȻݸĹ,ȷӦѡԪΪںġΪʹϵͳݴ,ڲͬйʱ,ӦѡͬԪٶƵϵϵͳĴĹ:(1)ȫ;(2)ϵͳSINS/GPS,GPS;(3)ϵͳSINS/TAN,TAN;(4)ϵͳSINS/DNS,DNS;(5)ϵͳSINS/GPSSINS/DNSSINS/TANSINS/DNS,SINSϡӶӦԪÿԪ,ӦnԪ,Ҳ˵һԪһ״̬Ĺں(״̬ںϵ),ݴϵϵͳںҪ5nԪ
ÿԪN롢һ,ͼ2ʾͨںN۲⵽ĵjϵͳ״̬,i=1,2,,N,õjϵͳ״̬ȫֹƽ⡣Ԫ򵥵Ԫ,0Ϊֵ

ͼ2ΪںĵԪ
ӦôѵԪȷȨֵ,ľֲ״̬Ϊ,Ӧʵ״̬ΪXTm,mΪXmΪNmάΪʹϵͳ,ӦʹmNѵĿľʹںϷ:
D(opt)Xm=XTm(13)
D(opt)ȨʸѧϰΪDṩһ㷨,ȨسֵΪһС,ںĵ,Ȩ湫ʽ:
Dk+1=Dk+ǦkXm(14)
ЦΪѧϰ,0ǣ1,kΪk
k=XTm-Dk/Xm(15)
,ÿһ,ӦDԼ(12)ʽѵ,ȨDһ̶,ʱԪͿΪһںĳһִ,Ըľֲ״̬ˡѵ߽еġ
4
4.1ѧģ
Ƶݴϵϵͳͼ1ʾ˲״̬Ϊߵϵͳ,üӷֱӹƹߵϵͳ,УУߵϵͳĲ,õֲ״̬ơߵϵͳΪָλϵͳ,öϵ,ȡƽ̨ǦE,N,U,λL,Ħ,h,ƯƦbxbybzrxryrz,ٶȼƯx,y,zΪ״̬,ϵͳ״̵̬ɢʽΪ:
X(k)=(k,k-1)X(k-1)+(k,k-1)W(k-1)(16)
SINS/GPSλáٶۺ,ֵ:һΪϵͳλòֵ;һΪϵͳٶȲֵGPSֻSASINS/GPSϵͳ۲ⷽΪ:
ZG(k)=HG(k)X(k)+VG(k)+G(k,G) (17)
SINS/TANSITAN㷨,ֵǸݹߵϵͳֵͼϢƵԸ߶Ⱥߵ߶ȱԸ߶֮,һά,ⷽΪ:
ZT(k)=HT(k)X(k)+VT(k)+T(k,T) (18)
ڹߵϵͳֱͨǲȶ,״ṩĴֱٶȾֺܵ,ϵͳSINS/DNSǴֱͨϵͳ״ֱ̬ٶʹֱλ,DNSĿ̶ϵKDopplerٶ,״̬Ϊ18סȡߵϵͳٶ״ٶȵĲֵΪֵ,ⷽΪ:
ZD(k)=HD(k)XD(k)+VD(k)+D(k,D)(19)
ϸʽоF(t),G(t),HG(k),VG(k),HT(k),VT(k),HD(k),VD(k)ף6;G,T,DΪ,ʾϴС;(k,)Ƿֶκ,ЦǹϷʱ䡣
ɻķй켣רŵķ,ṩʱ䡢ʱλáٶȡ̬̬ٶȼٶȵϢлܡɡߡת䡢ƽɵȹ,ܷʱΪ1000sĳʼݼ1
1ʼݼ

Ρֵ
ʼλ(γ,,߶)L0,0,h0N32,E118,5m
ʼλL0,Ħ0,h030,30,5m
ʼٶVE,VN,VU0.6m/s,0.6m/s,0.6m/s
ʼ̬Ǧx,y,z300,300,600
ݰƯƦgx,gy,gz0.01/h,0.01/h,0.01/h
ݳֵƯƦbx,by,bz0.1/h,0.1/h,0.1/h
һɷƯƦrx,ry,rz
Trx,Try,Trz0.1/h,0.1/h,0.1/h
7200s,7200s,7200s
ٶȼһɷƫax,ay,az
Tax,Tay,Taz10-4g,10-4g,10-4g
1800s,1800s,1800s
GPSջ(C/A)
(λò)PE,PN,Ph
TPE,TPN,TPh25m,25m,25m
100s,100s,100s
GPSջ(C/A)
(ٶ)VE,VN,VU
TVE,TVN,TVU0.05m/s,0.05m/s,0.05m/s
100s,100s,100s
ֵͼm5m
ߵ߶ȱr5m
DNS̶ϵƯƦҦK0.25%
Dopplerٶ
һɷƫ
ҦVD,TVD
1000m/h,300s


Ϊ˶ִµԪѵ,Ҫѵ,ֱٶ(1)ȫ;(2)GPS;(3)TAN;(4)DNS;(5)SINSϲѵݡֻλL,,hں,,Ҫѵ15Ԫ
4.2ѵ
ÿԪеԪ(ֱL,,hں),Ϊ4ϵͳ״̬,ӦΪʵλ(L,,h)ÿԪѵ,ѵWidrow-Hoff(14ʽ15ʽ)ȨسֵΪ(1)/(4)ѵӦԼ(12)ʽ,Ϊѵʱ,ÿһУ,WǷΪ,Ϊ,Ϊ0
4.3
ѵ,ԪȨؾȷ,ʱͿôԪΪںġΪ˽бȽ,N.A.Carlson˲õںϹ(ڳʼʱ̷һϢ޷ģʽ)ͼ4Ϊʵ켣ѵù켣ͬʱֲںϹγȽߡʵ켣ѵù켣ܲͬʱ,ʵй켣ͼ3(a)3(b)ʾ,ںϹЧԺܺ,ͼ5ΪDNSt=100sϡʵ켣ѵù켣ͬʱĸ״̬ľȽߡ

ͼ3(a)й켣(γ)ͼ3(b)й켣(ȸ߶)

ͼ4ʵ켣ѵù켣ͬʱͼ5ʵ켣ѵù켣ͬDNS
״̬γȽߡ100ʱ״̬ľ
5
ķԿ,ԪݴϵϵͳĵȽϺ,Ҿݴ,ͳҪЭںϷַѧϰʱϳ,Ҳ߱Ӧԡ֪ЭݵĻ,ҲԽһֻԪں㷨,ǽһоμѵʱҲһҪ⡣,רϵͳ,ҲԽһں㷨ܡΪԪϢںϲǻϸЭ,ǻʵʵľ,רϵͳҲԪںϵܡһоȨصӦѧϰ,θݸĹ,ԶٵȨֵ֮,ֵԪںϷоո,๤ȴȥ
6
һֻԪݴϵϵͳ,ԪΪϵͳľֲ״̬Ϣں,Ҫ֪ЭϢ,ͳҪȷЭϢںϷʵ,ֵϵͳݴ,ҵȺܺá
ߵλ(ɽҵѧԶϵ..250061)Ԭ(ϾպѧԶ.Ͼ.210016)
ο
1Kim KH.Development of Track To Track Fusion Algorithm.Proc.American Control Conf.,June 1994:1037-1041
2Carlson NA.Federated Filter for Fault-Tolerant Integrated Navigation Systems.Proc.of PLANS 1988:110-119
3Carlson NA.Berarducci M.P.,Federated Kalman Filter Simulation Results.Navigation,1994,41(3):297-321
4Carlson NA.Federated Square Root Filter for Decentralized Parallel Processes.IEEE Trans.on Aerospace and Electronic Systems,1990,26(3):517-525
5Chowdhury FN.A Neural Approach to Data Fusion.Proc.American Control Conf.1995,1693-1697
6Ԭ,,ܱ.ϵͳ.:չҵ,1993
ΪƼԤлĿ
ո:1997418,޻:1998323
