Զѧ
ACTA AUTOMATICA SINICA
1997 23 5 Vol.23 No.5 1997



ڶഫϢںϵĻ
ϰͻģ
ơ
ժҪͨںϾͼͲɫͼΪƶʽ˹άģͼϰ.УģͲ˶ֱĶάʾṹϺõؽ˼ٶȺģ;֮ìܣں㷨ƹDempaser-Shafer֤(DSTE)ΪϺõؽںϢ⣻ۼϵͳ㷨ʵ¾ԣЧѱʵ֤.
ؼʡƶʽˣģϰ⣬ഫںϣ֤.
MOBILE ROBOT OBSTACLE DETECTION AND ENVIRONMENT
MODELING WITH SENSOR FUSION
WU YONGGEHUANG JIONGYANG JINGYU
(Dept. of Computer Science, Nanjing Univ. of Sci. & Tech. Nanjing 210094)
AbstractIn this paper, modeling 2D environment and road detection for mobile robot by fusing color and range image information are discussed. The environment model is constructed using multiresolution 2D grid representation, which is proved to be a better solution to the tradeoff between accuracy and computation speed. The fusion algorithm is designed with a generalized Dempster-Shafer theory of evidence (DSTE), which is efficient in dealing with dependent information. The multisensor system and fusion algorithm are tested in real environment and their effectiveness is proved.
Key wordsMobile robot, environment modeling, obstacle detection, sensor fusion, theory of evidence.
1
ഫںϵͳЧؽģ㣬ȷع۲ͽͻ12.˽ഫںϵͳԽԽӦڸϵͳƶʽܻ˵ԶеһҪӦ.ڴ˴ĹдṩĹ۲ϢںϳڵĻһûкܺý⣬رǵʻҰ⸴ӵĻ.
Ҫɼ״ͲɫɵƶʽϵӾϵͳ䴫Ϣں.Ȼڲɫͼ;ͼ֮ĻԣںϽܸȷṩйϰʻ·ĻϢ.
Ϣںϵķܶ࣬Dempster-Shafer's֤(DSTE)Ӧõý϶һ.DSTEӦҪϲ֤໥ʵӦ.磬ڱ۵ƶʽӾϢںоͲϢ.ˣDSTEʵƹ㣬ʹҲܹϢǱҪ.ĵϢں㷨ǻƹDSTE.
⣬ȷģ͵Ľṹʱ2άģ͵ĻϽ϶ֱʷӶϺõؼģ;ȺͼٶҪͬʱ2άģҲڻ˵ĵ·滮.
2Ϣͻģ
һĵ˵ֻҪжĳһضĵ·Ƿϰ͹ˣϸ.Elfesһڻ˵ӿռʶ3ݣͨǡ򡱡ϰ򡱻δָӿռ(ΪĸԪ)״̬.ģ͵ôǱڵ·滮Ҫڴͻѽ϶ļʱ.
ΪһָĽĲöֱʵĶάӿռʶЧؼټ㿪ͬʱ֤ϸߵľ.
νֱʵ2άӿռʶǹ㲻ֱͬʵ2ά·ʶͼ(ͼ1)вl,l-1,k(kl)ֱ2l2l2l-12l-1,2k2kԪһϵĵԪһеһ22ӿϵ.

ͼ1ֱʵ2Dͼ
ڶֱʶάӿռʶĻģ͹£
1)·2άӿռͼͼ״ﵽ2άӿռͼͶӰ仯TcTrԤĲɫͼ;ͼϢͶӰ2άӿռͼУ
2)ÿԪнϢںϴںϵĽжϸǿաϰﻹδ֪͵õһ2άʶͼ
3)˱ʶͼķֱҪ󼴿ֹͨԪķֽ⽨һӿռͼϰδ֪ϢͶӰһӿռͼȥ
4)ת2.
ģ;һЩܺõʣڲͬϢĶӦϢںϺ·滮ʵֵ.
3֤ۼڴںеӦ
Dempster-Shafer֤ۣ5(DSTE)ǱҶ˹ƹ㣬ֱǿԼڴδ֪ȸʸЧԣ˱㷺ڶഫϢںϼ˹.
3.1DSTEĻڶഫϢںϷӦ
DSTEһϦ(Ϊ)ΪĳһȫĲǰļϣ۵ⶼǦһӼDSTEµĻʷ亯(BPA)

