课件-4.3-PLC运动控制编程

第4章·伺服控制技术4.3PLC运动控制编程标准之力——用PLCOpen指令驱动每一个轴本节知识链控制架构→IEC61131-3→PLCOpen→轴的概念→MC指令→点位控制4.3.1汇川AutoShop运动控制指令|4.3.2PLC控制步进电机与伺服电机|第4章本章小结与复习机电系统控制原理及应用·数字教材配套授课课件本节导图4.3·内容与知识主线数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件0201伺服控制器的选型与技术本质PLC/嵌入式系统/工控机加运动板卡三种主流架构；控制本质是编程控制数字量IO的输出02两个标准：IEC61131-3与PLCOpenIEC61131-3规范PLC编程语言；PLCOpen制定运动控制规范，用功能块表达功能03轴：驱动器与PLC指令之间的桥梁运动控制的对象称为轴；控制符合402协议的EtherCAT总线驱动器，也支持本地高速脉冲输入输出0413条PLCOpen常用运动控制指令单轴指令分使能复位、状态读取、运动控制、停止暂停四类；触发机制分Enable（电平）与Execute（上升沿）05PLC控制步进电机与伺服电机用MC_Home/MC_MoveAbsolute/MC_MoveRelative实现回原点与点位控制，并结合加减速曲线与编码器反馈主线·知识链控制器与标准↓轴的概念↓MC指令集↓点位控制↓整章回顾学习目标学完4.3，你将能够…数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件03知识目标①说出伺服控制器的三种主流架构及各自特点②理解运动控制的本质是控制数字量IO输出③知道IEC61131-3标准的地位与作用④知道PLCOpen运动控制规范的地位⑤理解“轴”的概念及其在系统中的位置⑥区分单轴指令与轴组指令⑦区分Enable类与Execute类触发机制⑧记住13条常用运动控制指令的功能技能目标①能根据工艺需求为项目选择合适的控制器②能读懂轴的结构关系与内部构成逻辑③能按功能对运动控制指令分类选用④能用MC_Home/MC_MoveAbsolute/MC_MoveRelative完成回原点与点位控制方案设计⑤能说明加减速曲线与闭环反馈的作用素质目标①建立“接口标准化、指令标准化”的工程视野②养成按标准与手册编程、不凭记忆写指令的习惯③强化安全停机与异常处理的编程意识④提升复杂机电系统的综合分析能力⑤团队协作与规范操作意识本节关键运动控制的本质是“用程序控制数字量IO的输出”；PLCOpen把这件事标准化成了13条功能块指令，学会一种控制器，就学会了一类。4.3.1汇川AutoShop运动控制指令控制器选型·两个标准·轴的概念·13条MC指令控制架构→IEC61131-3→PLCOpen→轴→MC指令机电系统控制原理及应用·数字教材配套授课课件知识要点伺服控制器的三种主流架构数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件05PLC开发周期短、维护简便；与HMI（人机界面）、SCADA（监控与数据采集）系统无缝集成；在工业伺服控制领域应用最为广泛。嵌入式系统基于C语言等底层开发；成本低、体积小、可深度定制；适合大批量的专用设备，但开发周期长、维护门槛高。工控机+运动板卡算力强、可运行复杂算法与图形界面；适合多轴、高精度、需二次开发的场合；但成本与体积较高，长期运行的可靠性要求高。为什么PLC最普及？伺服系统作为现代工业自动化领域的核心控制组件，其控制器选型对系统的高精度、快速响应以及高度可靠性具有至关重要的影响。PLC凭借开发周期短、维护简便以及与HMI、SCADA无缝集成的显著优势，在工业伺服控制领域中得到了最为广泛的应用。选型口径批量标准化设备→PLC；大批量专用产品→嵌入式；多轴复杂算法与科研开发→工控机+运动板卡。本课程以PLC（汇川AutoShop平台）为主线讲解运动控制编程。知识要点技术本质：程序控制数字量IO的输出数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件06本质对步进电机或伺服电机的控制，实际上是通过为控制器编写相应的程序来控制数字量IO（输入/输出）的输出。嵌入式系统开发基于C语言，直接操作寄存器与定时器产生脉冲工控机+运动板卡调用板卡厂商提供的运动库函数，在PC上编程PLC梯形图开发调用PLCOpen标准功能块指令，图形化编程共同点：都已经有现成的“库函数或指令集”得益于伺服接口的规范化发展，无论是基于C语言的嵌入式系统开发、工控机与运动板卡的结合开发，还是采用梯形图进行编程的PLC开发，都已经针对运动控制领域开发出了相应的库函数或指令集——我们不必从零开始生成脉冲序列。启示接口标准化+指令标准化=学一次、用一片。这也是下面要讲IEC61131-3与PLCOpen的原因。知识要点IEC61131-3：PLC编程语言的国际标准数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件07IEC61131-3是国际电工委员会（IEC）制定的PLC编程语言标准，旨在规范工业自动化控制系统的软件开发。它要解决什么问题？传统PLC编程中普遍存在两个痛点：一是平台不兼容——不同厂商的编程方式、指令体系各不相同，换一个品牌就要重学一遍；二是代码复用性差——为一个项目写的程序难以移植到另一个平台。谁兼容这个标准？目前，西门子、汇川、罗克韦尔、倍福等知名厂商的PLC均兼容该标准。这意味着工程师掌握的编程思想与程序结构可以在不同品牌之间迁移。对学习者的意义不必纠结于某个品牌的操作细节——把标准规定的编程范式、变量与程序组织方式学会，换平台只是换界面。知识要点PLCOpen：事实上的运动控制标准数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件08PLCOpen作为一个国际组织，致力于推动IEC61131-3标准的应用拓展，特别是在运动控制领域。标准的地位该组织制定的运动控制规范已成为国际公认的、事实上的运动控制标准。表达的方式PLCOpen制定的运动控制规范，都是用相应的功能块来表达功能。对工程师的价值同一个MC_MoveAbsolute，在汇川、西门子、倍福上含义一致。两个标准的分工IEC61131-3管“用什么语言写程序”，PLCOpen管“运动控制这一类功能怎么表达”。前者是语言标准，后者是应用层的功能块规范。记忆IEC61131-3定语言，PLCOpen定功能块——本节后面讲的13条指令就来自PLCOpen。知识要点什么是“轴”数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件09定义在汇川运动控制系统中，将运动控制的对象称为“轴”。轴是连接驱动器和PLC指令（运动控制MC指令）之间的桥梁——PLC不直接面对电机，而是面对一个抽象的“轴”。轴能控制什么？运动控制轴用于控制符合402协议的EtherCAT总线驱动器；同时还可以控制本地高速脉冲输出和高速脉冲输入。也就是说，总线型伺服与脉冲型步进/伺服都可以统一用“轴”来管理。统一的对象模型无论底下接的是步进还是伺服、脉冲还是总线，上层都用同一个“轴”来操作统一的指令集对轴施加PLCOpen指令，由底层适配到具体的驱动接口统一的状态使能、就绪、运行中、故障等状态由轴统一维护为什么要抽象？抽象出“轴”之后，程序不再依赖具体硬件：换电机、换总线只需改配置，运动逻辑不用重写。教材图示图4-23汇川运动控制指令轴结构关系数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件10从图里读出三层结构上层是运动控制指令（MC指令）：工程师编写的程序只与这一层打交道。中间是轴：指令作用的对象，维护位置、速度、状态等数据。下层是驱动器与电机：符合402协议的EtherCAT总线驱动器，或本地高速脉冲输出。箭头方向说明了指令的下达路径：MC指令→轴→驱动器→电机。反馈则沿相反方向返回：编码器→驱动器→轴→状态读取类指令。图4-23汇川运动控制指令轴结构关系记住这张图“轴”是这一节的中心概念——13条指令全部是围绕轴来操作的。教材图示图4-24PLC内部轴的构成与逻辑数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件11图4-24PLC内部轴的构成与逻辑轴的数据位置、速度、转矩等实时数据由驱动器反馈后保存在轴对象中。轴的状态使能、就绪、运行、停止、故障等状态决定哪些指令可以执行。轴的指令运动指令改变轴的目标值，读取指令取回轴的当前值。知识要点单轴与轴组、Enable与Execute数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件12单轴指令一个电机的控制。是单个伺服轴的独立运动控制，是运动控制的基础功能模块。本课程只介绍单轴指令。轴组指令多个电机的控制。可以实现多轴插补和同步，面向复杂协同场景（如机械臂末端轨迹控制）。Enable类指令（电平触发）需要保持Enable=TRUE以维持功能生效。典型：MC_Power（使能）、MC_MoveVelocity（持续运行）。Execute类指令（上升沿触发）仅需一次上升沿即可触发完整动作流程。典型：MC_MoveAbsolute、MC_Home、MC_Reset。编程易错点Execute类指令如果在程序里一直保持接通，只会触发一次；要再次执行必须重新给一个上升沿。而Enable类指令一旦断开，动作立即失效。记忆：Enable是“开关”，Execute是“按钮”。知识要点表4-7（一）PLCOpen常用运动控制指令：使能·复位·状态读取数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件13PLCOpen规范的运动控制指令按功能可分为四类。第一类是“让轴做好准备、并知道轴现在怎么样了”。序号指令功能使用场合1MC_Power使能控制，用于使能或禁用运动轴启动运动任务前使能轴；任务结束或异常时禁用轴以保证安全2MC_Reset复位故障，对轴的故障状态进行复位轴因过载、超程等故障停机后，排除故障源并复位轴状态3MC_ReadStatus读取轴状态信息（是否使能、是否运动中等）程序中需要根据轴的状态进行逻辑判断时4MC_ReadActualPosition读取运动轴的当前实际位置值实时了解轴位置信息，进行位置比较、位置反馈控制5MC_ReadActualTorque读取运动轴的实际输出力矩值了解轴的实际受力情况，保证运动系统安全稳定使用顺序先MC_Power使能，再用MC_ReadStatus判断状态；出现故障必须先MC_Reset复位后才能重新使能。知识要点表4-7（二）PLCOpen常用运动控制指令：读取与运动数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件14第二类是运动控制的核心——让轴以指定速度运行、移动到指定位置。序号指令功能使用场合6MC_ReadActualVelocity读取运动轴的当前实际运行速度速度反馈控制，对轴速度进行精确控制或监控7MC_MoveRelative相对定位，从当前位置相对移动指定距离需多次不同距离移动但不需要考虑绝对位置时8MC_MoveVelocity速度指令，使轴以指定速度持续运行输送线传动控制等需轴持续匀速运动的场景9MC_MoveAbsolute绝对定位，使轴移动到指定的绝对位置机械臂定位操作等需精确移动到特定位置的场景区别要点MC_MoveRelative走的是“相对位移”，MC_MoveAbsolute走的是“坐标系位置”——前者与当前位置有关，后者与当前在哪里无关。知识要点表4-7（三）PLCOpen常用运动控制指令：点动·回零·停止数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件15第三类用于手动调试与安全停机——设备能不能安全停下来，比能不能跑起来更重要。序号指令功能使用场合10MC_Jog点动运动，以点动方式运动设备调试、手动操作等场景11MC_Home原点回归，将轴回归到预设的机械原点位置消除累计误差，确保后续定位的基准一致性12MC_Stop停止指令，强制停止轴的所有运动紧急停机、设备故障或需要立即停止轴的场合。不可被其他运动指令中断。13MC_Halt暂停指令，暂停轴的当前运动临时暂停轴运动（如人工干预检查），后续需继续运行的情况易混辨析MC_Stop是“强制停止、不可被其它运动指令中断”，用于紧急与故障场合；MC_Halt是“暂停”，之后还可以继续运行。知识要点13条指令的分类速记数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件16使能与复位（2条）MC_Power使能/禁用轴MC_Reset复位轴故障状态读取（4条）MC_ReadStatus读轴状态MC_ReadActualPosition读位置MC_ReadActualTorque读力矩MC_ReadActualVelocity读速度运动控制（5条）MC_MoveRelative相对定位MC_MoveVelocity速度指令MC_MoveAbsolute绝对定位MC_Jog点动MC_Home原点回归停止与暂停（2条）MC_Stop强制停止（不可中断）MC_Halt暂停（可继续）编程心法先使能、再判态、后运动、能停下。任何一段运动程序，都应当能回答四个问题：轴使能了吗？状态正常吗？要去哪里？怎么安全停下来？记忆2+4+5+2=13：使能复位2条、状态读取4条、运动控制5条、停止暂停2条。4.3.2PLC控制步进电机与伺服电机控制本质·点位控制三件套·工程实践要点控制本质→回原点→绝对定位→相对定位→工程要点机电系统控制原理及应用·数字教材配套授课课件知识要点PLC如何控制步进电机与伺服电机数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件18控制本质对步进电机或伺服电机的控制，实际上是通过编写程序控制数字量IO的输出。得益于伺服接口的规范化发展，无论是嵌入式系统开发、工控机与运动板卡的结合开发，还是PLC开发，都已经针对运动控制领域开发出了相应的库函数或指令集。启动/停止用MC_Power使能、MC_Stop/MC_Halt停止正反转由位置/速度指令的目标值正负号，或脉冲方向信号决定加减速通过指令中的加减速参数设置，或配置梯形/S型曲线点位控制用MC_Home、MC_MoveAbsolute、MC_MoveRelative组合实现与4.1/4.2的呼应通过PLCOpen标准指令（如MC_MoveRelative、MC_MoveAbsolute、MC_Home等），PLC可以方便地实现步进电机和伺服电机的启动、停止、正反转、加减速以及点位控制——而底层接口正是4.1讲的脉冲+方向、4.2讲的位置模式接线。结论上层用标准指令描述“要做什么”，下层由驱动器与电机完成“怎么做”——层次分明、各司其职。知识要点点位控制三件套数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件19MC_Home回原点使用MC_Home指令将轴回归到机械原点位置，消除累积误差，确保后续定位的基准一致性。MC_MoveAbsolute绝对定位使用MC_MoveAbsolute指令使轴精确移动到指定的绝对位置，适用于需要精确位置控制的场景。MC_MoveRelative相对定位使用MC_MoveRelative指令使轴从当前位置相对移动指定的距离，适用于多次不同距离移动的场景。三者的关系上电后先回原点，建立坐标系基准；随后所有绝对定位都以该原点为参照。相对定位不关心原点在哪里，只关心“从现在这里再走多少”——因此适合连续多次不同距离的动作，但也容易因为丢步或误差而逐渐偏移。编程顺序建议使能（MC_Power）→回原点（MC_Home）→绝对定位（MC_MoveAbsolute）→必要时用相对定位（MC_MoveRelative）做微调。记忆MC_Home定基准，MC_MoveAbsolute走坐标，MC_MoveRelative走位移。编程要点工程实践要点：让轴走得准、停得稳数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件20教材原文要点实际应用中，需要结合具体的工艺要求，设置合理的加减速曲线（梯形或S型）、运动速度和目标位置，并根据编码器反馈进行闭环调整，以确保系统的定位精度和运动平稳性。加减速曲线梯形曲线实现简单，S型曲线冲击更小；高速启停必须设置曲线。运动速度与目标位置速度受机械与电机能力限制；目标位置要在行程范围内，并预留限位保护。编码器反馈闭环用MC_ReadActualPosition等指令读取实际值，与指令值比较；偏差过大即报警停机。安全兜底急停回路、限位开关、使能信号必须独立于程序逻辑有效——程序可能出错，硬件保护不能出错。一句话运动程序写得好不好，看的是“异常时能不能安全停下来”。第4章本章小结与复习本章小结·核心结论·易混辨析·关键数字·调试自检本章小结→核心结论→易混辨析→关键数字→自检清单机电系统控制原理及应用·数字教材配套授课课件课堂小结第4章本章小结数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件22①伺服系统的本质闭环反馈+实时通信+运动算法的三元协同；精度已从微米级推进到纳米级。②步进电机基础电脉冲→角位移；反应式/永磁式/混合式；两相混合式占97%以上，基本步距角1.8°；开环即可高精度且不产生累积误差。③步进驱动与控制需专用驱动器；控制方式分脉冲式与总线式；256细分等效0.007°；电流与细分由拨码开关设定。④交流永磁同步伺服由定子、转子、位置/速度传感器、伺服驱动器四部分组成；FOC通过Clark与Park变换实现转矩与磁场的解耦控制。⑤三闭环与三种模式由内到外为电流环（转矩环）、速度环、位置环，遵循“由内到外、逐环整定”；对应转矩/速度/位置三种模式；刚性（0~41）是关键参数。⑥驱动器与接线功能分整流、控制、逆变三大部分；电气接线分强电线、控制线、通讯线、编码器线四类。⑦参数设置与调试汇川SV630A参数分20组；最基础参数为控制模式（H02.00）、指令脉冲方式（H05.xx）、电子齿轮比、刚性（H09.01）与惯量比；面板与InoDriverShop两种方法。⑧IEC61131-3与PLCOpen国际PLC编程语言标准+事实上的运动控制标准；13条核心指令（MC_Power、MC_MoveAbsolute、MC_MoveRelative、MC_Home、MC_Stop等）。第4章知识链伺服本质→步进电机→步进驱动与细分→交流永磁同步伺服→FOC→三闭环→驱动器与参数→PLC运动控制编程课堂小结第4章核心结论与易混辨析数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件23核心结论伺服本质闭环反馈+实时通信+运动算法的三元协同步进定位开环即可、不累积误差、成本低，适中小功率场合伺服定位闭环三环嵌套、高响应高精度，适高速高动态场合FOC价值让交流电机获得媲美直流电机的转矩控制性能易混辨析步进vs伺服开环·低速大转矩·无累积误差/闭环·高速高精度·可过载步距角vs细分1.8°是固有步距角，0.007°是256细分后的等效分辨率三环顺序电流环最内、速度环居中、位置环最外，不可颠倒整定刚性vs惯量比刚性决定响应快慢与是否振荡/惯量比决定负载匹配程度绝对vs相对MC_MoveAbsolute走坐标位置/MC_MoveRelative走相对位移两条主线一条是“电机与驱动”：从步进电机到交流永磁同步伺服，从开环脉冲到FOC三闭环；另一条是“接口与编程”：脉冲+方向→位置模式接线→PLCOpen标准指令。学习闭环会算步距角、会看矩频曲线、会说清FOC与三闭环、会用MC指令做点位控制——四条都能做到，本章才算学通。下一章：第5章液压与气动控制技术。课堂小结第4章关键数字与调试自检数字教材第4章·4.3IEC61131-3与PLCOpen运动控制编程配套授课课件241.8°两相混合式步进电机基本步距角（200步/转）256细分等效步距角0.007°3环电流环→速度环→位置环0~41刚性设定范围，越大响应越快、越易振荡13条PLCOpen核心运动控制指令20组汇川SV630A参数分组