Զѧ
ACTA AUTOMATICA SINICA
1999 25 1 vol.25 No.1 1999



˹߸ٵӾƼɷ1)

ƽ֡»á¾

ժҪӾĻ˹߸ٿ⣬ӾĲصӾƼɵĿƷڸٹʵֵٶȿƣڷʵλÿƣһλɲͼֱӻãһпʵŷϵӾʹϵͳܵõߣСӳ(26.4mm26.4mm)ٶȴﵽ250mm/s.
ؼʡӾŷ߸٣ֱ.
INTEGRATION OF VISION AND CONTROL FOR
ROBOT CURVE TRACKING
JIANG PingLIN JingCHEN Huitang WANG Yuejuan
(Dept.of Electrical Engineering,Tongji University,Shanghai200092)
AbstractAiming at high speed visual tracking,this paper presents a new control scheme from the point of integration of vision and control.To track a curve,the control is decomposed into two subfunctions.One is the velocity control which controls the center of a CCD camera to move along the tangential direction of the curve.The other is the position control which controls the cneter of the CCD camera to move in the normal direction approaching to the curve.In order to improve the tracking performances,the proposed control scheme was realized in servo rate by the aid of a transputer based parallel controller.The tracking speed reached 250mm/s with a small field of view(26.4mm26.4mm).
Key wordsVisual servoing,trajectory tracking,D.D.robot.
1
߻˶ԻӦԼٷӳĽǶȳо̽ӾΪԴŷγӾŷϵͳģ1ݲö̶ʽצǣλƫֱɿ.ģ2ݲֲʽù˶˻PILQGʵʱӾƷʵƽٶΪ2530mm/s.Ȼ߿ԵҪϰͼݵĲɼʱϣĿǰĶϵͳֻڵ25hzƵʵӾջ.
ӾĻ˶ƵһֵӦǹ߸٣34ݣԶ١ͼӹͼֽԶȣͨĹʽӾ߲λָʹеָټӹӾϢֻΪָݣδջٹ̵Ķ̬ƷԱ֤ڼٶʵƽȸ(1020mm/s).Ϊ˱ģ4ݵĻϲֲʽͼʵӾʵʱջ߸ٶȼƷ.ǵӾĹ߸ص㣬ҪеָȡľֲߣʹĲƫƽ˶ϸĹ켣Ҫ˱ĵӾŷһֲߵĻнУʵ򡢷ֽ⣬ϷֱòͬĿƷʽõٶȿƱ֤ٶȣλÿƱ֤λøپ.صٶȿƣ˲Ҫʵʱɹ켣˹ͼľֲ켣ν⣬ٶȿƱλÿƸƽȣⷨƫͼȡǳ㣬һӾͼ(40ms/֡)ɴŷ(2ms)ãʵ׼ŷµӾ(2ms)ͼɼĴʱŷƵʼì.һ˼·˻򡢷ֽĻ˷ɣ֤˸÷Ӧڸ˻Ӿ߸ٵĽȶԣһTransputerĻ˲пʵƣʵӾĸٹ߸٣26.4mm26.4mmСӳ¹߸ٶȿɴ250mm/sﵽԭٶȵ10.
2ֽĹ߸ٿ
ȡĴپֲͼ1ʾ.x-yΪ꣬ʸrͼ䷨ƫeӦ߽Ϊo䣬ʱ̿ɽȻϵi-j,iΪߵλjΪߵλɵ



ͼ1ϵi-j
ٹ߶Ի׵ڣoλڸùϣ

sΪ߻.ע⵽ЦΪ߽ǣΪȻϵתٶȣе˶йأKΪʣ,ɵ
(1)
Իе˶ٶiķͬʱɵù߸ٶ
(2)
(2)ʽ˵߸ٶеiٶȷȣϵʰ뾶eй.еֹռ䶯ѧΪ
(3)
ٶΪu()ٶev=ui-λep=ej,ٸĿߣ˿ĿΪ

ƻ򼰷ֽĻ˹߸ٿʵϿĿ.

1.ùؽڿռɿɱ֤ĶԹߵĽȶԣҸٶu,JΪеJacobian
֤.Lyapunov



(1)ʽáʽ

Ϊi,j

붯ѧ(3)

ɶԳԣʽɻΪ

ȡռ
(4)
򣬰ٶȸ.Ϊ˵e0(4)(3)ʽ


ٶd=ui,ļٶ

۵֤.
һɷԲԷֹɣṹͼͼ2ʾͼ2ɿƷֱ𱻷ֽϣзƫֱӸͼýλ÷ƣֻٶȷƣͼϢ붯ѧԸƸٸʱĶ̬Ʒ.


