已阅读5页,还剩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. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
最新文档
- 特种设备维护保养检查记录表(轨道检测)
- 数控技术考试题及答案
- 一例荨麻疹患者的护理个案
- 机械员之机械员基础知识题库含完整答案(各地真题)
- 《数控机床与编程》题库及答案
- 幼儿园智慧校园建设标准(2025版)
- 物业暖通空调维保制度
- 2026年快餐店炸鸡设备维修服务合同
- 关节寒性脓肿护理查房
- 经颅内镜脑室脉络丛烧灼术后护理查房
- 4.5-北师数学二下第四单元《哪座山更高》课件
- 2026年数字技术在环境监测中的应用
- 小学科学新教科版三年级下册2.1.不同种类的动物 练习题(附参考答案和解析)2026春
- 2026中国林业集团有限公司校园招聘115人笔试参考题库附带答案详解
- DB42T2488-2025微型钢管桩应用技术规程
- 2026年游戏前端开发合同协议
- phc管桩施工培训课件
- 2021年北京中考数学试题及答案
- 建设项目的选址对周边道路交通影响评价与分析
- GB/T 24525-2009炭素材料电阻率测定方法
- GB/T 18092-2000免水冲卫生厕所
评论
0/150
提交评论