机械手外文翻译_3.docx
《机械手外文翻译_3.docx》由会员分享,可在线阅读,更多相关《机械手外文翻译_3.docx(22页珍藏版)》请在得力文库 - 分享文档赚钱的网站上搜索。
1、机械手外文翻译Proceedingsofthe33rdChineseControlConferenceJuly28-30,2021,Nanjing,ChinaTheRemoteControlSystemoftheManipulatorSUNHua,ZHANGYan,XUEJingjing,WUZongkaiCollegeofAutomation,HarbinEngineeringUniversity,Harbin15000E-mail:sunhuasAbstract:Aremotecontrolsystemofthe5degreeoffreedommanipulatorwasdesigned.
2、Thismanipulatorwasinstalledintoourmobilerobottoconstitutearemoterescuerobot.TheDenavit-Hartenbergmethodwasusedtoestablishthekinematicmodelsandthepathplanningofthemanipulatorwasresearched.TheoperatorcouldremotecontrolthemanipulatorbytheinteractiveinterfaceofPCwhichcoulddisplaymovingpictureandvariousd
3、ataofthemanipulator.TheservosofthemanipulatorwerecontrolledbytheslaveFPGAcontroller.Inaddition,theslaveFPGAcontrollercommunicatedwiththePCviathewirelesscommunicationmodule.OwingtotheembeddedNiosIIprogramandIP(IntellectualProperty)coregeneratingPWMwavesinFPGA,thesystemcouldcontrolthemultipleservosfas
4、tandflexible.Inordertoachievereal-timeoperationandsimulation,theinteractiveinterfacewasestablishedbythemixedprogrammingofVCandMATLAB.KeyWords:Themanipulator;Remotecontrol;Denavit-Hartenberg;FPGA;Human-computerinteraction1IntroductionWiththedevelopmentofthemicroelectronictechniqueandthecomputertechno
5、logy,themanipulatorhasbecomeessentialequipmentinthemanufacturingindustry.Asweallknown,themanipulatorisusuallyappliedtoaccomplishdull,onerousandrepeatedphysicalwork,especiallyusedtosubstitutethemanualoperationunderthedangerousandthehazardousenvironmentsuchasthecorrosionandthehightemperature.Inthispap
6、er,themanipulatorwasinstalledourmobilerobot.Thetele-operationsystemofthismanipulatorwasdesigned.ThewholesystemisonstitutedbyPCandslaveFPGA.TheoperatorcanremotecontrolthemanipulatorbyPC.ThewirelesscommunicationwasusedfortransmittingdatabetweenPCandFPGA.FPGAiscontrollerofthethemanipulatorinthemobilero
7、bot.FPGAhastheabundantinternalresourceandIPcores.AndacentralcontroloptionwasbuiltviaanembeddedNiosIIprogramandanIPcoreinFPGA.Furthermore,VeriloglanguagewasadoptedtodesigntheIPcorewhichgenerateddigitalPWMwavesforcontrollingthemanipulator.Therefore,thissystemcouldreachhigherprecisionandeasytodebug.MAT
8、LABsoftwarewasadoptedtobuildthekinematicmodelsofmanipulator.AndusingD-H(theacronymofDenavit-Hartenberg)methodtosolvetheforwardandinversekinematicequationsofthemanipulator,toanalyzethemotivation,toplanandtrackthemotionspath.Inaddition,agoodinterfaceofhuman-computerinteractionwasenhancedintheremotecon
9、trolsystemofthemanipulatorinPC.Moreover,themanipulatorsimulationtechnologywasbuiltbyusingthemixedprogrammingofVCandMATLAB.Thus,themotionchoreographswasgotquicklyandeasily,alsogreatlysavedtimeandcutthecost.2ManipulatorModelandPathPlanningAtfirst,themotionmodelofthemanipulatorwasbuilt.Then,thekinemati
10、csimulationanditspathplanningwereresearched.Theseworksprovidedthefoundationforthedesignoftheremotecontrolsystemofthemanipulator.2.1MotionModeloftheManipulatorThemanipulatorwasregardedasanopenloopkinematicchain.Itwasconstitutedbyfiverotaryjoints.Anditsoneendwasfixedonabasewhiletheotherendwasusedtoach
11、ievetheabilityofgrabbing.Therefore,itisbettertoestablishachaincoordinateframeasshowninFig.1.Theterminalpositionandattitudewasdeterminedviausingforwardkinematicequationafterknowingtherotatingangleofeveryjoint.TheD-HparametertableshownasTable1wasestablishedbyusingtheframesinFig.1.Fig.1Coordinateframes
12、ofmechanicalarmTable1D-HParametersoftheRobotArmDuetoD-Hmethod:T=An+1n+1n=Cn+1?Sn+1Sn+1CanCn+1Can0an?San?Sandn+1Sn+1SanCn+1San00CanCandn+101WhereCn+1=cosn+1,Sn+1=sinn+1,Can=cosan,San=sinan.Thetransformationmatrixofeveryjointwasgivenbyequation(2).T10=cos1sin1sin1cos1000000001001T21=cos2?sin200001d1?si
13、n2?cos2000001T32=cos3?sin3sin3cos3000000001d201T43=cos4?sin40000?1?d3sin4cos4000001T54=cos5?sin5sin5cos5000000001d401T50=nxnxnynynxnxnynynznz00nznz01=T10T2?1T3?2T4?3T5?4(2)Whereunitvectorn,o,ainequation(2)wasn=normal,n=orientation,n=approac?,n=position.Parametersofmechanicalarmweregivenbyd1=85mm,d2=
14、116mm,d3=85mm,d4=95mm.Thereforetheforwardkinematicequationwasdeterminedbytakingeveryparameterinequation(3).P50=180C1S2+3+116C1S2180S1S2+3+116C1S285+116C2+180C2+3(3)Inpracticalapplication,themanipulatorwasadoptedtograbobjects.Thisrequiredthatthefixedpositionwasgivenfromterminaltotargetlocation.Thatwa
15、stheinversekinematicanalysisofmanipulator.Inversetransformationwasusedtodetermineangleofeveryrotaryjointtowardtheestablishedcoordinates.Andtheusedmethodofinversetransformationwasthecommonmethodtosolvesuchproblem(thismethodalsoknownasalgebraicmethod).UsinginversetransformationTnn?1?1separatelytothele
16、ftmultiplicationwithT=50T10T2?1T3?2T4?3T5?4,theangleofeveryrotaryjoint12345wasdetermined.Owingtotheseresults,therotaryangles123atterminalpositionofmanipulatorweretotallydecidedbythetargetpositionPxPyPz.Angle4wasusedtochangeterminalattitudeofthemanipulatoranditwaschangedbytheknownnormalvector.However
17、,angle5,wasdecidedbythesizeoftargetobject.2.2MotionSimulationoftheManipulatorThemanipulatormodelwasbuiltandsimulatedviaMATLABtoolbox.Wecouldverifytherationalityofthemathematicalmodel.WhiletheMATLABmodelwasestablishedbytable1andshownasFig.2Fig.2MATLABsimulationofthemanipulatorComparingtotheFig.1andFi
18、g.2,thesimulationmodelofthemanipulatorwascoincidedtothereferenceframemodel.Thatwastosay,thegivencoordinateframewascorrect.TheseresultsalsocouldbeprovedbythedeterminedinversekinematicequationsviaMATLABshowninthetable(2)andtable(3).Thetargetpositionwassolvedbyforwardkinematics.Afterthat,therotaryangle
19、swerecalculatedbyinversekinematicalequation.Itturnedoutthattheserotaryanglescoincidedtothegivenangles.Therefore,theseresultsverifiedthecorrectnessofforwardandinversekinematicalequation.Table(2)ForwardKinematicsAnalyzeTable(3)InverseKinematicsAnalyze3PathPlanningoftheManipulatorThetotaldisplacementof
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 机械手 外文 翻译 _3
限制150内