ͼ2ƿͼ
3ͼȡ
һӾ߸ٿ㷨ҪݲɼͼȷKi,jƫߵķƫe,ܷʵָٸͼȡʵʱԣΪǱΪİ취Ա֤һȡŷ(2ms).
ɼmͼIm,ٹϱΪһɫ״ؼͼСɫ߿ΪWminΪ˾ݴ˻ĸĹΧ(xo,yo)ӴWڱ߳Ϊd(d<<1/KKΪ)Ӵڱ߽˳ʱ¼ɫصn,nWminȷΪϵ㣬ɫصĿɵù봰ڵһ(x1,y1)ظϹ̿ɵһ(x2,y2)d<<1/K ļٶ£봰ڽ򱾴ιǿɼ
i=arctg 2(y2-y1,x2-x1)+m+nС(n=0,1).(5)
mΪϵ빤ϵתǶȣɱͼʱ̵ĻеֹؽڽǶȾnֵǰŷеǲֵi-1ȷi-i-1/2.
ߵλλɱʾΪ
i=cosi),sin(i)T,j=-sini),cos(i)T,(6)
ɽĵ㸽ֱֲ߷
sin()x-cos()y=sin()x1-cos()y1,
ƫߵķΪ
e=sin()xo-cos()yo-sin()x1+cos()y1.
i,j,e򼰷ķƲѿɣΪ˽жѧKʵKڿֻڼļٶ,ֻҪ㼴ɣǲ³ϵKalman˲

ֱӻãʽ TΪŷڣڱϵͳT=2ms.
ǵͼ(40ms)ŷ(2ms)Թ󣬶ʵһͼɴŷĹϢ40msͼʹͬһͼ20ιȡŷ㣬ԴﵽŷµӾ.ڵiŷУݹؽڽǶȲֵ㵱ǰڵmͼеֵxo(i),yo(i)TӶe(i),i(i),j(i),,ԴΪϢʵ׼ŷµӾ
xo(i)yo(i)1T=CTB(m)(i),(8)


ͼ3ŷµӾ
ЦΪе˶ѧ̣CTBΪα任ͼʱ̵ĻеֹؽڽǶȦmȷ.
һ׼ŷµӾͼ3ԽͣͼڽǶȿϵͳ˶ͼнŷƣŷڽǶȿϵͳ40msԱͼپֹ.
4ʵƼ
һƷӦñΪһƽؽֱβиˣӾ߸ٵĿʹڲи־мӹͼֽԶ빦ܣ4ݣΪʵʵʱӾŷǽһTransputerĻӾŷпһпƬT800(root,slot1,slot2,slot3)ɣṹͼ4ʾ.


ͼ4пṹͼ

ͼɼ·רΪTransputerϵͳƵģƵźžA/Dתֱlinkзrootslot2.Ϊϵͳʵʱԣrootslot240ms/֡rootɼͼʱslot2ͼ󹩿ʹãslot2ɼͼʱroot ͼ󹩿ʹ.ͼֱΪ256256泡.slot1ֱrootslot2ӹͼϢͬʱslot3ӹŷ.slot3ŷƽӿڵ·ֱۡС۵ļPWMӣÿ2msһιؽڽǲslot3ؽڲֵslot1,slot1ݴ˽ǰĵӳǰͼвɿд(rootslot2)㣬ӦԸõΪĽֲڣõľֱֲ߷̻ͣslot1ݴ˼㵱ǰe(i)i(i),j(i),(i)slot3п.ȫ2msɣʵŷµӾ.
Ϊʵڰɫͼֽϻһ뾶Ϊ197.5mmԲеֽӾ٣ĩӳ26.4mm26.4mmѧģ5ݣƲȡֵ
kp=40.0,kv=1.0,KPO=0.2,KVO=43.1.
еٶΪu=150mm/s¼һܵͼ5  u=150mm/sʾ216ͼɼʱ8.64s,൱ƽȣɼûеƽٶΪ143.6mm/s߿ԿʱٶȴӾֹ150mm/s1mm⣬ȫƫ0.6mm.ٶ250mm/sͼ5 u=250mm/sʾ3.8mm1.1mmƽٶ242.4mm/sɼ128ͼ.ԷָıٶȲܴܲӰ죬رڸٵƽԷ.ģ4ùλøٵĿЧȣƽԵõܴƣͬʱڸٶ10¿ƾȴﵽͬһˮƽ.


ͼ5150mm/s250mm/sٶȸʱķ

5
һʵӾ߸ٵĻ˿ƷһƱֽ򼰷ϣֻٶȿƣȲȡλ÷ʽٿƸƽȣλŷ֤߸پ.һһӾŷпʵ׼ŷµӾĿܣ26.4mm26.4mmСӳ£ʵ250mm/sĿٸ.һӦͼֽ롢ٵȶֳ.
1)ҽίʿĿ9424713.Ӣĸʮ(1996)IFAC.
ƽ19631992ҵͨѧϢƹϵѧʿѧλΪͬôѧϵ.Ҫо˿ܻ.
֡19731996ͬôѧѧ˶ʿѧλΪͬôѧʿо.
ߵλ(ͬôѧϵϺ200092)
ο
1Wijesoma S W,Wolfe D F H,Richards R J.Eye-to-hand coordination for vision-guided robot control applications.Int.J.of Robotics Research,1993,12(1):6478
2Papanikolopoulos N P,Khosla P K,Kanade T.Visual tracking of a moving target by a camera mounted on a robot:a combination of control and vision.IEEE Trans.on Robotics and Automation,1993,9(1):1435
3Morgan C G,Bromley J S E,Davey P G et al.Visual guidance techniques for robot arc welding.Proc.3th Int.Conf.Robot Vision and Sensory Controls,1983,615624
4ƽ»ã¾.ӾĻ˹߸ϵͳ.ˣ199416(1)4549
5Chen H T,Jiang P,Zhu W H et al.Comparative study of D.D.robot control algorithms for trajectory tracking.Preprint of 12th IFAC World congress,1993,157160


ոڡ1995-06-06յ޸ĸڡ1998-05-15
