3. 伺服系统基础：伺服电机、驱动器、编码器、闭环控制原理、转矩/速度/位置模式
工业机械臂的每一个关节，本质上都是一个高动态、高精度的伺服系统。理解伺服系统的构成与工作原理，是掌握PLCopen运动控制逻辑的前提。本章将围绕伺服电机、驱动器、编码器、闭环控制原理以及三种核心控制模式展开，帮助您建立从硬件到软件、从物理到逻辑的完整认知。
3.1 伺服系统的核心组成与硬件链路
一套完整的工业机械臂关节伺服系统，由四个核心部件构成：伺服电机、伺服驱动器、编码器（反馈单元）以及运动控制器（PLC或专用运动控制卡）。它们之间的物理连接与信号流向，决定了系统的控制性能。
3.1.1 伺服电机：执行机构
机械臂关节普遍采用永磁同步伺服电机（PMSM）。其转子为永磁体，定子为三相绕组。相比异步电机，PMSM具有功率密度高、动态响应快、过载能力强、低速平稳性好等优势。在机械臂应用中，电机通常搭配高减速比谐波减速器或RV减速器，以输出大扭矩并保证关节刚度。
选型时需关注以下关键参数：
- 额定转矩与峰值转矩：决定关节的负载能力，峰值转矩通常为额定值的3倍以上，用于短时加速或克服冲击负载。
- 额定转速与最高转速：影响机械臂末端速度，需与减速比匹配。
- 转子惯量：惯量比（负载惯量/电机惯量）建议控制在10:1以内，否则动态响应变差，易产生振荡。
- 制动器（抱闸）：垂直关节必须配置失电制动器，防止断电时臂体坠落。
3.1.2 伺服驱动器：功率放大与控制核心
驱动器接收控制器下发的目标指令（位置、速度或转矩），通过内部三环调节，输出PWM电压驱动电机。驱动器内部包含：
- 整流与逆变单元：将三相交流电整流为直流母线电压，再通过IGBT或MOSFET逆变器输出频率可调的三相交流电。
- 电流采样电路：通常采样两相或三相电流，用于电流环闭环。
- 控制内核（DSP/FPGA）：执行位置环、速度环、电流环算法，周期通常为125μs~1ms。
- 数字量与模拟量接口：用于接收脉冲/方向信号、模拟量速度指令或总线通信（EtherCAT、PROFINET等）。
3.1.3 编码器：反馈测量单元
编码器是伺服系统的“眼睛”，其精度直接影响机械臂的定位精度和重复定位精度。常见类型如下表：
| 类型 | 原理 | 分辨率 | 机械臂应用场景 |
|---|---|---|---|
| 增量式光电编码器 | 输出A/B/Z正交脉冲，断电丢失位置 | 1000~8192线（4倍频后） | 低端SCARA或经济型关节 |
| 值单圈编码器 | 每圈内位置唯一，断电保持 | 17~23 bit | 标准六轴关节，需上电找零 |
| 值多圈编码器 | 记录圈数，断电保持位置 | 单圈17bit+多圈16bit | 高精度协作机器人，免找零 |
| 磁编码器（霍尔+磁阻） | 基于磁场角度检测 | 12~16 bit | 低成本或高冲击环境 |
3.2 闭环控制原理：三环结构
伺服系统采用嵌套式三闭环结构，从内到外依次为：电流环 → 速度环 → 位置环。内环响应速度最快，外环响应速度最慢，层层嵌套，保证系统稳定。
3.2.1 电流环（最内环）
电流环控制的是电机定子电流（即转矩电流Iq和励磁电流Id）。通过Clarke变换和Park变换，将三相静止坐标系下的电流转换为旋转坐标系下的直流分量，实现解耦控制。电流环的带宽通常为1~3 kHz，是三个环中最高的。其作用是快速响应转矩指令，抑制负载扰动和反电动势影响。
3.2.2 速度环（中间环）
速度环以电流环为内环，输入为目标转速，输出为电流指令。速度环采用PI控制器，其带宽通常为50~300 Hz。速度环的增益决定了系统的抗负载扰动能力和速度跟踪精度。在机械臂中，速度环的输出会经过陷波滤波器，以抑制机械谐振频率。
3.2.3 位置环（最外环）
位置环以速度环为内环，输入为目标位置，输出为速度指令。位置环通常采用P控制器（比例控制），带宽为10~50 Hz。位置环增益（Kp）越大，跟踪误差越小，但过大会引起超调甚至振荡。在PLCopen运动控制中，位置环的输入来自MC_MoveAbsolute等指令生成的目标位置。
3.3 转矩模式、速度模式与位置模式
根据机械臂的应用需求，驱动器可工作在三种基本模式。PLCopen通过不同的功能块（如MC_MoveVelocity、MC_MoveAbsolute、MC_MoveTorque）来调用这些模式。
3.3.1 转矩模式（电流模式）
转矩模式下，控制器直接给定目标电流（转矩）指令，驱动器只负责电流环闭环。此时电机的输出转矩与指令成正比。该模式用于需要精确控制力的场景，例如：
- 机械臂的力控/柔顺控制（如装配、打磨、拖拽示教）。
- 关节过载保护，限制最大输出力矩。
转矩模式的缺点是：电机转速不受控，若负载突然变小，电机可能飞车。因此，必须配合速度上限保护（驱动器内部有速度限制参数）。
3.3.2 速度模式
速度模式下，控制器给定目标速度指令，驱动器完成速度环和电流环闭环。速度指令可通过模拟量（±10V）、脉冲频率或总线通信给定。在PLCopen中，MC_MoveVelocity功能块即用于速度模式。速度模式适用于：
- 输送带同步、传送带跟踪。
- 机械臂关节的连续旋转运动（如转台）。
3.3.3 位置模式
位置模式是最常用的模式。控制器给定目标位置（位置或相对位置），驱动器完成位置环、速度环、电流环三环闭环。位置指令可通过脉冲+方向、总线（EtherCAT）或模拟量（较少用）给定。PLCopen的MC_MoveAbsolute、MC_MoveRelative均基于位置模式。位置模式适用于绝大多数点位运动、轨迹插补运动。
| 模式 | 控制环 | 指令类型 | 典型应用 | PLCopen功能块 |
|---|---|---|---|---|
| 转矩模式 | 电流环 | 目标电流/转矩 | 力控、柔顺、拖拽 | MC_MoveTorque（扩展） |
| 速度模式 | 速度环+电流环 | 目标速度 | 连续旋转、同步跟踪 | MC_MoveVelocity |
| 位置模式 | 位置环+速度环+电流环 | 目标位置 | 点位运动、轨迹插补 | MC_MoveAbsolute / MC_MoveRelative |
3.4 实战案例：六轴机械臂J1关节的伺服调试与模式切换
某六轴工业机械臂项目，J1（基座旋转关节）在调试时出现低频振荡（约5Hz），且上电后无法准确回零。我们通过以下步骤完成排查与优化：
3.4.1 初始现象与目标
- 现象：J1在低速运行时（<10 rpm）出现周期性抖动，示波器读取速度反馈波形呈正弦波动；高速运行时（>60 rpm）正常。
- 目标：消除低速振荡，实现±0.02°的重复定位精度，并优化上电回零流程。
3.4.2 关键数据采集
驱动器型号：某品牌 3kW 伺服驱动器
编码器：值多圈 23bit（单圈） + 16bit（多圈）
速度环增益（Kv）：0.5 Nm/rpm
速度环积分时间（Ti）：10 ms
位置环增益（Kp）：30 1/s
负载惯量比（J_load/J_motor）：8.5:1
振荡频率：约5.2 Hz（通过FFT分析速度反馈信号）3.4.3 分析判断过程
低频振荡通常由以下原因引起：
- 机械谐振：J1连接的大惯量转盘与减速器弹性形变形成谐振点，5.2Hz接近该机械固有频率。
- 速度环增益过高：Kv=0.5在低速时增益过大，导致速度环输出电流指令振荡。
- 编码器反馈噪声：低速时编码器信号细分误差被放大。
通过断开负载（空载）测试，振荡消失，确认是机械谐振与负载惯量比过高共同导致。
3.4.4 实际操作步骤
- 启用陷波滤波器：在驱动器参数中设置陷波频率为5.2Hz，陷波深度-20dB，带宽2Hz。重新测试，振荡幅值降低约70%。
- 降低速度环增益：将Kv从0.5降至0.35，Ti从10ms调整为15ms，牺牲少量动态响应换取稳定性。
- 增加位置环前馈：在PLCopen程序中，对MC_MoveAbsolute指令增加速度前馈系数（FeedForward Velocity=80%），减小跟踪滞后。
- 优化回零流程：利用值多圈编码器，在PLC上电后直接读取编码器位置，无需回零。但需在驱动器参数中设置“上电位置有效”标志，并校准机械零点偏移量（通过MC_Home指令设定偏移值）。
3.4.5 结果对比与复盘
| 指标 | 调试前 | 调试后 |
|---|---|---|
| 低速振荡幅值 | ±0.5 rpm | ±0.05 rpm |
| 重复定位精度 | ±0.05° | ±0.015° |
| 上电回零时间 | 8秒（需找零） | 0.5秒（直接读取） |
| 高速跟踪误差 | 0.8 mm | 0.3 mm |
复盘经验：机械臂关节调试必须结合机械特性（谐振频率、惯量比）进行，不能盲目调高增益。值编码器虽然免回零，但必须做好机械零点标定，否则位置无意义。此外，PLCopen中的前馈参数（如速度前馈、加速度前馈）对提升轨迹精度至关重要。
3.5 常见误区与总结
- 误区一：位置环增益越大越好。过大的位置环增益会导致电机啸叫、机械冲击，甚至损坏减速器。应结合机械刚性和负载惯量合理设置。
- 误区二：转矩模式可以随意使用。转矩模式下电机转速不受控，必须设置驱动器内部速度限制（如
Speed Limit参数），否则可能发生飞车事故。 - 误区三：忽略编码器电池电压。值编码器若使用电池保持多圈数据，电池耗尽会导致位置丢失。需在PLC程序中监控编码器电池报警。
- 误区四：三环参数独立调试。三环参数相互影响，修改速度环参数后必须重新验证位置环稳定性。
总结：伺服系统是机械臂的肌肉与神经。理解电机、驱动器、编码器的硬件特性，掌握三环闭环原理，并能在转矩、速度、位置三种模式间灵活切换，是编写高质量PLCopen运动控制程序的基础。在实际项目中，务必先完成驱动器层面的参数整定，再进行PLCopen功能块的逻辑调试，才能实现稳定、高效、精准的机械臂运动。