(1)
BPAֵ0ӼΪԪ.
m1ǵǰ֪BPAһµĶ֤Դõm2µBPAµϹʽ㣺

(2)
ȻڶഫںӦУÿϢԼӰBPAдϢĹͬÿϹʽ㣬DSTEڽں.
3.2D-S֤۵ƹ
DSTEеϹڻȡ֤(Ϣ)޸ļŶȵҪ.ǣùֻ֤ݶ²Ч֤ݶһǿܶ¶ϸ5.Ȼо߼ƶֱʹDempster's򣬵Ϊ֤ݼ򵥵Ϊ֤ȻʹںϽƣDSTEн֤ݵĺϲǺҪģرǿɿԷ.ף58ݴӼ֤ͬݵں.Ľһ֤Ϲ򣬲Դ֤.
DSTEһ֤ṩϢĶٺĽԪйأ˿Զ֤ݵϢE(Ev)£

(3)
УAiǽԪAiĻn(Ai)ǽԪصĸ.
֪E(Ev)ʣ01.i,m(Ai)=0,E(Ev)=0֤EvΪ.EvκõϢ.Ai=1m()=0,E(Ev)=1,EvϢ.
֤Ev1Ev2BPAΪm1m2ԪΪAiBj.صһǵĳЩԪϵõӳֽԪΪؽԪΪDij,BPAΪmDϢΪ

(4)
E(Ev1,Ev2)=0ʾ֤Ev1Ev2໥E(Ev1,Ev2)=1E(Ev1)E(Ev2)(E(Ev1)E(Ev2))ʾEv1Ev2(Ev2)E(Ev1,Ev2)֤ݼ.
1.֤Ev1Ev2ضΪ

(5)
2.֤Ev1Ev2R12

(6)
֤Ev2Ev1ϵR21

(7)
Dempster֤ϹƹΪ3.
3.֤Ev1Ev2ͬһܦµBPAֱΪm1m2ԪؼֱΪ
Ai,i=1,2,,kͣBj,j=1,2,,l.µBPAΪ

(8)


(9)

(10)
֤(8)ʽõBPA(1)ʽҵR12=R21=0ʱ˻Ϊ(2)ʽ.
4ƹDSTEĲɫ;ͼں
ԭʼͼԤתԴΪĵֱϵµľԾͼ󣬲ʹX-YƽΪ棬

(11)
RΪ״ﵽ࣬,طֱΪɨߵǺˮƽתǣz0Ϊ״ĸ߶.
ڲɫͼһֵ˲ȥȻͨͼϢѹʹ֮ú޵ļɫֵ(r,g,b)·ϰ.
ںϵĲɫͼ;ͼϢͬһĶӦϢ.ϢĶӦͨУ׼ֱɫͼ;ͼϢ2άԪͼı任TcTr9ʵ.TcTrֱͶӰͬһԪľͼͲɫͼϢΪǿںϵĶӦϢںϵĽΪԪΪաδ֪ϰ.
趨ܦΪOPIԴ·еĿͨ(Pʾ)ϰ(OʾΪڵ28׵)Ϣ޷ȷδ֪(Iʾ).ھԾͼа˵Ϊ(x,y)ĵĸ߶zܹ׵شгȡϢԪƽ߶ȡԪķ͵(Ϊˮƽ)ļнǦԪ߶ȷֲķvɲɫͼ󻹿ɵõɫֲֵC(ÿԪгֵɫֵļ)ֿΪȷÿԪ͵֤.ڵ
1)ȷÿ֤ݵBPA2)ȷۺ֤ݺõµBPAֵ.
Ϊȷÿ֤ݵBPAʹõ֤()͵Ԫ֮Ĺϵ.
1)֪=90ʱԪΪһƽ棬ʵԪдϰĸf=cos.
2)£ƽĸ߶ȷֲ(v0ʾ)ӦΪ0Ӱv00.ˣvv0ʱΪԪΪƽ棬赥Ԫдϰĸ
kһ.
3)һ£ĳԪΪΧһ·浥Ԫ.Լ裺·ģͻȻĽʱ仯.ԣֵжһԪǷΪ·ʱӦۺϿΧԪֵ.Ϊ˶һ33.贰ȫԪƽ߶ҴĵԪƽ߶Ϊ0ҼĵԪƽ߶ΧĵԪһҽӽ0ΪĵԪΪ·˿ĵԪΪ·ĸkǲ.
4)ͨ·ϵɫֲֵC0ͳƵķߵȷ.·ԵĽʱ仯һ(¶ܱ)C0Ϊֵ.ȻĳһԪɫֵķֲCC0õԪ·ĿŶȽϸߣ˵ԪΪ·ĸӦ
׼ĸBPAmi(i=1,4)Ǽ򵥺ûһȷֻܸݴʵĽȷǵĽʽ1ʾ.
1
OPIOPP,IO,I
m1(*)01-k1fk1f00000
m2(*)0k2fv2/3(1-k2fv)1/6(1-k2fv)01/6(1-k2fv)00
m3(*)05/6(1-k3fc)000
m4(*)0(1-k4fc)/3k4fc2/3(1-k4fc)0000

