Զѧ
ACTA AUTOMATICA SINICA
1999ꡡ255ڡVol.25 No.5 1999



ھҵоֲϿ1)
㡡ߡ
ժҪоھ̽ʹ뼸ϰھ˵ıϷ.ȹ滮ھ·ʱֵϰھУģֲ͸ѹѹ仯λϢΪģƹϰĿź.Уͨ켸ϰǰġͲ迹ƣʵϰر.ʵķǿе.
ؼʡھˣ迹ƣʵʱ.
SEMIAUTONOMOUS OBSTACLE AVOIDANCE FOR
AN EXCAVATINGROBOT
YANG YiFENG Pei'enGAO Yu
(The State Key Laboratory of Fluid Power Transmission and Control,The Institute of Machine Design,
Zhejiang University,Hangzhou310027)
AbstractHow to detect and handle force and geometric obstacles is one of the major problems for excavatingrobots in difficult working conditions.In this paper,methods for an excavatingrobot to semi-autonomously avoid obstacles which are not predicted along the preplanned paths for digging and transport are presented.During the digging process,a fuzzy semiautonomous controller takes the information of the pressures of cylinders,their derivatives and angular displacements as input to the fuzzy control rules and generates fuzzy output to the excavatingrobot handling the force obstacle.And during the transport process,a virtual resistance force regionin front of a geometric obstacle is invented and an impedance control is specified to produce the desired behavior to avoid the obstacle.Experiments show the proposed methods are feasible.
Key wordsExcavatingrobot,fuzzy logic control,semiautonomous,impedance control.
1
ھͨڷǽṹйҵļΡѧԸӶ䣬ʱ޷ԤĹʯϰ.ȹ滮ܻرϰҵ·.ǰڹ13ݻҵ̱Ϸȹ滮ھ·ʱֵϰھУѹλƴķϢģƻж̬ھжϣͨʽ̽ʵ־ֲرϣóഫȡϰϢϰǰġ迹ƣʵϰر.
2ھϰľֲر
ھϰģֲϿϵͳĽṹͼ1ʾ.


ͼ1ģֲϵͳĽṹ
2.1ȷ
ף4вͼٶȴⶨϰ÷Ĵװʵ.овðҺѹϵͳеѹ͸ؽϵĽλƴλƽʵʱ.ʵ͸ѹѹ仯λƵϢܷӳھ״̬Ϊģе
S=p2,p3,p4,2,3,4,p2,p3,p4,(1)
ʽpi,i,(i=2,3,4)ֱΪۡ˺Ͳ͸׵ѹؽڵĽλֵpiΪ͸ѹ仯pi=pi(k+1)-pi(k),kΪkβ.
ѡݵλٶΪݿռʾΪ
T=ۦx,z,vx,vz,(2)
ʽЦX(x,z)ΪλV(vx,vz)Ϊٶ.
ֱ𱻹һ01ݣ-11Уֱģ״̬ΪST(С)SR(С)S(С)M()L()LR(ϴ)LT(ܴ)ͣNL()NM()NS(С)ZE()PS(С)PM()PL()ģ.
2.2ģƹ
ģھ̵ĻƲԣڶʵĻܽõģڽʵеõ.ԶھʽΪƹΪ
1.p3󣬦p3Ҧ3ѽϴ+zС
2.p3󣬦p3ϰϴʯͷ
3.ϰڣҦ3ϴ+zԱܿϰ
4.ϰڣҦ3-zʯͷڳ
5.ִй4κЧϰԿ˷򷵻ؿڵ㣻
6.p3СVС.
ڿвminmaxǰѡȡСֵ(䡱)Ϊ̶ȣԵõĽۣٶԸĽۺѡȡȵĲ.
3͹лļϰر 
3.1
ϰĿռ伸壬ϰΪƽ棬Ҵֱڵ棻Уڶˡϰݲϰĺȱ仯ѳ滮ʼĿжص䲻ϰ·켣.
3.2鹹
ڼϰǰһڴһ(Դ)ͼ2ʾ.趨һֵd0봫û˲ϰСڴֵʱΪ롰.ܡĴС˲ڸ÷ϵٶȳ.Ϊײϰϰ榤dһ߸նϵ桱.


