ѧ
JOURNAL OF ASTRONAUTICS
1999 20 3 vol.20 No.3 1999



ٳеңػ
ϵͳ˫
ϯԣ̺׸
ժҪоٳмʵӻңĿۺƷڶԿϵͳĶѧ˶˫вŷͿƷʵ˸÷ĿԣʾڷǽṹԻٳǿ˻Խԡ
ʡӻˡңٳС˫
BILATERAL CONTROL OF MASTER-SLAVE 
TELEROBOT SYSTEM WITH FORCE TELEPRESENCE
Chen Weidong Xi Yugeng
(Department of Automation Shanghai Jiao Tong University.Shanghai.200030)
Cai Hegao
(Robot Research Institute Harbin Institute of Technology.Harbin.150001)
AbstractThis paper focuses on the control theory and design method of master-slave robot system,that can implement precise teleoperation by means of force telepresence technology under the unstructural environment.Based on the dynamics analysis of the control system,a force-reflecting servo control scheme is adopted in the force and motion bilateral control.Teleoperation experiments demonstrate the practicability of this control scheme and show the advanced capability to improve the man-machine interactivity.
Key wordsMaster-slave robot Teleoperation Force telepresence Bilateral control
1
ңػ˿ڷǽṹԻ(ռ䡢䡢ս)иӵĲҵ(纽װ䡢ά)ߵĲԡӻϢ(Ӿ)ʵأٳйܣʹʵظо뱻Ķ̬໥ãԼֱڲһڲɸӾܵҵֻ˿ƷʽǽԶƵ뷽֮һ1ݡ
ʶٳнӴңеҪãؼоӦܵ㷺עJPL/NASAˣ2ݣձMSMSˣ3ݣ¹ROTEXˣ4ݾøҹһ𲽽Ŀǰڿռ估ˮ»ȡýչ863ƻҲѽٳеңϵͳΪܻĹؼչо
˫ָֺʹּ˶ϢĽƣڵңػϵͳ˫λ÷ʵٳУּ޷λʹϵͳɿռ˶ҲԵʮ֡͡1ݣֱӰϵͳĲܡڴߣʹܹøܵʵּ˫ΪøȽĿƲԽһңṩ˻
2˫Ʋ
ͨõңػΪɶ칹ϵͳڵѿռƷ̵һʽΪ
(1)
(2)
Kmpm,Kmpm,KmpmKmfmֱΪֵλáٶȡٶȺķ󣬶Kmps,KmpsKmpsKmfsǴλáٶȡٶȺķ˸ϵȷֵFmͬKspm,Kspm,Kspm,Ksfm,Ksps,Ksps,KspsKsfsȷ˴ֵFsXm,FoΪλƺͲXs,FeΪλƺͷϸΪ6άΪ66ά͵ӿƲԣλŷ͡ͺŷӿϵͳΪʽ(1)(2)
3ϵͳѧ
ĶѧԣȽλŷ͡ͺűֿƲԵܡ
һŷͣ
ʽ(1)(2)УKmfm=Kmfs=-KfKspm=Ksps=KpKspm=Ksps=Kv,ȡΪ㡣ֶѧ̼ƲΪ
(3)
(4)
ֶѧ̡ƲԼ嶯ѧΪΪ
(5)
(6)
(7)
Ϊ˼򻯷ֵĶѧͬ(Mm=Ms=Mo,Bm=Bs=Bo)߸ܵķΪ
(8)
Kfȡ㹻Fo=FeͬϵKpKv㹻Ҳɼ涯Ӧע⣬ϵͳȶ½
ͣ
ʽ(1)(2)УKmfs=-IKspm=Ksps=KpKspm=Ksps=KvȡΪ㣬IΪλֶѧΪ
(9)
ֶѧ̡ƲԼ嶯ѧΪΪ
(10)
(11)
(12)
Ϊ˼򻯷ֵĶѧͬ(Mm=Ms=Mo,Bm=Bs=Bo)߸ܵķΪ
(13)
ϵͳֵܹĶѧԣǣֵĶѧԸӵУϵͳӦܲŷϵͳ
λŷͣ
ʽ(1)(2)УKmpm=Kmps=Kspm=Ksps=KpKmpm=Kmps=Kspm=Ksps=Kv,ȡΪ㡣ֶѧ̼ƲΪ
(14)
(15)
ֶѧ̡ƲԼ嶯ѧΪΪ
(16)
(17)
(18)
Ϊ˼򻯷ֵĶѧԺͷͬ߸ܵķΪ
(19)
ֺʹֵĶѧԶӵУϵͳӦܲϵͳ
ֿƷУ߸оĴһֳ/ҪֱܵѧԵĸţ䵱ָؽڵĹĦϴʱתƵ󽵵ͣ仰˵ֻŷͲǱȽ˫Ʋԡ
4ϵͳ
ѧٳеңػϵͳӲͼ1ʾϵͳӲ֣

