简介面向自动化工程师的运动控制工程资料聚焦倍福PLC内置PID算法对科尔摩根DDR伺服电机转矩的闭环控制适用于EtherCAT总线的伺服调试与工业自动化项目尤其适合需要降低开环转矩控制稳态误差的研发人员。资源包共1个docx文档大小5.17MB内容包括驱动器EtherCAT组网、PDO报文配置、驱动模式参数设置、转矩控制功能块用法并对比例、比例微分、比例积分微分三种控制策略做了对比分析比例、积分、微分增益整定对系统响应的影响。文档给出最终优化后的PID控制程序涵盖误差限幅、积分分离、微分先行、输出饱和等工程处理提供20牛米负载转矩、正负0.5牛米精度的闭环方案并说明利用扭矩传感器实时反馈构成闭环的思路。已有34人学习适合1至3年经验的电气传动或自动化研发工程师结合TwinCAT与WorkBench实操验证。 做运动控制这行的工程师早晚会遇到这么一类需求位置和速度都已经调得很顺了工艺却总是跟你较劲——卷绕要恒定张力压装要限力保护疲劳测试台要精确施加扭矩载荷机器人关节要柔顺拖动。这时候你会发现光靠位置环加个电流限幅根本不够负载一变实际力矩就跟着飘。这个项目就是把我手里最常用的一套组合用在了刀刃上倍福PLC做实时运算PID算法做闭环核心科尔摩根DDR伺服电机作为执行机构在负载端实现高精度的转矩控制闭环调控。简单说这套方案要解决的是“让电机输出力矩严格跟随目标值”的问题不管负载怎么波动、摩擦怎么变、温度怎么漂最终作用在负载上的扭矩都能稳稳落在设定区间。适合做运动控制系统集成、非标自动化设备、测试台架、液压伺服替代方案的工程师参考也适合刚接触TwinCAT又想上手扭矩环控制的朋友。下面我把原理、选型、代码、整定流程和踩过的坑一次说清楚。1. 项目在做什么先把“转矩闭环”这件事讲透1.1 为什么非得在负载端做扭矩闭环普通伺服系统里其实已经有“力矩”这个概念——驱动器内部的电流环就是最内层的力矩环。那为什么还要在负载端再做一个扭矩闭环答案是驱动器输出的电磁力矩和负载实际感受到的力矩根本不是一回事。中间隔着机械传动链。如果用的是传统伺服电机加减速机齿轮啮合会有回程间隙同步带会有弹性变形联轴器有扭转刚度这些都会让输出力矩在传递过程中被“吃掉”一部分或者滞后一拍。项目里用的DDR直驱电机虽然省掉了减速机构但负载本身的摩擦力矩、安装偏心带来的周期扰动、电机齿槽转矩依然会让负载端的实际扭矩偏离指令值。所以当工艺要求在负载端实现“力矩精度”时就必须有一个外部传感器直接测量负载扭矩把这个信号送回控制器形成一个更外层的闭环。这个环就是项目标题里说的“负载扭矩闭环”它不一定取代驱动器电流环而是在电流环之上再叠一层校正让最终输出更精确。1.2 为什么是这个组合倍福PLC PID DDR先分开说这个组合里每个角色的定位。倍福PLC不是传统意义上那种只能跑梯形图的PLC它本质上是基于TwinCAT实时内核的工业控制器可以把Windows系统升级成实时控制系统。这意味着除了做逻辑控制它还能干运动控制、数据采集、甚至跑自定义算法而且编程用类似高级语言的ST语言写PID这种控制算法比传统PLC平台舒服得多。科尔摩根DDR伺服电机核心价值就是“直驱”。转子直接和负载连接没有减速机构所以不存在背隙扭转刚度高响应快非常适合作高精度力矩输出。配合科尔摩根AKD驱动器支持EtherCAT总线可以轻松和倍福系统对接。PID算法是全球工业自动化的“万金油”在这套系统里是控制回路的运算核心。它接收“目标扭矩”和“实际扭矩反馈”的偏差计算出一个修正量叠加到驱动器的转矩指令上。选它不是因为高级而是因为靠谱、好调试、可解释性强在PLC里也跑得动。一句话概括这个组合的选型逻辑DDR解决“执行精度”的问题PLC解决“计算和集成”的问题PID解决“闭环校正”的问题。2. 系统架构与核心硬件选型2.1 控制环路的层级划分整个系统从外到内分四层控制环路这个架构在项目开始前一定要想清楚因为它决定了每个环节的带宽和周期分配。最外层是负载扭矩闭环由倍福PLC实现。它通过扭矩传感器读取负载端的实际扭矩值和目标扭矩比较偏差进入PID运算输出一个“转矩修正量”。这个环的控制周期我一般设置在1ms到2ms之间。中间是驱动器内部的电流环由AKD驱动器自己完成周期通常在62.5微秒到125微秒。它保证电机绕组电流能快速跟随指令是整个系统中最快的内环。速度环在这套方案里可以不用或者只在特定模式下使用。因为转矩控制模式下速度环是打开的直接由外部扭矩环给出扭矩指令。还有一层是机械层包括联轴器、扭矩传感器、负载本身。这层虽然不参与计算但它的谐振频率直接决定了外层闭环能调到多快。如果机械安装刚性不足扭矩环带宽就不敢拉太高否则会激起机械谐振。2.2 EtherCAT总线与TwinCAT的实时通信链路本项目的核心通信链路是倍福PLC通过EtherCAT总线与科尔摩根AKD驱动器、模拟量采集模块连接。EtherCAT的优势是“分布式时钟”同步各从站设备可以保持在纳秒级的时间同步精度。对于扭矩环来说这非常关键——驱动器的电流环反馈和扭矩传感器的采样值必须在同一个时间坐标系内否则控制算法读到的是“错位”的数据环路就会产生额外相位滞后。TwinCAT的实时任务配置里我习惯把扭矩环PID放在一个独立的循环任务中优先级比普通PLC逻辑更高。任务周期设1msEtherCAT的同步周期也配成1ms。这样PID任务和总线数据刷新严格对齐调试时好排查问题。2.3 扭矩传感器与DDR电机选型的几个关键点扭矩传感器选型有三个核心指标量程、精度、安装轴向刚度。量程要留余量。我习惯取最大负载扭矩的1.5到2倍。比如工艺最大需要20牛米那就选30牛米量程的传感器留出过载空间同时保证传感器工作在较好的线性区间。精度指标要看是“满量程精度”还是“读数精度”。如果扭矩范围变化大读数精度高的传感器更合适。一般选择综合精度在正负0.1%到0.3%满量程之间的即可满足大部分工业场合。DDR电机的选型则主要是看连续转矩和峰值转矩。连续转矩要能覆盖工艺的持续负载峰值转矩要能覆盖频繁加减速或冲击工况。选型时还要核算电机转子的惯量和负载惯量比值控制在一个合理的范围否则机械动态响应会受影响。3. PID算法在转矩环里的实现细节3.1 控制周期和带宽的关系转矩环的控制周期不是随便定的它决定了整个回路的带宽上限。采样-控制的循环频率至少要达到期望闭环带宽的10倍以上才能获得足够的相位裕度。举个例子如果期望扭矩环闭环带宽达到50Hz那控制周期至少要做到2ms实际上我会做到1ms甚至更短。如果TwinCAT的任务周期只能跑到5ms那这个环的带宽极限也就在20Hz上下负载稍微有点扰动输出就会跟着波动。所以说硬件实时性能、总线周期、控制周期、期望带宽这个链条在设计阶段就要估算清楚不能等调试时才发现计算速度跟不上。3.2 位置式PID加前馈的实现方案在TwinCAT里我通常用ST语言写PID功能块采用位置式PID结构同时加入前馈项和输出限幅。相比增量式PID位置式的积分项直观、方便做抗积分饱和处理转矩这种慢变物理量完全适用。功能块的关键输入有目标扭矩、实际扭矩、三增益、采样周期、输出限幅。核心运算逻辑是偏差等于目标减实际比例项等于Kp乘偏差积分项等于Ki乘累积偏差与采样周期的乘积微分项等于Kd乘偏差变化率与采样周期之商前馈项等于Kff乘目标扭矩最终输出是四项之和并做限幅。这样一个功能块可以在多个轴里面重复调用也可以在TwinCAT里面直接用PID_para库但我更习惯自己写因为可以对积分处理这块做更细致的控制。3.3 抗积分饱和是转矩环的命门扭矩环最容易出问题的就是积分饱和。启动瞬间目标扭矩还没建立起来偏差很大积分项快速累积等到实际扭矩跟上目标时积分项已经“冲过头”了输出继续维持高位导致超调甚至震荡。所以积分项一定要限幅。我给积分项单独设置一个限幅值这个限幅要比输出限幅小通常是输出限幅的50%到80%。更常用的做法是积分分离——偏差大于某个阈值时积分项不累计等偏差小到一定程度再重新启用积分。此外还有对PID输出的限幅要结合驱动器的转矩指令范围设置。比如驱动器给定转矩指令限制在正负100%额定转矩PID输出就不应该超过这个范围否则驱动器侧的扭矩指令会卡在限幅上环路的校正效果被削弱。4. 实操全流程接线、配置、整定、联调4.1 硬件连接和EtherCAT拓扑配置第一步是硬件连接。倍福PLC通过EtherCAT网口连接AKD驱动器扭矩传感器信号根据输出类型接入相应的模拟量输入模块或EtherCAT测量模块。如果传感器输出的是正负10V模拟信号选一个分辨率足够高的模拟量输入模块推荐16位以上不然信号量化误差会直接影响扭矩控制精度。第二步是在TwinCAT中扫描EtherCAT从站。AKD驱动器被识别后会加载对应的XML设备描述文件。确认拓扑无误后把TwinCAT系统切换到配置模式激活配置让PDO映射生效。需要注意AKD驱动器的EtherCAT从站地址和IP地址不能混淆EtherCAT从站地址通过驱动器上的拨码或软件设置确保系统里地址唯一。4.2 科尔摩根AKD驱动器的转矩模式配置AKD驱动器上电后用Workbench软件连接把控制模式设为“转矩模式”同时设置转矩指令来源为EtherCAT总线。转矩指令的映射对象一般是目标转矩或百分比转矩具体取决于固件版本。这个环节有个细节容易踩坑AKD的转矩指令单位。有的固件里转矩指令默认是额定转矩的百分比单位是千分之一有的则直接用毫牛米或安培。如果不确认单位在PLC侧算出来的输出直接下发实际扭矩可能和预期差几十倍。我的经验是先发一个小的固定转矩指令比如额定转矩的5%用扭矩传感器实测对比确认单位换算系数。驱动器内部还有电流环增益、速度环限幅等参数在转矩模式下速度环处于打开状态但一定要设置速度限制防止负载突然失载时电机飞车。这个保护必须加。4.3 扭矩传感器的标定和信号处理扭矩传感器在安装前要做标定。标定的思路是给传感器施加已知的扭矩记录输出信号值建立信号与扭矩的线性关系。工业扭矩传感器出厂时有标定报告但安装之后的零点可能发生偏移所以现场需要做一次零点和增益校准。信号处理方面模拟量扭矩信号的噪声不可忽视。我会在TwinCAT里加一个一阶低通滤波器截止频率根据实际噪声特征调整。注意滤波器不是越低越好相位滞后会吃掉环路裕量通常我取闭环带宽的3到5倍作为滤波截止频率。4.4 PID参数整定的完整过程整定顺序有讲究我通常按先比例、后积分、再加前馈的顺序来。第一步关闭积分和前馈把微分也关掉比例增益给一个偏小的初值让系统手动运行在一个恒定目标扭矩下。观察实际扭矩响应如果稳态偏差很大慢慢加大Kp。加Kp的同时注意听电机声音、感受振动一旦出现共振或抖动就回退一点。第二步加入积分项。Ki从很小开始一边加一边观察稳态偏差消除的时间和超调量。目标是在实际扭矩接近目标扭矩时能快速稳住且没有明显超调。这一步可以用阶跃测试验证给目标扭矩一个台阶跳变记录实际扭矩的阶跃响应曲线。第三步加前馈。前馈的目的是让PID在稳态时“少干活”主要靠前馈项直接建立起基础输出PID只负责校正残余偏差。前馈系数稳定时可以接近1但如果负载特性非线性明显这个系数需要通过实测拟合。最后整定完毕后保存参数学到TwinCAT的配置里并且在现场跑一遍全工况的力矩变化曲线确认无超调、无振荡、无积分饱和现象才算真正收尾。5. 常见问题与排查技巧实录5.1 扭矩信号噪声大导致系统颤抖这是最容易遇到的问题。扭矩传感器安装在电机和负载之间电机运行时的机械振动、电磁干扰都可能叠加到传感器信号上反馈噪声进入PID后会被比例项放大表现为系统高频颤抖。排查思路是先确认噪声来源。断开PID输出直接在PLC里记录扭矩反馈信号观察原始波形的噪声幅度。如果是电磁干扰检查屏蔽接地如果是机械振动改善传感器安装刚度或调整滤波器。使用低通滤波能够缓解但不能一味增加滤波要密切观察相位滞后对系统的影响。5.2 方向接反闭环推成开环设备初次上电测试时发现实际扭矩和目标扭矩背道而驰偏差越来越大这就是反馈极性接反了。解决方法是检查扭矩传感器信号正负方向与电机旋转方向之间的对应关系必要时在PLC侧把反馈值取反。我习惯在调试前用一个小经验技巧先用手或外力转动电机轴观察扭矩反馈值的变化方向然后确认PID输出方向与物理受力方向一致。这一步验证只需要一分钟但能避免后续试错带来的各种风险。5.3 积分饱和引起的启动超调启动瞬间目标扭矩突变积分项疯狂累积实际扭矩冲过头再拉回来形成明显的超调甚至振荡。这个问题的根源就是前面说的积分处理不到位。解决办法是采用积分分离或积分限幅。我在项目中两种方法都试过积分限幅实现简单效果可靠积分分离逻辑稍复杂但在大偏差工况下响应更好。对于转矩控制这种大阶跃常见的场景我建议两者结合从工程上更稳妥。5.4 总线周期限制了控制性能有时候算法、参数都没问题但扭矩环响应总是慢半拍。排查时会发现EtherCAT同步周期被设成了4毫秒甚至8毫秒与PLC任务周期不匹配或者PLC任务的优先级分配不合理导致控制周期不稳定。TwinCAT的任务配置里可以把扭矩环PID放到一个独立任务中优先级高于其他非实时任务周期设置为与EtherCAT同步周期一致。若需要提高性能还可以把同步周期改为250微秒或500微秒但需要检查驱动器从站是否支持。项目做完之后我的体会是扭矩闭环这套东西难点不完全在算法而在整个链条的配合——机械安装的刚性、传感器的精度、总线的实时性、驱动器的响应、控制器的算力每一样都要在同一水平线上任何一块短板都会直接反映到扭矩控制品质上。另外调试时千万别心急一步一步来每次只改一个参数记录好数据再调整比反复试错要高效得多。本文还有配套的精品资源点击获取