符合PLCopen运动控制规范机器人控制软件平台最佳应用实践_梁恩泉_分发版

1、清华大学电机系中国科技自动化联盟清华大学电机系中国科技自动化联盟u» 4-符合PLCopen运动控制规范的机器人 控制软件平台的最佳应用实践报告人：梁恩泉菲尼克斯电气软件有限公司软件业务经理2015年9月LL日About Me Personal DataGary Liang / 梁恩泉liangenquan phoe nixcon .c n2007 一 up to now Phoe nix Con tact Software Business Development and Team Management清华大学电机系中国科技自动化联盟清华大学电机系中国科

2、技自动化联盟清华大学电机系中国科技自动化耳Phoenix Contact Software GmbH菲尼克斯电气软件有限公司总部：Lemgo,德国成立于1982哼爵頫需户提供 Renaming KW-Softwarefrom 2015. 01. 01清华大学电机系中国科技自动化耳清华大学电机系中国科技自动化耳Tech no logy for Your Automati on!I EC 61131: SoftPLC runtime + Programming ToolSAFETY:SoftPLC runtime + Programming Tool (Certified, SIL3) PROFI

3、NET:Profinet IO Controller/Device stack (RT/IRT)PLCR.CbthsAtw50ft PLCialrtrPtCi/0伽伽Configurated 昭Autoratk. vrsUnnSCI-TECHHu山tnufs1SRpug Aq P.2JIPOW eq ueo.Sp4-Seul op eldEIS 301 AQP op As©g ias.u a. 9-.3 9>s tj 9 X *: f-of.Jesnpug Aq PJIPOUI eq 4OUUE0 UEeRUHPUI 04 x Iduloo doICDACDp op molma

4、 o-qeu 山 H smecoQs-eJ H lse_J(D66 一匚iosoLTO66 一 匚 H lse"l(D66 一匚orul H 唸-qeu 山)七)()ssa)ood po>o-dnd(0Hcnooos-ej n smeCDos_ej Hlse"ll6一匚二)-E_0o>Jnd 9unooo66一 匚Isgeo9-qndLM06_l8NO_10NnzlssSH90IJJ一 4。范elue>p<韻幽壬尼皿拦肚EI-&-<ri x|IEC61131 Software Solutionat .c<raAMitfaDeiL&

5、#187;/O4t CtffM 3，xZ、>-； ® 乓3 15曰巧/电讥TjjM “曰'。田3 屮 “ ：，|,| = | ：. |» ca aOBiAAf TT- e»sl»B9B S5-VrFt3UCDRAT4COH.$TK» COH.KXT LODW5TCi) WEQ SFCVQ mK 3 5 如*K U| AcSreB J no.ooT g» n noooTg. 3J WGI3aGR “ JJ WT.$fRS D CJK IK.»3 CH_£aM) F SB nx_i rcoi.Ni G n

6、W.SHT 由 ”山SRES-SWVT<*PSIMWMP_MIMirvtxjw*-LEVB._iXAxtlMi V川 Swttcti0 UMJIATIO0»XQUQOcvcucoH*-r« REStt IOM>PV<JU output CO_O«tpv<«»w«»GwXJlTCTDActuCMfVMLto-ttCTUDC<M«ei Ux*fow»-llr.inoralroEdja DmXo*R_TRO住:Xj £d?C*s*x«5OXRAMtCKMVM&#

7、174;SRS*«CMrvraH:ftGr*C«iWQrmr«wCki<M4y«rpZetoad回夕c- -ga cecoc*ooZ llllllllllllllllllw,、' ,4.ProConOSOS-00-.Q I. 1 O. mIiiiiiiiiiiiiiiiiiiiii._JCUNopsnDeviceNet«95uu55JT/OO如3师餌q芳今?Ef$ m. ! E /S:o®o©oInter Bus清华大学电机系中国科技自动化联盟机器人控制器设计实现方式完全自主开发；借助现有第三方控制器来集成开发

8、；采用第三方核心软件开发自己的控制器；（开放 式平台）清华大学电机系中国科技自动化联盟清华大学电机系中国科技自动化联盟 nu romn nonSCI-TECH清华大学电机系中国科技自动化联盟Soft-PLCf Real-time Ethernet基于高性能IPC架构IEC 61131, HMI, Bus Configuration清华大学电机系中国科技自动化联盟清华大学电机系中国科技自动化联盟MULTIPROGYSoftPLC MC/RCINtime virtual machine清华大学电机系中国科技自动化联盟支持16轴同步6轴插补的运动控制清华大学电机系中国科技自动化联盟清华大学电机系中国

9、科技自动化联盟SCI-TECH清华大学电机系中国科技自动化联盟清华大学电机系中国科技自动化联盟SCHTECH 翔気清华大学电机系中国科技自动化联盟清华大学电机系中国科技自动化联盟Robot MovementAsecsCroup- Point To Point: ExecuteDone vMC MoveDirAbsCoordSyateaDuffQrnodQBuqActiveCo ntriand Abo tft od，:ErrorErrorlD 勺JoblD >Linear:MC_MoveLinAbsCircular:MC_MoveCircAbsn：.*?罕nj_iv-AxwGvcajpPC