ʹɾͼȡԭǾͼķֱʵͶǳǿΪҪͨϢȵķ֤һȵںϽ.һ棬ͬԴ(֤)֮ȻDempsterϹЧʹDSTE.
ĳһϵÿԪȸݹϹ(8)ʽ㵥ԪϢۺBPAֵȻµķ׼ȷõԪ(OIP).
1)ȷĿBPAֵ
2)ȷĿBPAֵBPAֵĲһֵ
3)ȷĿǡPBPAֵĳһϴֵ.
׼У1)ٶŶһĿࣻ2)ҪĿĿŶȱִڶĿŶȣ3)֤ȷĿΪPʱеĿŶȷǳߣӶԱ֤ʻĿɿ.
еĵԪΪPOIһ2Dģ;͹.ҪΪȷģͣɶеϢϸȻͶӰһͼԽһں.
5ʵ
Ϊ֤ںϷЧԣһϵдԵʵ飬·Сϰƽֱ·.ͼ2ͼ3Ϊʵ黷֮һϰĵ·ͼ2ΪԤĲɫͼͼ3ΪԤľͼ.ͼ4ں㷨2DṹģͣбΪOϰPΪ򣬡IΪδģͼ4ķֱʽϵ.һ棬ڱĵں㷨ΪԪ׼(3)趨һϸߵֵȻȷΪPĵԪвϰͬʱϸߵ龯ʣһЩûлвϰռĵԪΪO.ͼ4УΪյ·խ޷ͨ·ʵ.ʱҪȷؽе·滮Ҫи߾ȵĵ·ģ.ͨͶӰϸͼ4ĻϽһںϼɵõͼ5ʾĸ߷ֱʵĻģͣǳϰλøȷ.Ȼͨظù̻ܵõ߷ֱʵĻģ.

ͼ2

ͼ3

ͼ488ֱʵںϽ

ͼ51616ֱʵںϽ
еʵķȶɿ.õĻڶֱʵ2D·ģṹʵϢںϺ͵·滮Եؽ˼.ĻƹDSTEϢں㷨ЧؽںϢ⣬ںϽĿɿ.
߼飺
1968.1990ҵϾѧѧϵ1993Ͼѧϵ˶ʿѧλ.ʦ.оΪӾϢںϵ.ѷ20ƪ.񲿼ƼһȽ.
ơ19931996Ͼѧֱѧʿ˶ʿѧλΪϾͬϢҵܾ.ĿǰоȤΪƵ.
ϾѧϵΡڡʿʦ.оȤΪӾܻ˵.ѳ680ƪʡϿƼ.
ߵλϾѧϵϾ210094
ο
1ݡ.ഫںϵĸʵ.ˣ1995()564568.
2ݡ.սںϼ.ҵ磬1994.
3ݡElfes A. Using occupancy grids for mobile robot perception and navigating. IEEE Computer, 1989, 21: 4657.
4ݡshafer G. A mathematical theory of evidence. Princiton, NJ:Princiton University Press, 1976.
5ݡVoorbraak F. On the justfication of Dempster's rule of combination. Artifical Intelligence, 1991 48:171297.
6ݡBazzi Y A, Mitchell B T. Reasoning under uncertainty with dependency information.proceeding of SPIE, 1988, 1003: 188193.
7ݡCheng Y Q, Wu Y G et al. Generalized integration method of evidence with dependency information. In:Proceeding of SPIE, 1992, 1828:288293.
8ݡФ˱.֤ݺϳɷо.ģʽʶ˹ܣ19936(3)227234.
9ݡLiu K et al. Calibration of multiple sensor by a planar calibration object. In:proceeding of SPIE, 1993, 1828: 499509.
ոڡ1995-12-12
