1. 项目概述为什么CIA402模式是EtherCAT运动控制的“普通话”你手头刚拿到一台汇川IS620P伺服驱动器接上EtherCAT主站后调试软件里跳出三个选项CSP、CSV、CST——不是选错菜单而是你正站在EtherCAT运动控制最核心的十字路口。这三个缩写背后不是简单的功能开关而是一套由CAN in AutomationCIA组织定义的、被全球主流伺服厂商倍福、汇川、台达、安川、松下共同遵守的设备行为规范即CIA402标准。它就像工业自动化领域的“普通话”让不同厂家的主站和从站能真正听懂彼此在说什么、怎么动、动到哪里。很多人卡在第一步连基本模式都选不对后续的电子齿轮比设置、位置环参数整定、多轴同步逻辑全都是空中楼阁。我见过太多工程师在汇川EtherCAT总线配置界面反复折腾把CSP当成CSV用结果电机抖得像筛糠也见过产线停机两小时就因为主站程序里误把CST模式下的速度指令当成了CSP的位置指令发出去。这根本不是软件bug而是对CIA402底层逻辑的误解。CSPCycle Synchronous Position、CSVCycle Synchronous Velocity、CSTCycle Synchronous Torque这三个模式本质是定义了“主站每周期给从站下达什么类型的控制指令”以及“从站如何响应并反馈”。选错模式等于给司机一张错误的导航地图目的地目标值没错但指令类型是告诉司机“开到A点”还是“以60码匀速前进”还是“油门踩到30%”完全错位。本文不讲虚的协议栈分层也不堆砌ISO/OSI模型就聚焦一个实操者最关心的问题面对一个具体的应用场景——比如你要控制一台机械臂关节做精准定位或者让输送带保持恒定线速度又或者需要电机输出稳定制动力矩——到底该掰开揉碎地看清楚CSP、CSV、CST各自吃几碗饭它们的指令结构、数据映射、时序要求、适用边界在哪里。我会用汇川IS620P的实际寄存器地址、TwinCAT3的PDO配置截图逻辑、以及现场抓取的EtherCAT帧数据来还原真实世界里的每一个字节。2. CIA402模式的核心设计与选型逻辑2.1 CIA402不是“协议”而是“设备行为契约”很多初学者一看到“EtherCAT通信协议”第一反应就是去翻《EtherCAT Technology Group Specification》文档结果被物理层、数据链路层、应用层绕晕。这是个根本性误区。CIA402全称CANopen Device Profile for Drives and Motion Control压根就不是通信协议它是一份“设备行为契约”。你可以把它理解成一份给伺服驱动器写的“岗位说明书”它规定了驱动器这个“员工”在接到主站这个“老板”的不同指令时应该表现出什么样的标准动作、汇报什么样的工作状态、遇到问题时如何打报告。EtherCAT只是负责把这份说明书里的“指令”和“报告”高效、实时地在老板和员工之间快递传递。所以当你在汇川的配置软件里选择CSP模式时你不是在修改通信方式而是在告诉驱动器“从现在开始你的岗位职责是‘精准定位员’老板每周期给你发一个‘目标位置’你必须用内部的位置环去跟踪它并把实际位置、状态字、故障码这些信息准时交上来。”这个契约的强制力来自于驱动器固件里预置的CIA402状态机。它严格遵循“初始化→未使能→使能待命→运行”这一套状态转换流程任何一步没走对电机就绝不会转。我曾经调试一台进口直线电机主站程序一切正常但电机就是不动。最后发现是汇川驱动器的“Control Word”控制字第12位“Quick Stop”被意外置1导致状态机卡死在“Fault Reaction Active”状态。这不是通信断了而是“员工”因为收到了一条错误的“紧急停机”指令正在严格执行停机流程根本没在等你的“启动”命令。这种问题查网络抓包毫无意义必须回到CIA402的状态机图里一行行核对控制字每一位的含义。2.2 CSP、CSV、CST的本质差异指令域与控制环的绑定关系CSP、CSV、CST的差异不能只看字面意思必须落到驱动器内部的控制环结构上。所有现代伺服驱动器其核心都是一个三层嵌套的闭环控制系统最外层是位置环中间是速度环最内层是电流/转矩环。CIA402的三种模式本质上就是把主站的“指令输入点”插在了这三层环的不同入口处。CSPCycle Synchronous Position指令直接注入位置环的设定值入口。主站每周期发送的“Target Position”目标位置会作为位置环的给定值位置环计算出所需的“Target Velocity”目标速度再把这个速度值送给速度环速度环再计算出所需的“Target Torque”目标转矩最终由电流环执行。这是一个完整的、由主站发起的“位置→速度→转矩”三级指令链。它的优势是精度高、轨迹平滑适合点到点定位、电子凸轮、电子齿轮等对位置精度要求严苛的场景。但它的致命弱点是动态响应慢。因为指令要经过三层环的计算和延迟当主站突然改变目标位置时从站的实际响应会有明显滞后。我在调试一台SCARA机器人Z轴时就吃过亏主站以10ms周期下发一串阶梯式位置指令期望电机快速抬升结果由于CSP模式下位置环的积分饱和电机出现了明显的“爬行”现象抬升时间比预期长了300ms。CSVCycle Synchronous Velocity指令直接注入速度环的设定值入口。主站发送的“Target Velocity”目标速度跳过了位置环直接成为速度环的给定值。速度环计算出所需的“Target Torque”再由电流环执行。这相当于主站直接告诉驱动器“你现在应该以多快的速度跑”而不管它当前在哪儿、要去哪儿。它的优势是动态响应极快、速度控制精度高特别适合需要恒速运行如薄膜收卷、张力控制、或需要快速加减速如高速分拣的场合。但它的代价是失去了绝对位置信息。CSV模式下驱动器内部的位置环是关闭的它不维护一个全局的位置计数器。这意味着如果你在CSV模式下运行了一段时间然后想切回CSP模式进行精确定位驱动器会告诉你“我不知道我现在在哪儿我的位置计数器是0。”你必须先执行一次“回零”操作才能重新建立坐标系。这在连续生产线上是不可接受的。我们产线曾因一个误操作让一台输送带电机从CSP切到了CSV运行了8小时后想切回去结果整条线被迫停机45分钟做回零校准。CSTCycle Synchronous Torque指令直接注入电流/转矩环的设定值入口。主站发送的“Target Torque”目标转矩是最终的、最底层的控制指令。它绕过了位置环和速度环直接作用于电机的电磁力。这是响应速度最快、带宽最高的模式适用于需要精确力控的场景比如打磨、装配、阻抗控制。但它的使用门槛也最高。因为没有了外层环的“保护”主站必须自己承担起所有控制算法的责任。你需要自己编写速度规划器生成平滑的速度曲线自己实现位置环如果还需要位置信息甚至要处理电机的反电动势补偿。一个微小的转矩指令波动都会直接导致电机剧烈抖动。我第一次尝试CST模式控制一台协作机器人关节时因为没做电流环的前馈补偿电机在静止状态下就发出持续的“嗡嗡”声用示波器测母线电流纹波高达额定值的15%。后来在指令前加了一个二阶低通滤波器才把纹波压到2%以下。2.3 选型决策树从应用场景倒推模式选择选模式不是拍脑袋而是一个严谨的逆向工程过程。我给自己总结了一套三步决策法已在十几个项目中验证有效第一步明确控制目标的“物理量”是什么这是最根本的判断依据。问自己我最终要精确控制的是“位置”、“速度”还是“力/转矩”如果是“把工件送到A点、B点、C点”目标是位置→ 优先考虑CSP。如果是“让传送带始终以1.2m/s运行”目标是速度→ 优先考虑CSV。如果是“用机械臂末端施加5N的恒定压力进行抛光”目标是力/转矩→ 必须用CST。第二步评估系统对“动态响应”的容忍度。查看你的工艺节拍要求。如果一个动作的完成时间要求小于50ms且中间有频繁的启停或方向切换CSP的三层环延迟很可能成为瓶颈。这时即使你的目标是位置也要考虑“伪CSP”方案用CSV模式运行主体运动保证速度响应再用一个独立的、更高频率的比如1kHz位置环在主站侧做闭环将计算出的实时速度指令下发给从站。这相当于把位置环“上移”到了主站牺牲了部分分布式控制的简洁性换来了极致的动态性能。第三步核查硬件与软件的“支持完备性”。再好的模式如果生态不支持也是空中楼阁。重点检查三点驱动器固件版本汇川IS620P早期固件V1.0x对CST模式的支持不完善某些状态字位定义与CIA402标准不符。必须升级到V2.10以上。主站控制器能力不是所有EtherCAT主站都能稳定输出10kHz的CST指令。像一些基于STM32的轻量级主站其CPU在10kHz下处理浮点运算和EtherCAT帧打包负载率会飙到95%极易丢帧。此时强行上CST无异于自毁。调试工具链TwinCAT3对CIA402的支持最成熟其“Drive Manager”能自动识别并配置PDO映射。而一些国产PLC的EtherCAT配置工具对CSV模式下的“Velocity Demand Value”速度需求值和“Velocity Actual Value”实际速度值的单位换算rpm vs. rpm*1000常常搞错导致调试时数值显示离谱。遇到这种情况必须手动进入SDO配置绕过图形化界面。提示永远不要为了“听起来高级”而选CST。我见过一个包装机项目客户坚持要用CST控制封口辊理由是“更精准”。结果调试了两周效果还不如用CSP优化过的S形加减速曲线。CST不是万能钥匙它是为特定难题准备的特种工具。3. 核心细节解析与实操要点3.1 PDO映射让每个字节都各司其职PDOProcess Data Object是EtherCAT实时数据交换的“高速公路”。CIA402模式的切换本质上就是重新规划这条高速公路上的“货车”数据装载哪些“货物”控制指令和卸载哪些“报告”状态反馈。这个规划过程就是PDO映射。它不像IP地址那样可以随便改而是有严格的CIA402标准定义。以汇川IS620P为例其默认的CSP模式PDO映射如下地址为16进制TxPDO1从站→主站上传0x6041:00(Status Word, 状态字, 16位)0x6064:00(Position Actual Value, 实际位置, 32位)0x606C:00(Velocity Actual Value, 实际速度, 32位)0x6077:00(Torque Actual Value, 实际转矩, 16位)RxPDO1主站→从站下发0x6040:00(Control Word, 控制字, 16位)0x607A:00(Target Position, 目标位置, 32位)0x6081:00(Max Profile Velocity, 最大轮廓速度, 32位)0x6083:00(Profile Acceleration, 轮廓加速度, 32位)当你把模式切换到CSV时PDO映射必须随之改变。最关键的变动是RxPDO1中0x607A:00目标位置必须被移除替换为0x60FF:00Target Velocity, 目标速度。同时TxPDO1中0x6064:00实际位置的上报优先级通常会降低因为CSV模式下位置信息不是核心反馈。这个映射不是在驱动器上设置的而是在主站的EtherCAT配置文件.xml中定义的。TwinCAT3会自动生成符合CIA402标准的PDO映射但如果你用的是自研主站就必须严格按照《CiA 402 Annex A》文档中的“Object Dictionary”表格一个字节一个字节地去配置。我曾在一个基于LinuxIGH的主站项目中因为手动配置PDO时把0x60FF:00目标速度的长度错配成了16位应为32位导致驱动器收到的指令总是0电机纹丝不动。花了整整一天用Wireshark抓包对比标准帧格式才定位到这个字节长度的硬伤。注意PDO映射一旦确定就不能在运行时动态更改。这意味着如果你想在一台电机上同时支持CSP和CSV不能靠“软件切换模式”而必须在主站侧预定义两套PDO映射并通过“Sync Manager”在运行时切换激活哪一套。这增加了主站软件的复杂度但对于需要多模式切换的柔性产线是必要的。3.2 控制字Control Word与状态字Status Word驱动器的“语言密码本”CIA402的灵魂藏在两个16位的字里0x6040:00Control Word和0x6041:00Status Word。它们是主站和从站之间沟通的“摩斯电码”每一位都有明确的、不可篡改的语义。理解它们是读懂驱动器“心思”的唯一途径。Control Word控制字详解这是一个16位的寄存器每一位代表一个“指令”。最常用、也最容易出错的是以下几位Bit 0 (Switch On)这是“电源开关”。只有当它为1时驱动器才允许功率输出。但它不是唯一的条件。Bit 1 (Enable Voltage)这是“电压使能”。它控制着驱动器内部的IGBT驱动电路是否上电。必须先置1再置0才能安全地“吸合”主接触器。Bit 2 (Quick Stop)这是“急停”。一旦置1驱动器会立即切断电机电流进入自由停车或斜坡停车状态。关键点在于它是一个“锁存”位。即使你下一周期把它清0驱动器也不会自动恢复必须先执行一次“Clear Fault”清除故障操作状态字0x6041:00的Bit 3Fault才会变0然后才能重新走使能流程。很多调试失败根源就在这里——工程师以为清0了Quick Stop就万事大吉却忘了还有个“Fault”状态要清除。Bit 3 (Enable Operation)这是“运行使能”。只有当Bit 0、1、2都为0无故障、已使能电压、未急停且Bit 3为1时驱动器才真正进入“Ready to Switch On”状态等待你的位置/速度/转矩指令。Bit 4 (New Set Point)这是CSP/CSV/CST模式下的“指令更新触发位”。在CSP模式下你每周期更新0x607A:00目标位置后必须在下一个周期将此位置1驱动器才会读取新的目标值。如果不置位它会一直用上一个周期的旧值。这就是为什么有时你明明改了目标位置电机却纹丝不动——不是没发过去而是没“按确认键”。Status Word状态字详解它实时反映驱动器的“健康状况”和“工作状态”是诊断问题的第一手资料。Bit 0 (Ready to Switch On)表示驱动器已准备好可以接收Switch On指令。Bit 1 (Switched On)表示驱动器已上电功率单元已激活。Bit 2 (Operation Enabled)表示驱动器已进入运行状态可以响应控制指令。Bit 3 (Fault)表示驱动器发生了故障。此时Bit 0-2都会变为0驱动器停止输出。必须通过SDO写入0x6040:00的Bit 7Fault Reset来复位。Bit 10 (Target Reached)这是CSP模式下的“到位信号”。当实际位置与目标位置的误差小于设定的“Position Window”位置窗口时此位自动置1。它是实现“精确定位完成”判断的黄金标准远比在主站侧用软件比较Actual Position和Target Position更可靠、更实时。我曾用这个信号替代了PLC里一个复杂的定时器逻辑将一个装配工位的循环时间缩短了120ms。3.3 模式切换的“安全门禁”状态机与使能流程CIA402定义了一套极其严谨的状态机State Machine它像一道道“安全门禁”确保驱动器只能在满足所有前置条件的情况下才能进入下一个工作状态。这个流程与你选择的CSP/CSV/CST模式无关是所有模式都必须遵守的铁律。标准的使能流程以CSP为例如下Startup (启动)驱动器上电进入Not Ready to Switch On状态。Enable Voltage (使能电压)主站写0x6040:000x0006(Bit 1 Bit 2)驱动器进入Voltage Enabled状态。此时电机轴可自由转动。Switch On (开启)主站写0x6040:000x0007(Bit 0 Bit 1 Bit 2)驱动器进入Ready to Switch On状态。Enable Operation (使能运行)主站写0x6040:000x000F(Bit 0 Bit 1 Bit 2 Bit 3)驱动器进入Operation Enabled状态。此时驱动器才开始真正响应0x607A:00目标位置指令。关键陷阱这个流程是“单向”的且每一步都需要读取0x6041:00状态字来确认是否成功。例如在第2步写入0x0006后你必须等待至少一个周期再读取状态字确认Bit 1Switched On是否为1。如果为0说明电压使能失败可能是主回路接触器未吸合或是驱动器内部电源模块故障。绝对禁止在未确认上一步成功的情况下就贸然执行下一步。我曾在一个项目中因为主站程序里缺少这个“等待确认”的延时导致驱动器在Voltage Enabled状态还没稳定时就收到了0x000F的指令结果触发了内部保护报出了一个无法复位的0x8110Internal Error故障最终只能返厂维修。模式切换本身也是一个状态机操作。从CSP切换到CSV不是简单地改一个参数。它要求首先将驱动器置于Operation Disabled状态写0x6040:000x0006。然后通过SDO非实时通道修改对象字典中的0x6060:00Modes of Operation为0x03CSV。最后重新走一遍上述的使能流程步骤2-4。整个过程驱动器会短暂失电电机轴会自由转动。因此模式切换只能在设备停机、安全防护到位的情况下进行。4. 实操过程与核心环节实现4.1 汇川IS620P的CSP模式完整配置以TwinCAT3为例下面以一个真实的、可复现的案例带你走完从零开始配置CSP模式的全部步骤。假设你有一台汇川IS620P伺服驱动器连接在TwinCAT3主站的EtherCAT网络上目标是让电机以S形加减速曲线精准运行到100000脉冲对应1圈的位置。Step 1导入EDS文件扫描从站在TwinCAT3的“System Manager”中右键点击“Devices”选择“Scan Devices”。TwinCAT会自动扫描网络找到IS620P并显示其Vendor ID和Product Code。右键该设备选择“Add Device from EDS...”。这里必须使用汇川官方提供的、与你驱动器固件版本严格匹配的EDS文件如IS620P_V210.eds。切记用错EDS文件会导致PDO映射错误这是90%的“配置后不工作”问题的根源。我曾用V1.0x的EDS去配V2.10的驱动器结果0x6083:00加速度的单位被识别成了rpm/s而实际固件要求是rpm/s^2导致加速度指令被放大了1000倍电机启动瞬间就触发了过流保护。Step 2配置PDO映射与同步管理器展开设备节点双击“Process Data” → “PDO Assignment”。确认RxPDO1下发中包含了0x6040:00(Control Word),0x607A:00(Target Position),0x6081:00(Max Profile Velocity),0x6083:00(Profile Acceleration),0x6084:00(Profile Deceleration),0x6085:00(Quick Stop Deceleration)。确认TxPDO1上传中包含了0x6041:00(Status Word),0x6064:00(Position Actual Value),0x606C:00(Velocity Actual Value)。在“Sync Manager”中将RxPDO1分配给SM2Output Sync ManagerTxPDO1分配给SM3Input Sync Manager并设置其“Cycle Time”为2ms即500Hz。这是CSP模式的典型周期既能保证响应又不会给主站带来过大负担。Step 3配置CIA402对象字典参数在设备节点下展开“Objects” → “6000h - 6FFFh”。找到0x6060:00(Modes of Operation)双击将其值设为0x01CSP。找到0x6086:00(Motion Profile Type)设为0x01S-Curve这是实现平滑运动的关键。找到0x6087:00(Max Acceleration)根据你的电机和负载计算并填入。例如IS620P-20A驱动器带1.5kW电机最大加速度约为10000 rpm/s²换算成CIA402单位rpm/s² * 1000应填入10000000。找到0x6065:00(Position Window)设为10001000个脉冲。这是Target Reached信号的触发阈值决定了你对“到位”的精度要求。Step 4编写TwinCAT PLC控制程序// 定义驱动器接口 driveInterface : FB_EtherCAT_ServoDrive; // 主循环 driveInterface( Enable : TRUE, AxisNo : 1, ControlWord : 16#000F, // 使能运行 TargetPosition : 100000, // 目标位置单位脉冲 MaxProfileVelocity : 3000, // 最大速度单位rpm ProfileAcceleration : 10000000, // 加速度单位rpm/s² * 1000 ProfileDeceleration : 10000000 ); // 判断是否到位 IF driveInterface.StatusWord AND 16#0400 THEN // Bit 10 Target Reached // 执行下一步动作如气缸夹紧 END_IF;这段代码的核心在于ControlWord的值。16#000F是十六进制对应二进制0000 0000 0000 1111即置位了Bit 0,1,2,3完成了完整的使能流程。TargetPosition的单位是“脉冲”这与汇川驱动器的编码器分辨率直接相关。如果你的编码器是2500线那么100000脉冲就等于40圈。务必确认你的单位换算无误。4.2 CSV模式下的速度环整定实战CSV模式的威力在于其超快的速度响应。但要发挥它必须对速度环进行精细整定。这与CSP模式下的位置环整定完全不同。第一步理解CSV的“速度指令链”在CSV模式下主站下发的0x60FF:00Target Velocity是速度环的直接给定值。驱动器内部的速度环会将这个给定值与0x606C:00Velocity Actual Value实际速度进行比较计算出误差再通过PI调节器输出一个转矩指令。因此CSV模式的性能瓶颈完全取决于速度环的带宽和抗扰动能力。第二步整定前的必要准备将驱动器切换到CSV模式0x6060:000x03。断开所有机械负载空载避免惯性干扰。在TwinCAT的Scope中添加两个信号0x60FF:00目标速度和0x606C:00实际速度采样率设为10kHz。第三步经典Ziegler-Nichols临界比例度法将速度环的P增益0x60B0:00设为一个很小的值如10I增益0x60B1:00设为0。给一个阶跃速度指令如从0rpm到1000rpm观察实际速度的响应曲线。你会发现实际速度缓慢上升严重滞后。逐步增大P增益直到实际速度出现等幅振荡。记录此时的P增益值Ku和振荡周期Tu。计算整定参数P增益 0.6 * KuI时间常数 0.5 * Tu→ I增益 P增益 / I时间常数我用此方法整定一台IS620P驱动的1.5kW电机得到Ku120,Tu8ms最终P72, I18000。整定后的速度响应时间0-90%从原来的120ms缩短到了18ms完全满足了高速分拣的需求。第四步加入前馈提升动态性能纯PI调节器在应对速度指令的快速变化时仍会有相位滞后。此时必须加入速度前馈Velocity Feedforward,0x60B2:00。它的原理是在速度指令发生阶跃变化的瞬间不等PI调节器慢慢计算就直接“预测”出一个转矩增量提前加进去。0x60B2:00的值越大前馈越强。但过大会引起超调。我的经验是从0.1开始试逐步增加到0.3观察Scope中的超调量。当超调量控制在5%以内时即可认为整定完成。4.3 CST模式的力控闭环从理论到实践CST模式是真正的“硬核”领域。它要求你放弃驱动器内置的任何环自己构建一个完整的力控系统。下面是一个用CST模式实现“恒力按压”的最小可行方案。硬件与信号流主站TwinCAT3 PLC配备一个高精度力传感器如ATI的Gamma系列其模拟量输出接入PLC的AI模块。从站汇川IS620P工作在CST模式0x6060:000x04。信号流力传感器读数 → PLC AI模块 → PLC程序计算误差 → 输出0x6071:00Target Torque→ IS620P执行。PLC程序核心逻辑// 力传感器读数已标定为N forceSensorValue : REAL; // 单位牛顿 // 设定期望力 setForce : REAL : 5.0; // 5N // PI力环控制器 forceController : FB_PID; forceController( Enable : TRUE, SP : setForce, PV : forceSensorValue, Kp : 10.0, Ti : 0.1, Td : 0.0 ); // 将力环输出单位N转换为转矩指令单位0.01%额定转矩 // IS620P的额定转矩为4.77Nm100% 10000 targetTorque : INT : INT_TO_INT( (forceController.CV * 10000) / 4.77 ); // 下发转矩指令 driveInterface.TargetTorque : targetTorque;关键难点与解决方案单位换算地狱力传感器输出是伏特PLC AI模块读取的是数字量要转换成牛顿牛顿要转换成电机的转矩Nm再转换成CIA402的0x6071:00单位是0.01%额定转矩。每一步都可能引入误差。我的做法是在PLC中建立一个“标定表”用已知重量的砝码逐点测试传感器输出与实际力的关系生成一个线性拟合公式直接嵌入程序。机械谐振当电机以恒定转矩推动一个弹性体如橡胶垫时系统会形成一个机械谐振峰导致力值剧烈震荡。解决方法是在力环PID之后加入一个陷波滤波器Notch Filter中心频率设为实测的谐振频率如120Hz。TwinCAT3的FB_NotchFilter功能块可以直接调用。零漂补偿力传感器和电机本身都有零点漂移。必须在每次启动时执行一个“零点校准”程序让电机输出0转矩保持5秒记录此时的传感器读数作为后续所有测量的零点基准。5. 常见问题与排查技巧实录5.1 “电机不转”问题的黄金排查清单这是最常见、也最让人抓狂的问题。别急着怀疑硬件按这个清单一步步查90%的问题能在5分钟内定位。排查步骤检查内容工具/方法典型原因1. 看状态字读取0x6041:00看Bit 0-2是否为1TwinCAT的Online WatchBit 00电压未使能Bit 10未开启Bit 20未使能运行。2. 查控制字检查下发的0x6040:00值是否正确Scope抓取Control Word波形值为0x0006只使能了电压忘了置位Bit 0和Bit 3。3. 核PDO映射确认RxPDO1中是否包含了0x6040:00和0x607A:00TwinCAT的PDO Configuration窗口映射缺失指令根本没发到驱动器。4. 测目标值读 CIA402运动控制三模式：CSP/CSV/CST原理与选型实战
1. 项目概述为什么CIA402模式是EtherCAT运动控制的“普通话”你手头刚拿到一台汇川IS620P伺服驱动器接上EtherCAT主站后调试软件里跳出三个选项CSP、CSV、CST——不是选错菜单而是你正站在EtherCAT运动控制最核心的十字路口。这三个缩写背后不是简单的功能开关而是一套由CAN in AutomationCIA组织定义的、被全球主流伺服厂商倍福、汇川、台达、安川、松下共同遵守的设备行为规范即CIA402标准。它就像工业自动化领域的“普通话”让不同厂家的主站和从站能真正听懂彼此在说什么、怎么动、动到哪里。很多人卡在第一步连基本模式都选不对后续的电子齿轮比设置、位置环参数整定、多轴同步逻辑全都是空中楼阁。我见过太多工程师在汇川EtherCAT总线配置界面反复折腾把CSP当成CSV用结果电机抖得像筛糠也见过产线停机两小时就因为主站程序里误把CST模式下的速度指令当成了CSP的位置指令发出去。这根本不是软件bug而是对CIA402底层逻辑的误解。CSPCycle Synchronous Position、CSVCycle Synchronous Velocity、CSTCycle Synchronous Torque这三个模式本质是定义了“主站每周期给从站下达什么类型的控制指令”以及“从站如何响应并反馈”。选错模式等于给司机一张错误的导航地图目的地目标值没错但指令类型是告诉司机“开到A点”还是“以60码匀速前进”还是“油门踩到30%”完全错位。本文不讲虚的协议栈分层也不堆砌ISO/OSI模型就聚焦一个实操者最关心的问题面对一个具体的应用场景——比如你要控制一台机械臂关节做精准定位或者让输送带保持恒定线速度又或者需要电机输出稳定制动力矩——到底该掰开揉碎地看清楚CSP、CSV、CST各自吃几碗饭它们的指令结构、数据映射、时序要求、适用边界在哪里。我会用汇川IS620P的实际寄存器地址、TwinCAT3的PDO配置截图逻辑、以及现场抓取的EtherCAT帧数据来还原真实世界里的每一个字节。2. CIA402模式的核心设计与选型逻辑2.1 CIA402不是“协议”而是“设备行为契约”很多初学者一看到“EtherCAT通信协议”第一反应就是去翻《EtherCAT Technology Group Specification》文档结果被物理层、数据链路层、应用层绕晕。这是个根本性误区。CIA402全称CANopen Device Profile for Drives and Motion Control压根就不是通信协议它是一份“设备行为契约”。你可以把它理解成一份给伺服驱动器写的“岗位说明书”它规定了驱动器这个“员工”在接到主站这个“老板”的不同指令时应该表现出什么样的标准动作、汇报什么样的工作状态、遇到问题时如何打报告。EtherCAT只是负责把这份说明书里的“指令”和“报告”高效、实时地在老板和员工之间快递传递。所以当你在汇川的配置软件里选择CSP模式时你不是在修改通信方式而是在告诉驱动器“从现在开始你的岗位职责是‘精准定位员’老板每周期给你发一个‘目标位置’你必须用内部的位置环去跟踪它并把实际位置、状态字、故障码这些信息准时交上来。”这个契约的强制力来自于驱动器固件里预置的CIA402状态机。它严格遵循“初始化→未使能→使能待命→运行”这一套状态转换流程任何一步没走对电机就绝不会转。我曾经调试一台进口直线电机主站程序一切正常但电机就是不动。最后发现是汇川驱动器的“Control Word”控制字第12位“Quick Stop”被意外置1导致状态机卡死在“Fault Reaction Active”状态。这不是通信断了而是“员工”因为收到了一条错误的“紧急停机”指令正在严格执行停机流程根本没在等你的“启动”命令。这种问题查网络抓包毫无意义必须回到CIA402的状态机图里一行行核对控制字每一位的含义。2.2 CSP、CSV、CST的本质差异指令域与控制环的绑定关系CSP、CSV、CST的差异不能只看字面意思必须落到驱动器内部的控制环结构上。所有现代伺服驱动器其核心都是一个三层嵌套的闭环控制系统最外层是位置环中间是速度环最内层是电流/转矩环。CIA402的三种模式本质上就是把主站的“指令输入点”插在了这三层环的不同入口处。CSPCycle Synchronous Position指令直接注入位置环的设定值入口。主站每周期发送的“Target Position”目标位置会作为位置环的给定值位置环计算出所需的“Target Velocity”目标速度再把这个速度值送给速度环速度环再计算出所需的“Target Torque”目标转矩最终由电流环执行。这是一个完整的、由主站发起的“位置→速度→转矩”三级指令链。它的优势是精度高、轨迹平滑适合点到点定位、电子凸轮、电子齿轮等对位置精度要求严苛的场景。但它的致命弱点是动态响应慢。因为指令要经过三层环的计算和延迟当主站突然改变目标位置时从站的实际响应会有明显滞后。我在调试一台SCARA机器人Z轴时就吃过亏主站以10ms周期下发一串阶梯式位置指令期望电机快速抬升结果由于CSP模式下位置环的积分饱和电机出现了明显的“爬行”现象抬升时间比预期长了300ms。CSVCycle Synchronous Velocity指令直接注入速度环的设定值入口。主站发送的“Target Velocity”目标速度跳过了位置环直接成为速度环的给定值。速度环计算出所需的“Target Torque”再由电流环执行。这相当于主站直接告诉驱动器“你现在应该以多快的速度跑”而不管它当前在哪儿、要去哪儿。它的优势是动态响应极快、速度控制精度高特别适合需要恒速运行如薄膜收卷、张力控制、或需要快速加减速如高速分拣的场合。但它的代价是失去了绝对位置信息。CSV模式下驱动器内部的位置环是关闭的它不维护一个全局的位置计数器。这意味着如果你在CSV模式下运行了一段时间然后想切回CSP模式进行精确定位驱动器会告诉你“我不知道我现在在哪儿我的位置计数器是0。”你必须先执行一次“回零”操作才能重新建立坐标系。这在连续生产线上是不可接受的。我们产线曾因一个误操作让一台输送带电机从CSP切到了CSV运行了8小时后想切回去结果整条线被迫停机45分钟做回零校准。CSTCycle Synchronous Torque指令直接注入电流/转矩环的设定值入口。主站发送的“Target Torque”目标转矩是最终的、最底层的控制指令。它绕过了位置环和速度环直接作用于电机的电磁力。这是响应速度最快、带宽最高的模式适用于需要精确力控的场景比如打磨、装配、阻抗控制。但它的使用门槛也最高。因为没有了外层环的“保护”主站必须自己承担起所有控制算法的责任。你需要自己编写速度规划器生成平滑的速度曲线自己实现位置环如果还需要位置信息甚至要处理电机的反电动势补偿。一个微小的转矩指令波动都会直接导致电机剧烈抖动。我第一次尝试CST模式控制一台协作机器人关节时因为没做电流环的前馈补偿电机在静止状态下就发出持续的“嗡嗡”声用示波器测母线电流纹波高达额定值的15%。后来在指令前加了一个二阶低通滤波器才把纹波压到2%以下。2.3 选型决策树从应用场景倒推模式选择选模式不是拍脑袋而是一个严谨的逆向工程过程。我给自己总结了一套三步决策法已在十几个项目中验证有效第一步明确控制目标的“物理量”是什么这是最根本的判断依据。问自己我最终要精确控制的是“位置”、“速度”还是“力/转矩”如果是“把工件送到A点、B点、C点”目标是位置→ 优先考虑CSP。如果是“让传送带始终以1.2m/s运行”目标是速度→ 优先考虑CSV。如果是“用机械臂末端施加5N的恒定压力进行抛光”目标是力/转矩→ 必须用CST。第二步评估系统对“动态响应”的容忍度。查看你的工艺节拍要求。如果一个动作的完成时间要求小于50ms且中间有频繁的启停或方向切换CSP的三层环延迟很可能成为瓶颈。这时即使你的目标是位置也要考虑“伪CSP”方案用CSV模式运行主体运动保证速度响应再用一个独立的、更高频率的比如1kHz位置环在主站侧做闭环将计算出的实时速度指令下发给从站。这相当于把位置环“上移”到了主站牺牲了部分分布式控制的简洁性换来了极致的动态性能。第三步核查硬件与软件的“支持完备性”。再好的模式如果生态不支持也是空中楼阁。重点检查三点驱动器固件版本汇川IS620P早期固件V1.0x对CST模式的支持不完善某些状态字位定义与CIA402标准不符。必须升级到V2.10以上。主站控制器能力不是所有EtherCAT主站都能稳定输出10kHz的CST指令。像一些基于STM32的轻量级主站其CPU在10kHz下处理浮点运算和EtherCAT帧打包负载率会飙到95%极易丢帧。此时强行上CST无异于自毁。调试工具链TwinCAT3对CIA402的支持最成熟其“Drive Manager”能自动识别并配置PDO映射。而一些国产PLC的EtherCAT配置工具对CSV模式下的“Velocity Demand Value”速度需求值和“Velocity Actual Value”实际速度值的单位换算rpm vs. rpm*1000常常搞错导致调试时数值显示离谱。遇到这种情况必须手动进入SDO配置绕过图形化界面。提示永远不要为了“听起来高级”而选CST。我见过一个包装机项目客户坚持要用CST控制封口辊理由是“更精准”。结果调试了两周效果还不如用CSP优化过的S形加减速曲线。CST不是万能钥匙它是为特定难题准备的特种工具。3. 核心细节解析与实操要点3.1 PDO映射让每个字节都各司其职PDOProcess Data Object是EtherCAT实时数据交换的“高速公路”。CIA402模式的切换本质上就是重新规划这条高速公路上的“货车”数据装载哪些“货物”控制指令和卸载哪些“报告”状态反馈。这个规划过程就是PDO映射。它不像IP地址那样可以随便改而是有严格的CIA402标准定义。以汇川IS620P为例其默认的CSP模式PDO映射如下地址为16进制TxPDO1从站→主站上传0x6041:00(Status Word, 状态字, 16位)0x6064:00(Position Actual Value, 实际位置, 32位)0x606C:00(Velocity Actual Value, 实际速度, 32位)0x6077:00(Torque Actual Value, 实际转矩, 16位)RxPDO1主站→从站下发0x6040:00(Control Word, 控制字, 16位)0x607A:00(Target Position, 目标位置, 32位)0x6081:00(Max Profile Velocity, 最大轮廓速度, 32位)0x6083:00(Profile Acceleration, 轮廓加速度, 32位)当你把模式切换到CSV时PDO映射必须随之改变。最关键的变动是RxPDO1中0x607A:00目标位置必须被移除替换为0x60FF:00Target Velocity, 目标速度。同时TxPDO1中0x6064:00实际位置的上报优先级通常会降低因为CSV模式下位置信息不是核心反馈。这个映射不是在驱动器上设置的而是在主站的EtherCAT配置文件.xml中定义的。TwinCAT3会自动生成符合CIA402标准的PDO映射但如果你用的是自研主站就必须严格按照《CiA 402 Annex A》文档中的“Object Dictionary”表格一个字节一个字节地去配置。我曾在一个基于LinuxIGH的主站项目中因为手动配置PDO时把0x60FF:00目标速度的长度错配成了16位应为32位导致驱动器收到的指令总是0电机纹丝不动。花了整整一天用Wireshark抓包对比标准帧格式才定位到这个字节长度的硬伤。注意PDO映射一旦确定就不能在运行时动态更改。这意味着如果你想在一台电机上同时支持CSP和CSV不能靠“软件切换模式”而必须在主站侧预定义两套PDO映射并通过“Sync Manager”在运行时切换激活哪一套。这增加了主站软件的复杂度但对于需要多模式切换的柔性产线是必要的。3.2 控制字Control Word与状态字Status Word驱动器的“语言密码本”CIA402的灵魂藏在两个16位的字里0x6040:00Control Word和0x6041:00Status Word。它们是主站和从站之间沟通的“摩斯电码”每一位都有明确的、不可篡改的语义。理解它们是读懂驱动器“心思”的唯一途径。Control Word控制字详解这是一个16位的寄存器每一位代表一个“指令”。最常用、也最容易出错的是以下几位Bit 0 (Switch On)这是“电源开关”。只有当它为1时驱动器才允许功率输出。但它不是唯一的条件。Bit 1 (Enable Voltage)这是“电压使能”。它控制着驱动器内部的IGBT驱动电路是否上电。必须先置1再置0才能安全地“吸合”主接触器。Bit 2 (Quick Stop)这是“急停”。一旦置1驱动器会立即切断电机电流进入自由停车或斜坡停车状态。关键点在于它是一个“锁存”位。即使你下一周期把它清0驱动器也不会自动恢复必须先执行一次“Clear Fault”清除故障操作状态字0x6041:00的Bit 3Fault才会变0然后才能重新走使能流程。很多调试失败根源就在这里——工程师以为清0了Quick Stop就万事大吉却忘了还有个“Fault”状态要清除。Bit 3 (Enable Operation)这是“运行使能”。只有当Bit 0、1、2都为0无故障、已使能电压、未急停且Bit 3为1时驱动器才真正进入“Ready to Switch On”状态等待你的位置/速度/转矩指令。Bit 4 (New Set Point)这是CSP/CSV/CST模式下的“指令更新触发位”。在CSP模式下你每周期更新0x607A:00目标位置后必须在下一个周期将此位置1驱动器才会读取新的目标值。如果不置位它会一直用上一个周期的旧值。这就是为什么有时你明明改了目标位置电机却纹丝不动——不是没发过去而是没“按确认键”。Status Word状态字详解它实时反映驱动器的“健康状况”和“工作状态”是诊断问题的第一手资料。Bit 0 (Ready to Switch On)表示驱动器已准备好可以接收Switch On指令。Bit 1 (Switched On)表示驱动器已上电功率单元已激活。Bit 2 (Operation Enabled)表示驱动器已进入运行状态可以响应控制指令。Bit 3 (Fault)表示驱动器发生了故障。此时Bit 0-2都会变为0驱动器停止输出。必须通过SDO写入0x6040:00的Bit 7Fault Reset来复位。Bit 10 (Target Reached)这是CSP模式下的“到位信号”。当实际位置与目标位置的误差小于设定的“Position Window”位置窗口时此位自动置1。它是实现“精确定位完成”判断的黄金标准远比在主站侧用软件比较Actual Position和Target Position更可靠、更实时。我曾用这个信号替代了PLC里一个复杂的定时器逻辑将一个装配工位的循环时间缩短了120ms。3.3 模式切换的“安全门禁”状态机与使能流程CIA402定义了一套极其严谨的状态机State Machine它像一道道“安全门禁”确保驱动器只能在满足所有前置条件的情况下才能进入下一个工作状态。这个流程与你选择的CSP/CSV/CST模式无关是所有模式都必须遵守的铁律。标准的使能流程以CSP为例如下Startup (启动)驱动器上电进入Not Ready to Switch On状态。Enable Voltage (使能电压)主站写0x6040:000x0006(Bit 1 Bit 2)驱动器进入Voltage Enabled状态。此时电机轴可自由转动。Switch On (开启)主站写0x6040:000x0007(Bit 0 Bit 1 Bit 2)驱动器进入Ready to Switch On状态。Enable Operation (使能运行)主站写0x6040:000x000F(Bit 0 Bit 1 Bit 2 Bit 3)驱动器进入Operation Enabled状态。此时驱动器才开始真正响应0x607A:00目标位置指令。关键陷阱这个流程是“单向”的且每一步都需要读取0x6041:00状态字来确认是否成功。例如在第2步写入0x0006后你必须等待至少一个周期再读取状态字确认Bit 1Switched On是否为1。如果为0说明电压使能失败可能是主回路接触器未吸合或是驱动器内部电源模块故障。绝对禁止在未确认上一步成功的情况下就贸然执行下一步。我曾在一个项目中因为主站程序里缺少这个“等待确认”的延时导致驱动器在Voltage Enabled状态还没稳定时就收到了0x000F的指令结果触发了内部保护报出了一个无法复位的0x8110Internal Error故障最终只能返厂维修。模式切换本身也是一个状态机操作。从CSP切换到CSV不是简单地改一个参数。它要求首先将驱动器置于Operation Disabled状态写0x6040:000x0006。然后通过SDO非实时通道修改对象字典中的0x6060:00Modes of Operation为0x03CSV。最后重新走一遍上述的使能流程步骤2-4。整个过程驱动器会短暂失电电机轴会自由转动。因此模式切换只能在设备停机、安全防护到位的情况下进行。4. 实操过程与核心环节实现4.1 汇川IS620P的CSP模式完整配置以TwinCAT3为例下面以一个真实的、可复现的案例带你走完从零开始配置CSP模式的全部步骤。假设你有一台汇川IS620P伺服驱动器连接在TwinCAT3主站的EtherCAT网络上目标是让电机以S形加减速曲线精准运行到100000脉冲对应1圈的位置。Step 1导入EDS文件扫描从站在TwinCAT3的“System Manager”中右键点击“Devices”选择“Scan Devices”。TwinCAT会自动扫描网络找到IS620P并显示其Vendor ID和Product Code。右键该设备选择“Add Device from EDS...”。这里必须使用汇川官方提供的、与你驱动器固件版本严格匹配的EDS文件如IS620P_V210.eds。切记用错EDS文件会导致PDO映射错误这是90%的“配置后不工作”问题的根源。我曾用V1.0x的EDS去配V2.10的驱动器结果0x6083:00加速度的单位被识别成了rpm/s而实际固件要求是rpm/s^2导致加速度指令被放大了1000倍电机启动瞬间就触发了过流保护。Step 2配置PDO映射与同步管理器展开设备节点双击“Process Data” → “PDO Assignment”。确认RxPDO1下发中包含了0x6040:00(Control Word),0x607A:00(Target Position),0x6081:00(Max Profile Velocity),0x6083:00(Profile Acceleration),0x6084:00(Profile Deceleration),0x6085:00(Quick Stop Deceleration)。确认TxPDO1上传中包含了0x6041:00(Status Word),0x6064:00(Position Actual Value),0x606C:00(Velocity Actual Value)。在“Sync Manager”中将RxPDO1分配给SM2Output Sync ManagerTxPDO1分配给SM3Input Sync Manager并设置其“Cycle Time”为2ms即500Hz。这是CSP模式的典型周期既能保证响应又不会给主站带来过大负担。Step 3配置CIA402对象字典参数在设备节点下展开“Objects” → “6000h - 6FFFh”。找到0x6060:00(Modes of Operation)双击将其值设为0x01CSP。找到0x6086:00(Motion Profile Type)设为0x01S-Curve这是实现平滑运动的关键。找到0x6087:00(Max Acceleration)根据你的电机和负载计算并填入。例如IS620P-20A驱动器带1.5kW电机最大加速度约为10000 rpm/s²换算成CIA402单位rpm/s² * 1000应填入10000000。找到0x6065:00(Position Window)设为10001000个脉冲。这是Target Reached信号的触发阈值决定了你对“到位”的精度要求。Step 4编写TwinCAT PLC控制程序// 定义驱动器接口 driveInterface : FB_EtherCAT_ServoDrive; // 主循环 driveInterface( Enable : TRUE, AxisNo : 1, ControlWord : 16#000F, // 使能运行 TargetPosition : 100000, // 目标位置单位脉冲 MaxProfileVelocity : 3000, // 最大速度单位rpm ProfileAcceleration : 10000000, // 加速度单位rpm/s² * 1000 ProfileDeceleration : 10000000 ); // 判断是否到位 IF driveInterface.StatusWord AND 16#0400 THEN // Bit 10 Target Reached // 执行下一步动作如气缸夹紧 END_IF;这段代码的核心在于ControlWord的值。16#000F是十六进制对应二进制0000 0000 0000 1111即置位了Bit 0,1,2,3完成了完整的使能流程。TargetPosition的单位是“脉冲”这与汇川驱动器的编码器分辨率直接相关。如果你的编码器是2500线那么100000脉冲就等于40圈。务必确认你的单位换算无误。4.2 CSV模式下的速度环整定实战CSV模式的威力在于其超快的速度响应。但要发挥它必须对速度环进行精细整定。这与CSP模式下的位置环整定完全不同。第一步理解CSV的“速度指令链”在CSV模式下主站下发的0x60FF:00Target Velocity是速度环的直接给定值。驱动器内部的速度环会将这个给定值与0x606C:00Velocity Actual Value实际速度进行比较计算出误差再通过PI调节器输出一个转矩指令。因此CSV模式的性能瓶颈完全取决于速度环的带宽和抗扰动能力。第二步整定前的必要准备将驱动器切换到CSV模式0x6060:000x03。断开所有机械负载空载避免惯性干扰。在TwinCAT的Scope中添加两个信号0x60FF:00目标速度和0x606C:00实际速度采样率设为10kHz。第三步经典Ziegler-Nichols临界比例度法将速度环的P增益0x60B0:00设为一个很小的值如10I增益0x60B1:00设为0。给一个阶跃速度指令如从0rpm到1000rpm观察实际速度的响应曲线。你会发现实际速度缓慢上升严重滞后。逐步增大P增益直到实际速度出现等幅振荡。记录此时的P增益值Ku和振荡周期Tu。计算整定参数P增益 0.6 * KuI时间常数 0.5 * Tu→ I增益 P增益 / I时间常数我用此方法整定一台IS620P驱动的1.5kW电机得到Ku120,Tu8ms最终P72, I18000。整定后的速度响应时间0-90%从原来的120ms缩短到了18ms完全满足了高速分拣的需求。第四步加入前馈提升动态性能纯PI调节器在应对速度指令的快速变化时仍会有相位滞后。此时必须加入速度前馈Velocity Feedforward,0x60B2:00。它的原理是在速度指令发生阶跃变化的瞬间不等PI调节器慢慢计算就直接“预测”出一个转矩增量提前加进去。0x60B2:00的值越大前馈越强。但过大会引起超调。我的经验是从0.1开始试逐步增加到0.3观察Scope中的超调量。当超调量控制在5%以内时即可认为整定完成。4.3 CST模式的力控闭环从理论到实践CST模式是真正的“硬核”领域。它要求你放弃驱动器内置的任何环自己构建一个完整的力控系统。下面是一个用CST模式实现“恒力按压”的最小可行方案。硬件与信号流主站TwinCAT3 PLC配备一个高精度力传感器如ATI的Gamma系列其模拟量输出接入PLC的AI模块。从站汇川IS620P工作在CST模式0x6060:000x04。信号流力传感器读数 → PLC AI模块 → PLC程序计算误差 → 输出0x6071:00Target Torque→ IS620P执行。PLC程序核心逻辑// 力传感器读数已标定为N forceSensorValue : REAL; // 单位牛顿 // 设定期望力 setForce : REAL : 5.0; // 5N // PI力环控制器 forceController : FB_PID; forceController( Enable : TRUE, SP : setForce, PV : forceSensorValue, Kp : 10.0, Ti : 0.1, Td : 0.0 ); // 将力环输出单位N转换为转矩指令单位0.01%额定转矩 // IS620P的额定转矩为4.77Nm100% 10000 targetTorque : INT : INT_TO_INT( (forceController.CV * 10000) / 4.77 ); // 下发转矩指令 driveInterface.TargetTorque : targetTorque;关键难点与解决方案单位换算地狱力传感器输出是伏特PLC AI模块读取的是数字量要转换成牛顿牛顿要转换成电机的转矩Nm再转换成CIA402的0x6071:00单位是0.01%额定转矩。每一步都可能引入误差。我的做法是在PLC中建立一个“标定表”用已知重量的砝码逐点测试传感器输出与实际力的关系生成一个线性拟合公式直接嵌入程序。机械谐振当电机以恒定转矩推动一个弹性体如橡胶垫时系统会形成一个机械谐振峰导致力值剧烈震荡。解决方法是在力环PID之后加入一个陷波滤波器Notch Filter中心频率设为实测的谐振频率如120Hz。TwinCAT3的FB_NotchFilter功能块可以直接调用。零漂补偿力传感器和电机本身都有零点漂移。必须在每次启动时执行一个“零点校准”程序让电机输出0转矩保持5秒记录此时的传感器读数作为后续所有测量的零点基准。5. 常见问题与排查技巧实录5.1 “电机不转”问题的黄金排查清单这是最常见、也最让人抓狂的问题。别急着怀疑硬件按这个清单一步步查90%的问题能在5分钟内定位。排查步骤检查内容工具/方法典型原因1. 看状态字读取0x6041:00看Bit 0-2是否为1TwinCAT的Online WatchBit 00电压未使能Bit 10未开启Bit 20未使能运行。2. 查控制字检查下发的0x6040:00值是否正确Scope抓取Control Word波形值为0x0006只使能了电压忘了置位Bit 0和Bit 3。3. 核PDO映射确认RxPDO1中是否包含了0x6040:00和0x607A:00TwinCAT的PDO Configuration窗口映射缺失指令根本没发到驱动器。4. 测目标值读