免费预览已结束,剩余16页可下载查看
下载本文档
版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领
文档简介
AdvancedRobotics ,Vol.17,No.4,pp.339358(2003) VSPandRoboticsSocietyofJapan2003.AFulpaperTheconceptandresearchofapipecrawlingrescuerobotZHELONGWANG andERNESTAPPLETONSchoolofEngineering,UniversityofDurham,DurhamDH13LE,UKReceived19June2002;accepted31July2002AbstractThispaperpresentsthecontrolalgorithmanddesignofapipecrawlingrobotwhichcanbeusedforthepurposeofearthquakerescueandpipelinemaintenance.Therobotisdesignedtobeabletointelligentlyalteritsbodyshapetobullet5tthepipeortunnel-likevoidswithinrubble.Thepaperintroducesasimulationtotesthowtherobotaltersitsbodyshapetobullet5tvoids.Thecontrolalgorithmusesalook-uptablemethodcombinedwiththemethodofleastsquarestopredicttheshapeoftherobotundertheinbullet6uenceofactuators.Thepaperalsopresentsthedesignofboththehardwareandsoftwaresystemsoftherobot,andlaboratoryexperimentsontherobotbodymodule.ComputersimulationresultsbyusingMATLABandtheexperimentalresultsindicatethefeasibilityoftherobotbodyshapechangecontrolalgorithmproposal.Keywords:Piperobot;controlalgorithm;methodofleastsquares;deformablebody;rescuerobot.1.INTRODUCTION1.1.ApipecrawlingrobotInternationalpipelinesystemsusedforthetransmissionofoil,gasandwateraregrowinginage,andsomeinstallationshavealreadybeeninoperationbeyondtheservicelifetheyhadoriginallybeendesignedfor.Inspectionofshortpipesisanimportanttaskfacedbymanyindustries.Thedeteriorationoftheinnersurfaceofpipesisespeciallycommoninrebullet5neriesandsteamplants.Itisthereforeofever-increasingimportancethatpipelineoperatorsareprovidedwiththemeanstoaccuratelyandreliablyinspecttheirpipelines,andobtaintheinformationneededfordecisionmakingregardingsafeoperation,rehabilitationandrepair1.Theuseofautomaticpipeinspectioncouldreducethedowntimeandmanpowerrequiredforthepipeinspectionprocess.Thishighlydemandingrequirementhasresultedinthedevelopmentofvariouskindsofpiperobots.Towhomcorrespondenceshouldbeaddressed.E-mail:zhelong.wangdurham.ac.uk340 Z.WangandE.Appleton1.2.EarthquakerescuerobotsEarthquakesareunfortunatelyfrequenthappeningsandverydangerousnaturalphenomena.Inalmosteverymajorearthquakemanyvictimsareburiedundercolapsedbuildings,bridges,roadways,etc.Itisverydifbullet5culttorescuethesepeople,whomaywellbeinjured,hungryandweak.Inaddition,thestructuralconditionsundertherubblecanbecomplex,dangerousandunknown.Thus,thereisaprimaryneedtoexploretheseconditionsanddeterminethevictimslocationandtheircondition.Thematterisalsourgentasitisimportanttorescuethosevictimsassonaspossible.Asaresult,rescuerobotshavebeendevelopedtoundertakethesetasks.InanarticlebyTokuda etal.2,aprototypeCUL(CarryandpowerassistrobotforUnspecibullet5edLandform)whichwillbeusedforearthquakerescuemissionshasbeendescribed.Thepaperalsodescribesresultsofexperimentsforafeasibilitystudy.TheexperimentalresultsshowtheeffectivenessoftheCULrescuerobotproposed.2.PROBLEMPRESENTATION2.1.TheshortcomingsofexistingpipelinerobotdesignPipelinerobotsarementionedinalargenumberofpapers.Forexample,arobotsystemnamedKARO3(Entwicklungeinesbullet6exibleeinsetzbarenRobotszurintelligentensensor-basiertenKanalinspektion)isequippedwithintelligentmulti-sensors.Theseallowautomaticandreliabledetectionofdamagelocation,itstypeandsize,andgivesuperiorperformancecomparedwiththemajorityofCCTV-basedsystems.Thesystemhasbeendevelopedfortheprotectionofgroundwaterandsoilagainstcontaminatingmaterialsandliquids.ToyomiandKoichi4havedevelopedamicro-inspectionrobotfor1-inchdiameterpipes.Therobotcanundertakevisualinspectionsinpipesandalsoretrievesmallobjects.GlenandDevon5describearobotthatundertakesautomaticpipeinspectionandhasbeenprovedtobeasuitablealternativetocurrentpipeinspectiontechniques.Theadvantageofthissystemisthatitutilizesestablishedmechatronicprinciplestoproducealow-costdevicecapableofdetectinginerpipedefects.However,alltheserobotscanonlyworkinpipesofbullet5xeddiametersandcannotworkifthewallofthepipeisbrokenorbadlydamaged,ifthepipediametervariesorifthepipecollapsedpartially.2.2.ABrushrobotApipecrawlingrobothasbeendevelopedattheCenterofIndustrialAutomationandManufacturing(CIAM),SchoolofEngineering,UniversityofDurham.Therobotutilizesaunique,innovativeandpatentedtractionsystem.Theprincipleofthedrivesystemissimple.Thatis,ifabrushwithadiameterslightlylargerthantheboreofapipeisinsertedintoapipe,itsbristlesaresweptbackatanangle.Underthiscondition,itiseasiertopushthebrushforwardsthoughthepipethanTheconceptandresearchofapipecrawlingrescuerobot 341itistopullitbackwards.Thus,iftwobrushareinterconnectedbyareciprocatingcylinder,then,bycyclingthecylinder,itispossiblefortherobottocrawlalongthepipe6.Thedrivesystemhasbeenawardedpatentsonanearworldwidebasis.MoredetailsaboutthedrivesystemareillustratedinStutchbury6andHan7.MostoftherobotsdevelopedinDurhamarepoweredbypneumaticsandgripthewallofthepipebymeansofmanybristleclusters,hencenamedBrushrobots.Justlikeotherpipelinerobotsmentionedearlier,aBrushrobotcanonlyworkinpipeswithinalimiteddiameterrangealthough,unlikemanyoftheothertractionsystems,thebristlemechanismiscapableofdealingwithbrokenonpartiallycollapsedpipes.2.3.AnimprovedBrushrobotforearthquakerescueandpipelinemaintenanceThisreportoutlinessomeimprovementsontheestablishedBrushrobotprinciple,andadaptsittoworkforthepurposeofearthquakerescueandinseverelydamagedorbrokenpipelines.Thus,itisdesignedtobeabletoalteritsbodyshapetobullet5tthevariablevoidshapesinacolapsedbuildingordifferentdiameterpipeswhosewallsmightbebrokenorinabadcondition.Torealizethesefunctions,asensorsystemfordetectingtheholeshapeandacontrolsystemforalteringtherobotbodyshapeisnecessarilyequipped.Forthepurposeofrescue,aCCDcameraneedstobeequippedtoseetheconditionsinthehole.ACO 2detectorisusedfordetectingwhethervictimsarealiveornotandforlocatingtheirpositions.Amicrophoneisequippedforavictimtocommunicatewithrescuepersonnel.Inaddition,anairhosewilbecarriedbytherobotforconditionsofairdebullet5ciency.3.RESEARCHMETHODOLOGY3.1.OutlineThekeypointforaBrushrobotistoproduceenoughfrictiontodriveitselfandcarrythenecessaryloads.Forthepurposeofearthquakerescue,therobotshouldbeabletopassthroughholesandcracksintheruinsmadebytheearthquake.However,theholesandcracksintheruinsusuallyhaveirregularshapesandsizes.Thus,therobotmustbeabletoalteritsbodyshapeandbullet5ttheholeshapetoproduceenoughfrictionalforce.Torealizetherequirement,itisessentialtoinstallasensorsystemontherobotshead,whichisusedtoroughlydetecttheholeandcrackshapes.InthedesignofthisBrushrobot,fourgroupsofactuatorsneedtobeinstalledaroundtherobotsbody.Theseactuatorswillchangetherobotsbodyshapeaccordingtosignalsfromthesensorsystem.Duringthisprocedureacontrolsystemwillrecog-nizethesensorssignals,performingcalculationsbasedonthesignalinformationandsendingappropriatecommandstochangetheactuators.UsingaCCDcameramountedontheheadoftherobot,theconditionsintheholesandcrackscanbeinvestigatedvisually.Amanualcontrolfunctionisalsorequiredtodealwithexcep-tionalcircumstancesinthecaseoffailureoftherobotautomaticcontrolfunction.A342 Z.WangandE.AppletonsoftwaresystembasedonaPCisalsorequiredtorundatacommunicationandcon-trol,storedata,etc.Morespecibullet5cally,thesoftwareisrequiredtobeabletorecordtherobotsroutesandtheholeshapesatdifferenttravelstages.3.2.Robotworkingmechanismtheory3.2.1.ThemechanismtheoryofanoldBrushrobot. Beforebuildingarealrobotmodel,itisnecessarytodosomecomputersimulationstoprovethefeasibilityofthecontrolalgorithm.MovementofaBrushrobotisachievedbytheutilizationofcurvedbristleasthemeansofpropulsionandsupport,asillustratedinFig.1.Whenthecylinderopens,theleadingbrush,offeringlowerresistancebecauseofthebristlecurvature,movesforwardeasily;thetrailingbrush,becauseofitshigherresistancetobackwardforces,remainsstationary.However,whenthereversehappens,i.e.thecylindercloses,theleadingbrushremainsstationary,whereasthetrailingbrush,nowofferinglowresistance,ispulledforward.Basedonthistheory,theresultanttractiondependsentirelyonthebristlemechanismset-upandcanbeillustratedinthefollowingway.Consideringasinglebristleforthepurposeofsimplicity,whenabristleisputintoapipe,andbecauseofitseffectivelateraldimension,itisbentbythepipewall,therewillbeaperpendicularforce Pactingatthetipofthebristle,asshowninFig.2.Whenmovingthecoreofbristles,traction Fshouldequal P.Theprojectionofabristleinthedirectionofthe y-axisismarkedas h.Thelengthofabristleis l.Thechordbetweenthetwotipsofthebristleisexpressedas L.Inthethesis6,Stutchburygivestheconclusionthattheoptimumangelbetweenthebristleandpipewallshouldbebetween30 and40toachievethebesttraction F,althoughthisangelwillvarydependinguponanumberoffactors,e.g.lubrication.InRef.7,Hangivesustherelationbetween handl: hlD2E./QlL: (1)Note:E./D21122sin2213242sin4231352462sin625;andQlD21C122sin22C13242sin423C1352462sin625C:Thevalueofhcanbeobtainedif landareknown.ThethesisbyHangivesatablewhichindicatestheresultsobtainedbyapplying(1),asshownbelowinTable.ThemechanismtheoryofanimprovedBrushrobot. AnewlyimprovedBrushrobotusedthesamebrushmechanismastheoldone,butthestructureofTheconceptandresearchofapipecrawlingrescuerobot 343Figure1.Brushrobotmotionprinciple.Figure2.Bristlemechanismdiagram.Table1.Spreadsheetfortherelationbetween handl(deg) P=PEuler =l h=l10 1.004 0.1116 0.992320 1.016 0.2193 0.969830 1.035 0.2588 0.932440 1.062 0.4221 0.878760 1.152 0.5930 0.697390 1.392 0.7925 0.4189344 Z.WangandE.AppletonFigure3.Thestructureofonerobotbodymodule.itsbodymodulehasbeenmodibullet5ed.TheoldBrushrobotsbodymoduleisasolidsteelcylindermountedwithhundredsofsteelbristles.Thesteelcylinderistherobotbodycoreofabullet5xeddiameterandthebodycorecannotdoanychangetoitsphysicalshape.However,intheimprovedBrushrobot,athinsteelstripcirclereplacestheoldrobotbodycylinder,asillustratedinFig.3.Insidethestripcircle,fouractuatorsconnectthestripcirclebyjoiningtheactuatorendpointswiththestripcircle.Liketheoldrobotbodymodule,hundredsofsteelbristlesaremountedonthesurfaceofthestripcircle.Thenew,improvedrobotbodymodulewithsuchamechanismcanalteritsshapebyactuatorspushinginandout.3.3.ControlalgorithmforthenewBrushrobotTomakeanimprovedBrushrobottobeabletoalteritsbodyshapeandbullet5tthevoids,ahybridcontrolalgorithmbasedonalook-uptablemethodandthemethodofleastsquaresisdeveloped.Themethodthattherobotusetodecideshowtoalteritsbodyshapetobullet5ttheholeisreferencetoadatabullet5le,storedinatable.Thetableiscom-posedofdatabullet5lesandeachbullet5lepresentsonecalculationresultobtainedbyusingABAQUSsoftware.Figure3illustratesthestructureofonerobotbodymodule.Eachrobotbodymoduleiscomposedoffouractuators,athinspringsteelstripcir-cleandhundredsofspringsteelbristlesmountedonthesurfaceofthestrip.Theendpointofeachactuatorisconnectedtothestripsothattheshapeofthesteelstripcirclecanbedeformedbytheactuatorspushinginandout.Ifseveralhundredpointsonthestripcirclearemarked,thepositionofeachpointcanberecordedasapairofcoordinates.Thestripcircleshapecanbeuniquelyrepresentedifallpointscoordi-natescanbeknown.Theshapeofthestripcirclecanbeacquiredfromcoordinatesofthosepointswhenactuatorspushin/outandthestripcircleisdeformedbysuchpushing.Infact,heretheshapeofthestripcirclerepresentstheactualshapeoftherobotbodymodule.Theseshapesarerelatedtoactuatorloadsandconsequentlydebullet6ectionsthatareputontherobotbodyinthedirectionofthe x-axisandy-axisindependently.Thus,therobotbodymoduleshapewillbechangedwithvariedac-tuatorloadsanddebullet6ections.Inthemeantime,thecoordinatesofthepointsontherobotbodymodulewillbechangedbecauseoftherobotbodydebullet6ection.Theco-ordinatesofthosepointscanbecalculatedandpredictedbyusingABAQUS,whenactuatorloadsarealreadyknown.ThisarrayofpointcoordinatespresentstherobotTheconceptandresearchofapipecrawlingrescuerobot 345Table2.Adatabullet5lestoresanarrayofpointcoordinatesPOINT1 POINT2 POINTnXi X1 X2 XnY1 Y1 Y2 Ynbodymoduleshapeundersuchactuatorloads.Iftheactuatorloadsarechanged,anewarrayofpointcoordinatescanbeacquiredandthismeansthattherobotbodymodulewillassumeanewshape.Thusbychangingtheactuatorloads,whichareinputvariablesinthecalculationbyABAQUS,manyarraysofpointcoordinatescanbeacquired.Eachofthemuniquelyrepresentsarobotbodymoduleshape.Thesearraysofpointcoordinatescanbestoredindatabullet5lesandeachdatabullet5leisusedasarecordtoputintoatable.Asaresult,thistableincludesmanyrobotbodymoduleshapesunderdifferentactuatorloads.Similarlyaholeshapecanalsobeuniquelyexpressedasanarrayofcoordinatesofpointsaroundtheholewall.Therobotscontrolalgorithmisrequiredtobeabletobullet5ndthemostappropriateshapetobullet5ttheholeshapefromthosedatabullet5lesinthetable.Forexample,Table2expressesanarrayofpointcoordinatesstoredasadatabullet5le,whichisarecordintherobotbodyshapetable.A POINTi(iD1;2;:;n/meansapairofcoordinatesofapointontherobotbodyaftertherobotbodyisdebullet6ected.POINTiisexpressedas( Xi;Yi)inthemeaningofthecoordinates,whichisapointontherobotbody.Thecoordinate( xi;yi)isexpressedasthecoordinateofapointontheholewall. diisthedifferencebetweenapointontherobotbodyanditscorrespondingtargetpointontheholewallalongthesamedirection.Iftherobotbodymoduleshapecouldbullet5ttheholeshapeverywell,thatmeansthateach dishouldbeassmallaspossible.Torealizethis,therobotcontrolalgorithmneedstobullet5ndthesmallest D,whichisthesumofthesquareddistance di.Finally,thecontrolalgorithmwillsearchalldatabullet5lesintherobotbodymoduleshapetableandbullet5ndthebestdatabullet5letominimize D,whichiscalculatedbyusing(3). listheoptimallengthofthebristle,whichisaconstantandcanbeknowbyusingaspreadsheetin6.nisthetotalnumberofpointsaroundtherobotbodymodule.diDx2iCy2iX2iCY2il;.iD1;2;:;n/; (2)DDniD1 x2iCy2iX2iCY2il2;.iD1;2;:;n/:(3)3.4.ComputersimulationofthecontrolalgorithmTotestthefeasibilityofthecontrolalgorithmpresentedabove,anumberofcomputersimulationshavebeenperformedusingMATLAB.Thesimulationresultsshowthatthecontrolalgorithmproposedwillbeeffective.Figures46arebased346 Z.WangandE.AppletonFigure4.Robotbodymodulebullet5tsasquare:Cindicatesapointoftherobotbodyandindicatesapointoftheholeswall.Figure5.Robotbodymodulebullet5tsanellipse:Cindicatesapointoftherobotbody.Figure6.Robotbodymodulebullet5tsanirregularshape:indicatesapointoftheholeswall.Theconceptandresearchofapipecrawlingrescuerobot 347onsomesimulationresults.Inthesebullet5gures,theholeshapeisexpressedbyanarrayofinterconnectedsymbolsandtherobotbodymoduleshapeisexpressedbyanarrayofinterconnectedsymbolsC.AlsoeachsymbolrepresentsapointontheholewallandeachCsymbolrepresentsapointontherobotbodymodule.InFig.4,theholeshapeisarectangleandtherobotbodycurvebullet5tstheholewell.InFig.5,theholeshapeisanellipseandtherobotbodycurveissimilartotheholeshape,butitisrelativelysmallerthanthehole.Thebristlearoundtherobotbodycandealwiththelittledifferencebyelasticdebullet6ection.Figure6showstherobotbodytestedtobullet5tanirregularholeshapeandmostoftherobotbodymodulecurvecanbullet5ttheholebyelasticdebullet6ectionofthebristles;however,therightuppercornercannotbebullet5ttedbytherobotbodymodulecurve.Toachieveabetterbullet5tting,furtherworkneedstobecarriedonmakinganon-symmetricrobotbody.Fromthesimulationresultsabove,therobotbodymodulecouldalteritsshapetobullet5tsomebasicgeometricshapesandsimpleirregularshapes.Thecontrolalgorithmisbasicallyprovedtobefeasible.Morecomplicatedirregularshapescannotbebullet5ttedwellbyusingthecurrentstructureoftherobotbodymodule.Thiscouldbesolvedbymakinganon-symmetricrobotbodymoduleandusingmoreactuators,whichwillenablerobotbodymoduletochangeintomorecomplexshapestobullet5tvariousholeshapes.3.5.Robotcontrolsystem3.5.1.Controlmodulediagram. ItisenvisagedthatacontrolprogramwillruninaPCandthatasensorsystemwilsendbacksignalsabouttheconstantlychangingholeshape.Afterprocessingthesesignals,thePCmakesthecontroldecisionsandsendscontrolcommandstoeverycontrolmodule.Thenthecontrolmoduleswillcontrolthemovementsoftheactuatorsaccordingtothosecontrolcommands.Figure7displaysthatarobotcontrolsystemthatincludestwolayersofcontrol.OneisthecontrolfromaPCtoeachcontrolmodule;theotheristhecontrolfromeachcontrolmoduletoitscorrespondingactuator.Inaddition,asensorsystemFigure7.Controlmodulediagram.348 Z.WangandE.AppletonFigure8.CmunicateswiththePCtocolecttheinformationoftheholeshapeandsendstheinformationtothePC.3.5.2.Controlboarddiagram. Itisproposedtomakeaprototypeofthisrobotusingeightsteppermotorcontrolboards,16steppermotordriveboards,16steppermotorsandonePCtorunthecontrolsoftware.InFig.8,aschemeisdrawntoexplaintheconnectionsbetweenthesemodules.Eachcontrolboardcancontroltwosteppermotorsandeverysteppermotorneedstobedrivenbyadriveboard.Foursteppermotorsareneededforeachrobotbodymodule,sothatafour-body-partBrushrobotneeds16steppermotorsinall.4.EXPERIMENTSThisBrushrobotiscomposedofthesamefourmodules.Thus,thelaboratoryexperimentfocusesononerobotbodymodule.4.1.LaboratoryexperimentonarobotbodymoduleTherobotbodymoduleexperimentaldeviceisshowninFig.9.Thedevicesincludeastraingaugesensor,robotbodymodule,robotactuatorcontrolbox,DCpowersupplyandPC.Thestraingaugesensorisusedtodetectthevoidshapes.Thesensorincludes12bullet5ngersequippedwithstraingauges.Thestraingaugecanbeusedtodetectthedebullet6ectionsofthebullet5ngers.Thetouchingpointcoordinatesofthebullet5ngersonthevoidwallcanbeworkedoutbythesedebullet6ections.Withthesecoordinates,asplinealgorithmcanestimatethewholevoidshape.4.1.1.Robotsoftwaresystem. AcomputerprogramwritteninVisualC+wasdevelopedfortherobotprototypeexperimenttocollectsensorsignals,controlTheconceptandresearchofapipecrawlingrescuerobot 349Figure9.Robotexperimentaldevices.Figure10.Robotsoftwareinterface.actuatorsandrealizetheshapechangealgorithm.Figure10illustratestheprograminterface.Theleftwindowshowshowtherobotbodymodulewillalteritsbodyshapetobullet5tthevoid.Theblackinnerlineshowstheoutlineoftherobotbodymoduleandthegreyouterlineshowstheoutlineofthevoidwall.Therightwindowdisplaysthecommunicationworkingstatus;thesteppermotorworkingstatusandcontrolcommandssenttothesteppermotors.Figure1showstheinterfaceofthedataacquisitionprogram,whichdisplaysthedataacquisitioncardinformation;32analoginputch
温馨提示
- 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
- 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
- 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
- 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
- 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
- 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
- 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
最新文档
- 宠物营养知识普及平台创新创业项目商业计划书
- 宠物骨骼健康管理与预防方案创新创业项目商业计划书
- 摩托车智能化防抱死制动系统创新创业项目商业计划书
- 建筑机器人故障诊断系统创新创业项目商业计划书
- 挖掘机高效节能传动系统创新创业项目商业计划书
- 改装车轮胎性能提升创新创业项目商业计划书
- 复古风格电钢琴音乐会创新创业项目商业计划书
- 企业员工入职培训教材及考核
- 医院感染控制管理方案及执行标准
- 小学语文文言文教学设计方案
- 河北省医疗卫生事业编-护理类历年考试真题库-含答案解析
- 五年级奥数题型训练及复习资料(并附上100道奥数练习题)
- 2024风电建设项目水土保持技术标准
- 高中英语新课标3000词汇表(新高考)
- 水痘病人的护理常规
- 山东省济南市2024-2025学年高一上学期1月期末英语试题(含答案无听力音频无听力原文)
- 《减肥及代谢手术》课件
- 足球教练职业生涯规划
- 名著阅读《红星照耀中国》练习课件语文八年级上册
- 2024-2030年全球及中国腋窝多汗症治疗行业发展方向及前景规划分析报告
- 江苏省镇江市2024-2025学年高一上学期期中考试历史试题(无答案)
评论
0/150
提交评论