



已閱讀5頁,還剩5頁未讀, 繼續(xù)免費閱讀
版權(quán)說明:本文檔由用戶提供并上傳,收益歸屬內(nèi)容提供方,若內(nèi)容存在侵權(quán),請進行舉報或認領(lǐng)
文檔簡介
IEEETRANSACTIONSONROBOTICS,VOL.25,NO.4,AUGUST2009851Vision-Based,DistributedControlLawsforMotionCoordinationofNonholonomicRobotsNimaMoshtagh,Member,IEEE,NathanMichael,Member,IEEE,AliJadbabaie,SeniorMember,IEEE,andKostasDaniilidis,SeniorMember,IEEEAbstractInthispaper,westudytheproblemofdistributedmo-tioncoordinationamongagroupofnonholonomicgroundrobots.Wedevelopvision-basedcontrollawsforparallelandbalancedcir-cularformationsusingaconsensusapproach.Theproposedcon-trollawsaredistributedinthesensethattheyrequireinformationonlyfromneighboringrobots.Furthermore,thecontrollawsarecoordinate-freeanddonotrelyonmeasurementorcommunica-tionofheadinginformationamongneighborsbutinsteadrequiremeasurementsofbearing,opticalflow,andtimetocollision,allofwhichcanbemeasuredusingvisualsensors.Collision-avoidancecapabilitiesareaddedtotheteammembers,andtheeffectivenessofthecontrollawsaredemonstratedonagroupofmobilerobots.IndexTermsCooperativecontrol,distributedcoordination,vision-basedcontrol.I.INTRODUCTIONCOOPERATIVEcontrolofmultipleautonomousagentshasbecomeavibrantpartofroboticsandcontroltheoryresearch.Themainunderlyingthemeofthislineofresearchistoanalyzeand/orsynthesizespatiallydistributedcontrolar-chitecturesthatcanbeusedformotioncoordinationoflargegroupsofautonomousvehicles.Someofthisresearchfocussesonflockingandformationcontrol9,14,16,22,31,andsynchronization2,39,whileothersfocusonrendezvous,distributedcoverage,anddeployment1,5.Akeyassump-tionimpliedinallofthepreviousreferencesisthateachvehicleorrobot(hereaftercalledanagent)communicatesitspositionand/orvelocityinformationtoitsneighbors.Inspiredbythesocialaggregationphenomenainbirdsandfish6,30,researchersinroboticsandcontroltheoryhaveManuscriptreceivedFebruary23,2008;revisedJanuary31,2009.Firstpub-lishedJune10,2009;currentversionpublishedJuly31,2009.ThispaperwasrecommendedforpublicationbyAssociateEditorZ.-W.LuoandEdi-torJ.-P.Laumonduponevaluationofthereviewerscomments.TheworkofA.JadbabaiewassupportedinpartbytheArmyResearchOfficeMultidisciplinaryUniversityResearchInitiative(ARO/MURI)underGrantW911NF-05-1-0381,inpartbytheOfficeofNavalResearch(ONR)/YoungIn-vestigatorProgram542371,inpartbyONRN000140610436,andinpartunderContractNSF-ECS-0347285.TheworkofK.DaniilidiswassupportedinpartunderContractNSF-IIS-0083209,inpartunderContractNSF-IIS-0121293,inpartunderContractNSF-EIA-0324977,andinpartunderContractARO/MURIDAAD19-02-1-0383.N.MoshtaghwaswiththeGeneralRobotics,Automation,Sensing,andPer-ceptionLaboratory,UniversityofPennsylvania,Philadelphia,PA19104USA.HeisnowwithScientificSystemsCompany,Inc.,Woburn,MA01801USA(e-mail:).N.Michael,A.Jadbabaie,andK.DaniilidisarewiththeGeneralRobotics,Automation,Sensing,andPerceptionLaboratory,UniversityofPennsylva-nia,Philadelphia,PA19104USA(e-mail:;;).Colorversionsofoneormoreofthefiguresinthispaperareavailableonlineat.DigitalObjectIdentifier10.1109/TRO.2009.2022439developedtools,methods,andalgorithmsfordistributedmo-tioncoordinationofmultivehiclesystems.Twomaincollectivemotionsthatareobservedinnatureareparallelmotionandcircularmotion21.Onecaninterpretstabilizingthecircularformationasanexampleofactivityconsensus,i.e.,individualsare“movingaround”together.Stabilizingtheparallelforma-tionisanotherformofactivityconsensusinwhichindividuals“moveoff”together33.Circularformationsareobservedinfishschooling,whichisawell-studiedtopicinecologyandevolutionarybiology6.Inthispaper,wepresentasetofcontrollawsforcoordinatedmotions,suchasparallelandcircularformations,foragroupofplanaragentsusingpurelylocalinteractions.Thecontrollawsareintermsofshapevariables,suchastherelativedistancesandrelativeheadingsamongtheagents.However,theseparam-etersarenotreadilymeasurableusingsimpleandbasicsensingcapabilities.Thismotivatestherewritingofthederivedcontrollawsintermsofbiologicallymeasurableparameters.Eachagentisassumedtohaveonlymonocularvisionandisalsocapableofmeasuringbasicvisualquantities,suchasbearingangle,opti-calflow(bearingderivative),andtimetocollision.Rewritingthecontrolinputsintermsofquantitiesthatarelocallymeasurableisequivalenttoexpressingtheinputsinthelocalbodyframe.Suchachangeofcoordinatesystemfromaglobalframetoalocalframeprovidesuswithabetterintuitiononhowsimilarbehaviorsarecarriedoutinnature.Verificationofthetheorythroughmultirobotexperimentsdemonstratedtheeffectivenessofthevision-basedcontrollawstoachievethedesiredformations.Ofcourse,inreality,anyformationcontrolrequirescollisionavoidance,andindeed,collisionavoidancecannotbedonewithoutrange.Inordertoimprovetheexperimentalresults,weprovidedinteragent-collision-avoidancepropertiestotheteammembers.Inthispaper,weshowthatthetwotasksofformationkeepingandcollisionavoidancecanbedonewithdecoupledadditivetermsinthecontrollaw,wherethetermsforkeepingparallelandcircularformationsdependonlyonvisualparameters.Thispaperisorganizedasfollows.InSectionII,wereviewanumberofimportantrelatedworks.Somebackgroundinfor-mationongraphtheoryandothermathematicaltoolsusedinthispaperareprovidedinSectionIII.TheproblemstatementisgiveninSectionIV.InSectionsVandVI,wepresentthecontrollersthatstabilizeagroupofmobileagentsintoparallelandbalancedcircularformations,respectively.InSectionVII,wederivethevision-basedcontrollersthatareintermsofthevisualmeasurementsoftheneighboringagents.InSectionVIII,collision-avoidancecapabilitiesareaddedtothecontrollaws,andtheireffectivenessistestedonrealrobots.1552-3098/$26.002009IEEEAuthorizedlicenseduselimitedto:NanchangUniversity.DownloadedonJanuary12,2010at20:02fromIEEEXplore.Restrictionsapply.852IEEETRANSACTIONSONROBOTICS,VOL.25,NO.4,AUGUST2009II.RELATEDWORKANDCONTRIBUTIONSTheprimarycontributionofthispaperisthepresentationofsimplecontrollawstoachieveparallelandcircularformationsthatrequireonlyvisualsensing,i.e.,theinputsareintermsofquantitiesthatdonotrequirecommunicationamongnearestneighbors.IncontrastwiththeworkofJusthandKrishnaprasad17,MoshtaghandJadbabaie27,Paleyetal.32,33,andSepulchreetal.35,whereitisassumedthateachagenthasaccesstothevaluesofitsneighborspositionsandvelocities,wedesigndistributedcontrollawsthatuseonlyvisualcluesfromnearestneighborstoachievemotioncoordination.Ourapproachonderivingthevision-basedcontrollawscanbeclassifiedasanimage-basedvisualseroving41.Inimage-basedvisualservoing,featuresareextractedfromimages,andthenthecontrolinputiscomputedasafunctionoftheimagefeatures.In8,12,and38,authorsuseomnidirectionalcam-erasastheonlysensorforrobots.In8and38,inputoutputfeedbacklinearizationisusedtodesigncontrollawsforleader-followingandobstacleavoidance.However,theyassumethataspecificverticalposeofanomnidirectionalcameraallowsthecomputationofbothbearinganddistance.IntheworkofPrattichizzoetal.12,thedistancemeasurementisnotused;however,theleaderusesextendedKalmanfilteringtolocalizeitsfollowers,andcomputesthecontrolinputsandguidestheformationinacentralizedfashion.Inourpaper,thecontrolar-chitectureisdistributed,andwedesigntheformationcontrollersbasedonthelocalinteractionamongtheagentssimilartothatof14and22.Furthermore,forourvision-basedcontrollers,nodistancemeasurementisrequired.In25and34,circularformationsofamultivehiclesys-temundercyclicpursuitisstudied.Theirproposedstrategyisdistributedandsimplebecauseeachagentneedstomeasuretherelativeinformationfromonlyoneotheragent.Itisalsoshownthattheformationequilibriaofthemultiagentsystemaregeneralizedpolygons.Incontrastto25,ourcontrollawisanonlinearfunctionofthebearingangles,andasaresult,oursystemconvergestoadifferentsetofstableequilibria.III.BACKGROUNDInthissection,webrieflyreviewanumberofimportantcon-ceptsregardinggraphtheoryandregularpolygonsthatweusethroughoutthispaper.A.GraphTheoryAn(undirected)graphGconsistsofavertexsetVandanedgesetE,whereanedgeisanunorderedpairofdistinctverticesinG.Ifx,yVand(x,y)E,thenxandyaresaidtobeadjacent,orneighbors,andwedenotethisbywritingxy.Thenumberofneighborsofeachvertexisitsdegree.Apathoflengthrfromvertexxtovertexyisasequenceofr+1distinctverticesthatstartwithxandendwithysuchthatconsecutiveverticesareadjacent.IfthereisapathbetweenanytwoverticesofagraphG,thenGissaidtobeconnected.TheadjacencymatrixA(G)=aijofan(undirected)graphGisasymmetricmatrixwithrowsandcolumnsindexedbytheverticesofG,suchthataij=1ifvertexiandvertexjareneighbors,andaij=0otherwise.Wealsoassumethataii=0foralli.ThedegreematrixD(G)ofagraphGisadiagonalmatrixwithrowsandcolumnsindexedbyV,inwhichthe(i,i)-entryisthedegreeofvertexi.ThesymmetricsingularmatrixdefinedasL(G)=D(G)A(G)iscalledtheLaplacianofG.TheLaplacianmatrixcapturesmanytopologicalpropertiesofthegraph.TheLaplacianLisapositive-semidefinitematrix,andthealgebraicmultiplicityofitszeroeigenvalue(i.e.,thedimensionofitskernel)isequaltothenumberofconnectedcomponentsinthegraph.Then-dimensionaleigenvectorassociatedwiththezeroeigenvalueisthevectorofones,1n=1,.,1T.Formoreinformationongraphtheory,see13.B.RegularPolygonsLetd1andnanddarecoprime,thentheedgesintersect,andthepolygonisastar.Ifnanddhaveacommonfactorl1,thenthepolygonconsistsofltraversalsofthesamepolygonwithn/lverticesandedges.Ifd=n,thepolygonn/ncorrespondstoallpointsatthesamelocation.Ifd=n/2(withneven),thenthepolygonconsistsoftwoendpointsandalinebetweenthem,withpointshavinganevenindexononeendandpointshavinganoddindexontheother.Formoreinformationonregulargraphs,see7.IV.PROBLEMSTATEMENTConsideragroupofnunit-speedplanaragents.Eachagentiscapableofsensinginformationfromitsneighbors.Theneigh-borhoodsetofagenti,thatis,Ni,isthesetofagentsthatcanbe“seen”byagenti.Theprecisemeaningof“seeing”willbeclarifiedlater.Thesizeoftheneighborhooddependsonthechar-acteristicsofthesensors.TheneighboringrelationshipbetweenagentscanbeconvenientlydescribedbyaconnectivitygraphG=(V,E,W).Definition1(Connectivitygraph):TheconnectivitygraphG=(V,E,W)isagraphconsistingof1)asetofverticesVindexedbythesetofmobileagents;2)asetofedgesE=(i,j)|i,jV,andij;3)asetofpositiveedgeweightsforeachedge(i,j).TheneighborhoodofagentiisdefinedbyNi.=j|ijVi.Letrirepresentthepositionofagenti,andletvibeitsvelocityvector.Thekinematicsofeachunit-speedagentisAuthorizedlicenseduselimitedto:NanchangUniversity.DownloadedonJanuary12,2010at20:02fromIEEEXplore.Restrictionsapply.MOSHTAGHetal.:VISION-BASED,DISTRIBUTEDCONTROLLAWSFORMOTIONCOORDINATIONOFNONHOLONOMICROBOTS853Fig.1.TrajectoryofeachagentisrepresentedbyaplanarFrenetframe.givenbyri=vivi=ivivi=ivi(1)whereviistheunitvectorperpendiculartothevelocityvectorvi(seeFig.1).Theorthogonalpairvi,viformsabodyframeforagenti.Werepresentthestackvectorofallthevelocitiesbyv=vT1,.,vTnTR2n1.Thecontrolinputforeachagentistheangularvelocityi.Sinceitisassumedthattheagentsmovewithconstantunitspeed,theforceappliedtoeachagentmustbeperpendiculartoitsvelocityvector,i.e.,theforceoneachagentisagyroscopicforce,anditdoesnotchangeitsspeed(andhence,itskineticenergy).Thus,iservesasasteeringcontrol16foreachagent.Letusformallydefinetheformationsthatwearegoingtoconsider.Definition2(Parallelformation):Theconfigurationinwhichtheheadingsofallagentsarethesameandvelocityvectorsarealignediscalledtheparallelformation.Notethatinthisdefinition,wedonotconsiderthevalueoftheagreeduponvelocitybutjustthefactthattheagreementhasbeenreached.Attheequilibrium,therelativedistancesoftheagentsdeterminetheshapeoftheformation.Anotherinterestingfamilyofformationsisthebalancedcircularformation.Definition3(Balancedcircularformation):Theconfigurationwheretheagentsaremovingonthesamecirculartrajectoryandthegeometriccenteroftheagentsisfixediscalledthebalancedcircularformation.Theshapeofsuchaformationcanberepresentedbyanappropriateregularpolygon.Inthefollowingsections,westudyeachformationanddesignitscorrespondingdistributedcontrollaw.V.PARALLELFORMATIONSOurgoalinthissectionistodesignacontrollawforeachagentsothattheheadingsofthemobileagentsreachanagree-ment,i.e.,theirvelocityvectorsarealigned,thusresultinginaswarm-likepattern.ForanarbitraryconnectivitygraphG,con-sidertheLaplacianmatrixL.We,therefore,defineameasureofmisalignmentasfollows27,35:w(v)=12summationdisplayij|vivj|2=12v,Lv(2)wherethesummationisoverallthepairs(i,j)E,andL=LI2R2n2n,withI2beingthe22identitymatrix.Thetimederivativeofw(v)isgivenbyw(v)=nsummationdisplayi=1vi,(Lv)i=nsummationdisplayi=1ivi,(Lv)iwhere(Lv)iR2isthesubvectorofLvassociatedwiththeithagent.Thus,thefollowinggradientcontrollawguaranteesthatthepotentialw(v)decreasesmonotonically:i=vi,(Lv)i=summationdisplayjNivi,vij(3)where0isthegain,andvij=vjvi.Remark1:Letirepresenttheheadingofagentiasmeasuredinafixedworldframe(seeFig.1).Theunitvelocityvectorvianditsorthogonalvectorviaregivenbyvi=cosisiniTandvi=sinicosiT.Thus,thecontrolinput(3)becomesi=summationdisplayjNisin(ij),0.(6)Thefollowingtwotheorems28presenttheresultswhenbalancedcircularformationsareattainedforagroupofunit-speedagentswithfixedconnectivitygraphs.Theorem2isforthecasewhenGisacompletegraph,andTheorem3isfortheringgraph.Theorem2:Considerasystemofnagentswithkinematics(5).GivenacompleteconnectivitygraphGandapplyingcontrollaw(6),then-agentsystem(almost)globallyasymptoticallyconvergestoabalancedcircularformation,whichisdefinedinDefinition3.Proof:See28fortheproof.squaresolidThereasonfor“almostglobal”stabilityofthesetofbal-ancedstatesisthatthereisameasure-zerosetofstateswheretheequilibriumisunstable.Thissetischaracterizedbythoseconfigurationsthatmagentsareatantipodalpositionfromtheothernmagents,where1mn/2.Next,weconsiderthesituationthattheconnectivitygraphhasaringtopologyGring.Theorem3:Considerasystemofnagentswithkinematics(5).SupposetheconnectivitygraphhastheringtopologyGringandthateachag
溫馨提示
- 1. 本站所有資源如無特殊說明,都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請下載最新的WinRAR軟件解壓。
- 2. 本站的文檔不包含任何第三方提供的附件圖紙等,如果需要附件,請聯(lián)系上傳者。文件的所有權(quán)益歸上傳用戶所有。
- 3. 本站RAR壓縮包中若帶圖紙,網(wǎng)頁內(nèi)容里面會有圖紙預(yù)覽,若沒有圖紙預(yù)覽就沒有圖紙。
- 4. 未經(jīng)權(quán)益所有人同意不得將文件中的內(nèi)容挪作商業(yè)或盈利用途。
- 5. 人人文庫網(wǎng)僅提供信息存儲空間,僅對用戶上傳內(nèi)容的表現(xiàn)方式做保護處理,對用戶上傳分享的文檔內(nèi)容本身不做任何修改或編輯,并不能對任何下載內(nèi)容負責(zé)。
- 6. 下載文件中如有侵權(quán)或不適當內(nèi)容,請與我們聯(lián)系,我們立即糾正。
- 7. 本站不保證下載資源的準確性、安全性和完整性, 同時也不承擔(dān)用戶因使用這些下載資源對自己和他人造成任何形式的傷害或損失。
最新文檔
- 2025年建筑施工吊裝作業(yè)人員勞務(wù)派遣協(xié)議
- 2025年科技研發(fā)策劃貸款協(xié)議書范本
- 合規(guī)管理對企業(yè)品牌聲譽的長期影響
- 企業(yè)在融資中的法律風(fēng)險管理
- 2025年圍欄護欄個性化定制與安裝服務(wù)協(xié)議
- 高管責(zé)任與公司治理的關(guān)聯(lián)性分析
- 語文教育數(shù)字化轉(zhuǎn)型與創(chuàng)新路徑
- 理賠業(yè)務(wù)風(fēng)險管理跨文化協(xié)作風(fēng)險基礎(chǔ)知識點歸納
- 大連景點介紹課件視頻
- 農(nóng)業(yè)機器人技術(shù)在生產(chǎn)中的應(yīng)用前景
- 國開2024年秋《教育心理學(xué)》形成性考核1-4答案
- CDFI醫(yī)師、技師彩超上崗證-單項選擇題(試題)
- 病理檢驗技術(shù)課程設(shè)計
- 招投標管理招聘筆試題與參考答案
- 高考監(jiān)考員培訓(xùn)考試題庫(含參考答案)
- 村霸舉報信范文(篇一)
- 華為企業(yè)架構(gòu)設(shè)計方法及實例
- 2024年福建省泉州市惠安縣綜治網(wǎng)格員招聘173人歷年高頻考題難、易錯點模擬試題(共500題)附帶答案詳解
- 2024-2030年中國鹽化工行業(yè)運營態(tài)勢與發(fā)展前景展望報告
- 《聚落與環(huán)境》名師課件
- 《城軌通信信號基礎(chǔ)設(shè)備應(yīng)》課件-FTGS軌道電路
評論
0/150
提交評論