10、 空 cd AxeCxcp-ExecutePont?1CxccModaBtaxy1AuxPoiritActiveEridPointCowriond 枪 o rt edPathChoicrErrorn>ixiPl»ir»Ex xor IX*VelocityJoblDBirff rModa清华大学电机系中国科技自动化联盟清华大学电机系中国科技自动化联盟ISG Motion TechnologyF5愛一島一? SIEMENS?Daimler Ben 2 他msp*Schjjeider#EfccuxPanasonicLenzeiESRrromRTionVAGOR蠟粧西aJH0

11、FF KUKAUHUKVkNUWICAOtetoicontrolssimulation/virtual machi n©medical technologydrive technologyEISENMANN UATFICWI Z臓KQCffROTOXMftSCHi HFNMBfilt/fk KHS manroland BOSCH 竺雪Krauss Maffei OYSTAR IWKSteam technik BOSCHk£U0匸 nronESpilzHC江巧轨占口曲 3Im a«rhi hp nDAIMLERHELLERMiCROTEC悭叱肥SCHULERappl

12、icationsKSE辭适I wohlenberg3 C3 h nni r.NMAunttAmmetoBrt-QinMconsulting servicesHORSTMANNGROUP'fi (GROBTRUMPFBAUMUUEH «1 丿os- © s6u_JWc6ud IKW230W5A&OJOUIpat 532a B 8GB £-HZIDZLBZRG-tfcrrr) BOSCH清华大学电机系中国科技自动化联盟清华大学电机系中国科技自动化联盟符合PLCopen运动控制Parti/2规范Motion-Library McpPLCopenBaseM

13、C_PowerMC_StopMC_ReadAxislnfoMC_AbortTriggerM C_Read MotionstateMC_Touch ProbeMC_ReadStatusMC_CamlnMC_ReadAxisErrorMC_CamOutMC_ReadActual PositionMC_CamTableSelectMC_ResetMC_Gearl nMC_HomeMC_GearOutMC_MoveAbsoluteMC_PhasingMC_MoveAdditiveMC_ReadParameterMC_MoveRelativeMC_WriteParameterMC_MoveSuperlm

14、posedMC_SetPositionMC_MoveVelocityMC_SetOverrideMC_Halt清华大学电机系中国科技自动化联盟清华大学电机系中国科技自动化联盟完全符合PLCopen运动控制Part4规范Motion-Library McpPLCopenP4MC_GrpEnableMC_MoveCircAbsMC_GroupHaltMC_MoveCircRelMC_GrplnterruptMC_MoveDirAbsMC_GrpReadActPosMC_MoveLinAbsMC_GrpReadCfgMC_MoveLinRelMC_GrpReadErrorMC_RemAxisFrom

15、GroupMC_Grp Read InfoMC_SetCartTransMC_GrpReadStatusMC_UngroupAIIAxesMC_Grp ResetMC_GrpSetOverrideMC_GrpStopSCI-TECH 蛰清华大学电机系中国科技自动化联盟提供以下类型机器人运动学6自由度机器人SCARA机器人直接坐标机器人SCI-TECHHUTOmHTIOn开放式运动学SDKINtime SDKMicrosoft Visual Studio也；t fenster Wife in32清华大学电机系中国科技自动化联盟清华大学电机系中国科技自动化联盟INtime Runtime清华大学电

16、机系中国科技自动化联盟ISG-Kerneld me nbr_axi8,USFOKMSlTTOM-COORD pcoord, F param)lnitTrafo()internalkinematic libraryReverseTrafo()x, y;SEO ZXAXFLt, 2I0T TCR V5E WXTK A RTAL R93CT !ForwardTrafo()Trafo dll.rslcccrd->ac9i);«rU3】IN 2iann_id, nbr_axis> ；清华大学电机系中国科技自动化联盟Motion Control Platform Architectu

17、reCNC/MCChannel 1DECTGCDynPrepM AxlpoTRAFOChannel 2DECTGCDynPrepM AxlpoTRAFOChannel nDECTGCICH 2DynPrepAxis control1122M AxlpoSAISAISAsTRAFO L-Ich 1+/-10VIa/ISimulationSERCOS Profidrive CAN- - - StepmotorsFlUTOmHTIOnSCI-TECHIn teg rated Robot features:Path Planning19清华大学电机系中国科技自动化联盟19清华大学电机系中国科技自动化联盟Akima-SplineFillets and chamfersTrajectory optimizationJerk limited contouringCircularHelical二pyB-Splinec detection of prismatic ；trajectory segme ntsInterpolationooLinearVelocity profiles (slope function)<.5 -R12卞7厂、弋J1Arammable velocity e parameters19清华大学电机系中国科技自动化联盟Robot Bl