ͼ1ϵͳӲͼ
1.֣Ƶɶȹؽͻеۣаֱص͹̲ǻ2.֣PUMA562ͻˣ3.пԺϷоSAFMS-ά/4.LORD˾F/T30/100ά5.PC-AT486 DX2/66ͼƽӿڿ(a)źŲɼ(b)źŲɼ(c)̼⿨(d)ֵ/ģת6.ͨѶʵPUMAALTERʵʱ·ܽӿڵͨѶ
ĲŷͿƷ칹Ӧ˶ѧѧ㣬ͨòͬȺλȡʵʱϵͳĽṹͼ2ʾŷλŷͼGfΪΪ28ms˶ʱϵͳΪλÿƣʱƻպϡ

ͼ2ŷͿϵͳṹͼ
óPIDƷFo˳ͨϵͳıջûκӰ죬ϵͳıջʱԲӿǡԿ˳ڵãϵͳ̬ϵͳ̬ӦΪ
(20)
ʽ(20)KfΪGfı档ڱƣȻӴԼС̬ϵͳܣϵͳĴӿϵͳӦٶȣСɹʱ䣬ϵͳ켣(ͼ3)Kfߣ켣Sƽƽ棬ϵͳʧȡˣѡʵĿ棬ϵͳӦܺȶ֮ԡ

ͼ3ϵͳĸ켣
ϵͳ켣ĸնKeı仯ҲϵͳȶԺܾԵӰ죬ߵնҲʹϵͳòȶ
ñ+΢ֿ(PD)ʱGf=Kf(1+Kds)൱ڣSƽ벿һʵ㣬켣ĽʵļнΪ90㣬ϵͳȶԣȣʹϵͳΪȶϵͳڴڴ΢ò˹
ñ++΢ֿ(PID)ʱGf=Kf(1+Kds+Kis-1)൱ڣSƽ벿һʵ㣬ȻԸӦ̬ȣϵͳȶԣȣ³ԲԻ˵ķԶѧԸΪУײ񵴣ڲߵٳУһʵʲвֻڡ
ʵPUMAһǿϵķϵͳλú̬ĸı䶯ѧҲӦı仯ڿУӦԻ˵ķԸʵĿǣͨѶ0.084sʱӣϵͳȶҲвӰ죬ӦһԱλƿ
5ңʵ
ңʵԼռڵ3ݣ
(1)1һúʵ̨ϣ߲ݴַѹ࣬Բ߶Ժ迹Եĸо
(2)2һüǯ̶ʵ̨ϣ߲ĩ˴岢𽥼ӴڴĩҲϼӹģʱĽӴúΣգνġӲӴ
(3)3ٳңװʵ顣׼ǯ̶ʵ̨ϣLODRһָצװʵ̿ɷΪ¼׶Σץѿ׺Ͳסѿ׺Ͳ׽׶Σͨоĩ׼ĽӴ˳Ӧλã˷ӾڽӴ״̬µķȱݣɰ߾߲ΪɽϾܵװáΪ˱֤ӲӴµȶԣPUMAеֵĩ˺LORDһ˳װRCC
ʵԼռ䣬ʱ߿׼ȷظоԣӦͼ4(a)ʾʱ߿ɱ鵽롰ӲǽӴĸоӦͼ4(b)ʾϵͳӦٶȣС̬񵴣ϵͳȶ½ѡʵ΢ԸϵͳĶ̬ԣӦٶȣKdǹСʹϵͳϴ󣬵ʱϳӾϵͳṩٳйܣ߿˳ңװҵңװеӦͼ5ʾڴΧ˶׶ͨӾλСΧѿ׺Ͳ׽׶νٳУͨýСλ(1/21/4)װ侫ȣСߵΪɴ˲ײɵĹˡȻԲߵѵҲǷǳҪģһĲ߿ԸõϢԼСΪװЧʡ

ͼ4ӦߺλӦ(֣ʵߣ֣)


ͼ53װӦ
6
Ľľٳеңػϵͳʹ߿Իô뻷ӴʱʵٳоԸңϵͳĲܣɹңװҵʵ۷ϵͳƵȷԺЧԡ
ٳΪһӱ˻ȳֿ˻кңԶµҵͬʱַڷǽṹԻеܾãѳΪǰоȵ㣬ں졢ܡҽƺͺ󿪷йӦǰ
ԶңصĴʱ⣬˻ңֲĹƼԼ˻ӿڵĶάԺͺȣдо
ߵλϯԣϺͨѧԶϵ.Ϻ.200030
̺׸ޣҵѧо..150001
ο
1.ѧ.ѧ磬1993
2Edwin P K,Edmund A.The JPL telerobot teleoperation system,International Journal of Robotics and Automation,1990,5(1):27-31
3Masao Inoue et al.Six-axis bilateral control of an articulated slave manipulator using a Cartesian master manipulator.Advanced Robotics,1990,4(2):139-150
4Hirzinger G.A sensor-based telerobotic system for the space robot experiment ROTEX.ʸ߼ѧۻļ199139-59
ո:1997623,޻:19981022