ͼ2ʾͼ
3.3ϵĿƲԣ5
δϰʱھ˱Ϊ迹нϸߵĸԻΪɣʹݼܵظĹ켣.ӽϰʱڡ£ֱϰ淽ٶȼ迹Сٶȼ迹.˵߸նȱ桱ʱٶȼ㣻ֱϰ淽迹ҲӦΪ㣬Ա֤ӴС.ʱ˲ĸ߶ȵĿĸ߶ʱشˡ桱Զ˶ֱϰĸ߶Ⱥ󣬻˵迹ָԭɿռʱֵĿ.ϰĿжظ߶ȣи߶ȴﵽĿĸ߶ȺԭĿ߶ӦhΪʱĿ߶ȣʹǰ¼˶.ظֱϰĸ߶.Ϊ㣬ϷʽĿ˶.
3.4ƻ·
ڱоУ˻תؽڵĿƻ·ͼ3ʾ.


ͼ3תؽڱϿƻ·
ڿƻ·п
(3)
ʽЦ1,1dֱΪתλƵĵǰֵ͸ֱֵΪٶȵĵǰֵ͸ֱֵΪתؽڵϵ͸նϵ


dΪϰ룻d0,d3.2.
rΪ롰⡰ءr=fr.l,lΪתĵľ룬,(ã).
4ʵ
Ƶھʵ̨ϽϿʵо.
4.1ھ̵ʵ
ϴʯͷڲͬλýھʵ.ͼ4ʾмھ̵ʵ.ʱʵʵھ·Ԥڵ·Ǻͼ4aʾ.滮ھȽϴʯͷʱھ˸ѹѹ仯λϢ·.磬·ϳʱϴʯͷ˶Աܿʯͷͼ4bʾ·ʱʯͷ˶Խʯͷһڳͼ4cʾͨθı·ĳԣڳʯͷԺܴ򷵻ؿڵͼ4dʾ.ʵϿʹھһЩ͵ھܸʵʹԤڵ˶״̬.


ͼ4ھʵ
ע.1ʾԤڵ·2ʾʵʵ·.
4.2̵ʵ
ƽ塢ֽΪеϰбʵ.ķнϺõʵʱ.ڱжؿڻǽײΪЧ.ͼ5Ϊ̱ʵƬ.


ͼ5ھеıʵ
5С
ʵ֤ھҵеľֲϷ.Щдڼ.磬ھ̱ϵģ֪ʶһḻӦӶҵмϰʶһߣӦرܲͬ״ϰҪ.
1ߵѧУʿѧƵ221D96062003ܹѧ96033521Ŀ
߼飺㡡1952.㽭ѧڡʿ.19941996ڼô׶ѧԶʵҴ»о.ڹⷢ15ƪ.ҺʡѧƼɹ.ĿǰҪоΪһ廯ͻ.
1943.1985ֹҵѧѧʿѧλ.Ϊ㽭ѧڡʿʦ.ڹⷢ140֣а屾.ҺʡѧͿƼɹ10.ĿǰҪоΪԶͻһ廯.
ߡ1972.㽭ѧеʵҼԱ.Ҫ»һ廯ʵо.ѷ10ƪ.
ߵλ㽭ѧ崫ƹصʵңеоݡ310027
ο
1Ǩ㣬ΰ.Һѹھ΢ݹ滮Ƽо.Զѧ199521(1)3338
2㣬ߡ.ھͿնع̵ı.е1995(10)2628
3Feng Peien,Yang Yi,Sun Shouqian,Qi Zhongwei.Research on control method of planning level for excavatingrobot.In:Proceedings of the 9th International Symposium on Automation and Robotics in Construction. 1992,Tokyo,Japan.777786
4Huang D,Bernold L E.Robotic rock handling during backhoe excavation,Automation and Robotics in Construction X,Elsevier Science Publishers,1993,355362
5Neville Hogan.Impedance control:An approach to manipulation:Part Applications.Journal of Dynamic Systems,measurement,and control,1985,107:1723
ոڣ1997-08-29
޸ڣ1998-06-10
