做运动控制调试这几年我越来越觉得速度控制比位置控制更容易让人栽跟头。位置控制出错最多是定位精度差、起点偏移速度控制一旦没做好轻则机械抖动重则直接把减速机打坏。今天想聊的 MC_ProgramSpeedMotor1 正是速度控制中的一个标准功能块不少国产PLC和基于CODESYS内核的控制器里都有它的身影名字可能略有差异但逻辑脉络一脉相承。这篇文章我会从原理讲到现场实操从参数含义讲到故障排查把速度行为这条链路完整梳理一遍。1. 项目背景为什么速度控制要单独做成一个功能块1.1 位置指令解决不了的速度连续问题先说一个容易混淆的点很多人觉得轴转得快慢不就是一个速度给定信号的事吗伺服驱动器上也有速度模式直接在驱动器里给个模拟量或者通讯给定值就行为什么还要跑到PLC里用 MC_ProgramSpeedMotor1 这种功能块来做原因在于“连续”两个字。你用驱动器自身的速度模式确实可以设定一个转速但这个过程是开环的——PLC不知道轴是不是真的达到了这个速度不知道在这个速度下负载发生了多大波动更不知道轴从静止到目标速度之间到底走了怎样的曲线。而运动控制里的速度行为强调的是整条状态链从当前速度过渡到目标速度中间经过多少时间、加速度大小、是否存在冲击、速度超调多少这些都要由一个统一的运动内核来规划和管理。我调过一台恒张力放卷设备张力的核心就是收卷轴速度必须跟随线速度实时变化。线速度一变收卷轴转速要马上跟着变但“马上跟着变”并不意味着越猛越好。如果加速度给得太大张力会瞬间崩紧材料被拉断如果加速度太慢材料又会松掉产生褶皱。这种场景用位置指令根本没法写因为目标不是一个精确位置而是一条随外部信号动态变化的速度曲线。MC_ProgramSpeedMotor1 这一类速度控制功能块正是为这种需求设计的。1.2 速度行为控制在整个运动控制库中的位置在PLCopenPLC编程运动控制的事实标准里运动控制指令被分成几个大类单轴运动、多轴插补、电子齿轮/凸轮、以及轴管理。单轴运动里又细分为位置控制绝对定位、相对定位、速度控制、回零、点动、停止等。MC_ProgramSpeedMotor1 属于单轴速度控制这一类在很多厂家的库实现里它的功能对应标准中的 MC_MoveVelocity连续速度运行同时可能糅合了“程序方式设定速度”的一些扩展语义。把速度控制单独做成功能块还有一个重要原因是“轴资源只有一个”。运动内核同一时刻只允许一个运动指令实际占用轴资源。你执行绝对定位时如果在同一个轴上再调用一个速度控制指令那之前的定位指令就会被中止这种互斥关系在功能块层面就已经帮你约束好了。如果你自己在PLC里写逻辑控制伺服速度经常会漏掉这种互斥处理两个指令同时抢轴最终总线报错或者电机飞车。标准功能块至少把这一层兜住了谁先执行后来的指令要么等待、要么中止前者全看你BufferMode缓冲模式怎么配。2. MC_ProgramSpeedMotor1的核心参数与执行原理2.1 输入参数到底在告诉运动内核什么很多人初用 MC_ProgramSpeedMotor1觉得参数很简单轴、使能、速度、加减速填完就完事。但真正跑起来就会发现有些参数之间的关联比想象中复杂。我常用的一组典型输入参数如下以CODESYS风格的PLCopen指令为参考参数名类型方向含义与使用要点AxisAXIS_REF输入轴引用必须先在轴配置里定义并启用ExecuteBOOL输入上升沿触发启动速度模式运行期间持续有效SpeedREAL输入目标速度单位通常为mm/s或°/s取决于轴配置AccelerationREAL输入从当前速度加速到目标速度的加速度DecelerationREAL输入从目标速度减速到停止或新速度的减速度JerkREAL输入加加速度用于S型曲线平滑过渡可选Direction枚举输入运行方向可指定正转/反转BufferMode枚举输入缓冲模式多个运动指令排队时的处理逻辑这里最关键的是 Execute 与使能信号之间的关系。位置定位指令一般用 Execute 的上升沿触发一次运动完成以后 execute 信号不需要继续保持。但速度控制指令本质上是“无终点”的运动你让它一直跑它就一直跑直到被停止、被新的指令中止或者驱动器报警。所以 Execute 在速度控制里更像一个“运行保持标志”。如果程序里把 Execute 做成一个脉冲信号那轴可能刚起步就停了看起来像指令完全没响应这是新手最容易踩的坑。2.2 加速度、减速度、加加速度三个参数决定曲线形态速度行为的核心就看曲线形态。理想情况下速度阶跃最好但机械系统受不了。真正执行时运动内核会按照设定的加速度把速度从初始值斜坡变化到目标值。加速度决定了电机的驱动力矩增长速度和系统达到目标速度的时间。加速度越大速度上升越快但需要的电机峰值扭矩越大。加速度的计算公式很直白T J × a × 效率系数 摩擦负载T是电机扭矩J是折算到电机轴的总惯量a是角加速度。不考虑负载就算加速度最后伺服会直接报过载或者转矩限幅。减速度这个参数常被人忽视实际上它比加速度更容易出问题。加速度不够顶多启动慢减速度太大相当于运动过程中急刹车惯量负载的冲击力全部作用在传动齿轮和联轴器上。我见过有现场为了赶节拍把减速度拉到驱动器的极限值结果联轴器扭断就是没算负载惯量。加加速度加加速度是加速度的变化率。如果不限制加加速度速度曲线是梯形波在拐点处加速度突变机械上表现为明显冲击。加上加加速度限制后曲线变成S型冲击显著降低特别适合精密定位和载物输送。大部分国产运动控制内核支持S型曲线只是需要你主动配置。要理解加速度和加加速度的关系可以类比开车加速度就是你踩油门的深度加加速度则是你踩油门的动作快慢。同样是把车速提到60 km/h一脚猛踹油门和缓缓踩下去乘坐体验完全不同对传动系统的冲击也完全不同。运动控制里这两个参数就是干这个的。2.3 输出状态、状态机与生命周期MC_ProgramSpeedMotor1 的输出参数不只是用来看看它们是程序中判断执行状态的重要依据。常见输出包括 Busy执行中、Active正在运行、CommandAborted被中止、Error错误、ErrorID错误码。我把状态转换关系画成一张思维模型轴空闲时Execute 为 FALSE功能块输出全部复位Execute 变为 TRUE 后功能块进入 Busy 状态此时运动内核开始规划速度曲线经过一个插补周期的准备后轴实际开始运动Active 变为 TRUE。当速度达到目标值后由于速度控制没有终点Busy 和 Active 会一直保持。直到你通过其他指令、停止功能块或者将 Execute 复位来中止运动整个状态才会退出。值得注意的是不同厂商的实现中状态定义会有细微差别。有的功能块用 Enable 信号而不是 Execute区别在于Enable 信号有效期间功能块持续控制轴速度信号无效时才按减速参数停下来Execute 则是沿触发开始运动但要靠其他方式停止。拿到一个新的运动控制库第一件事就是查手册里 MC_ProgramSpeedMotor1 的时序图确认它到底用的是电平触发还是沿触发这决定了你外围程序怎么写。3. 现场实操从轴配置到速度环参数3.1 环境和轴配置准备要在项目里用 MC_ProgramSpeedMotor1前提是轴已经被正确配置。很多人忽略这一步直接在程序里调用功能块结果 Axis 参数填了个空引用运动内核根本不知道要控制哪个驱动器。我习惯的配置流程是这样的先在PLC的轴组态里添加一个单轴设定轴的类型为伺服轴或虚拟轴。虚拟轴可以脱离硬件调试程序非常推荐在项目前期先用虚拟轴把功能块的所有逻辑跑通。再设置单位换算位置单位用mm还是脉冲速度单位用mm/s还是RPM。单位混乱是现场问题高发区比如上位机写了个Speed300本意是300 mm/s结果轴按300 pulse/s跑差了十几倍。还有一个容易被忽略的配置项是轴限位。包括软件限位、速度限值、加速度限值。速度控制模式下轴没有位置目标但软件限位依然会被检查。如果你的轴在无限旋转的设备上比如绞盘必须把限位逻辑配置成“无限模式”否则轴运行到某个位置就会被系统强制停止看起来就像速度指令突然失效了。3.2 编写一条能跑的速度控制指令下面是一段典型的结构化文本实现基于CODESYS风格的函数块调用。我用的是真实项目中常写的结构包含轴使能、速度控制、错误复位三个动作。PROGRAM MC_Test VAR Axis1 : AXIS_REF; PowerAxis : MC_Power; SpeedRun : MC_ProgramSpeedMotor1; StopAxis : MC_Stop; bPowerEnable : BOOL; bRunCmd : BOOL; bStopCmd : BOOL; rTargetSpeed : REAL : 500.0; // 目标速度单位 mm/s rAcc : REAL : 1000.0; // 加速度 rDec : REAL : 1000.0; // 减速度 rJerkVal : REAL : 5000.0; // 加加速度 bReset : BOOL; END_VAR// 轴使能速度控制的前提 PowerAxis( Axis : Axis1, Enable : bPowerEnable, bRegulatorOn : bPowerEnable, bDriveStart : TRUE ); // 速度控制调用 SpeedRun( Axis : Axis1, Execute : bRunCmd, Speed : rTargetSpeed, Acceleration : rAcc, Deceleration : rDec, Jerk : rJerkVal ); // 停止逻辑 StopAxis( Axis : Axis1, Execute : bStopCmd, Deceleration : rDec ); // 错误复位 IF bReset THEN bReset : FALSE; SpeedRun.Error : FALSE; END_IF;这段程序里有一个实际项目中必须养成的习惯把Execute信号用一个布尔变量控制而不是直接给TRUE常量。如果你直接在功能块输入上写TRUE一旦程序每次扫描周期都触发上升沿MC_ProgramSpeedMotor1 会反复重启速度曲线永远走不完。3.3 一个具体的负载计算实例参数不能拍脑袋填我拿一个真实算例来说明。假设现场一台输送皮带电机是1.5 kW伺服电机额定转速1500 rpm经过减速比10:1带动直径200 mm的主动辊筒。首先算线速度。电机1500 rpm减速后辊筒转速为150 rpm即2.5 rps。辊筒周长等于 π × 0.2 ≈ 0.628 m所以最大线速度 2.5 × 0.628 ≈ 1.57 m/s。项目要求输送带在2秒内从静止加速到最大线速度。加速度的计算1.57 m/s ÷ 2 s ≈ 0.785 m/s²折算到角加速度按辊筒半径0.1m计算角加速度α ≈ 7.85 rad/s²。再折算到电机侧因为减速比是10电机侧角加速度 7.85 × 10 78.5 rad/s²。如果负载惯量折算到电机轴是0.005 kg·m²加速需要的扭矩 J × α 0.005 × 78.5 ≈ 0.39 N·m再叠加皮带本身的摩擦负载假设摩擦折算扭矩为0.2 N·m总需求扭矩约0.59 N·m。额定扭矩一般在减速比10后有很大裕量所以这个加速度参数是安全的。这个计算看着繁琐但如果不做这一步直接填个很大的加速度伺服一跑就报过载。参数不是越大越好是要匹配负载能力。4. 调试实录与常见问题排查4.1 故障现象与排查对照表我整理了这些年调试速度控制指令时遇到频率最高的几类问题对照表如下基本覆盖了 MC_ProgramSpeedMotor1 在项目里的主要坑点故障现象可能原因排查方法Execute给TRUE后轴没反应轴未使能、Execute是脉冲而非保持、轴配置出错先查MC_Power输出用虚拟轴试监控Busy状态轴运行到某位置自动停软限位触发、驱动器报警查看系统限位状态检查驱动器报警码速度上升特别慢加速度设置过小、负载过大转矩饱和、加加速度未配置强制给定一个更大加速度对比看伺服实际转矩输出速度波动明显运动控制任务周期过长、驱动器刚性低、滤波参数不当把功能块放到快速任务如1-2ms周期运行调伺服增益报Error且ErrorID指向配置错误轴引用无效、单位配置错误、参数超出允许范围用调试工具查看轴的在线状态和限值参数电气停止后无法再次启动Execute未复位、错误未清除、轴仍处于ErrorStop状态执行错误复位确认轴回到Standstill再触发运行每个问题背后都有可展开的细节。比如“轴没反应”十有八九是Execute的触发方式写错了。速度控制指令本质上是电平型触发你得把按钮信号做成一个自保持输出而不是像按钮本身的瞬时信号那样一个扫描周期就消失。4.2 几个现场容易踩的坑踩坑一没有建立互斥管理。MC_ProgramSpeedMotor1 虽然本身会处理轴占用但你程序里如果还写了 MC_MoveAbsolute 或 MC_Stop多个指令的Execute标志必须互锁。一个真实的教训我见过同事用同一个按钮既触发启动功能块又触发停止功能块结果两个上升沿在同一周期内到达功能块一个刚启动一个就中止轴根本不动。正确做法是做一个运行状态标志位启动时复位停止命令停止时复位启动命令。踩坑二加减速参数用了同一个值。很多新手图省事把 Acceleration 和 Deceleration 填相同数值。现场很多工艺对加、减速要求并不一样比如收卷设备加速要平缓防拉断减速却希望果断防止堆积同一数值会导致要么加速太猛要么减速太慢。踩坑三在中断程序里调用运动控制功能块。有些PLC允许在高速中断OB里调用普通功能块但运动控制指令需要访问运动内核的上下文中断里调用容易造成数据不一致或者周期错乱。正确做法是在主任务或独立运动任务里调用中断里只置标志位。踩坑四驱动器的速度指令滤波与功能块参数互相“打架”。如果PLC侧的加加速度已经做了S型平滑但驱动器自身的速度滤波也设得很大整个系统响应会慢半拍表现为速度跟随滞后。我在调试时会把驱动器的速度指令低通滤波时间调小让PLC运动内核做规划驱动器只负责执行。踩坑五不监控CommandAborted输出。速度控制运行中一旦触发急停、限位或另一个运动指令功能块会中止退出。如果程序里只管发指令不停看状态设备看起来像“自动停了”又没报Error非常难排查。所以我的习惯是只要功能块在运行每隔一个扫描周期就把CommandAborted和Busy送到HMI报警界面现场操作员能直接看到是哪条指令被中止了。最后再分享一个小技巧调试速度行为时别只盯着速度值本身要在伺服驱动器或者PLC的现场总线诊断面板上同时看“实际转速”和“转矩输出”。速度控制的问题很多时候不是速度环的问题而是负载波动导致的速度调整过程出了问题。把这两个参数历史曲线拉在一起分析比单纯看程序逻辑快得多。我是把这个习惯坚持了几年处理现场抖动的效率明显比同行要高一截。