3. 伺服系统基础
在工业机械臂的运动控制中，伺服系统是执行末端轨迹与力控的最终载体。PLCopen 标准中的 MC 功能块（如 MC_Power、MC_MoveAbsolute）本质上是向驱动器发送目标位置、速度与转矩指令，而实际能否精准、稳定地完成动作，取决于伺服电机、驱动器、编码器与闭环算法的协同质量。本章将围绕伺服系统的物理组成、控制链路与选型参数展开，帮助学员建立从“指令字”到“轴端机械位移”的完整技术认知。
3.1 伺服电机的类型与机械特性
工业机械臂中超过 90% 的旋转关节采用永磁同步伺服电机（PMSM），其转子嵌有高性能钕铁硼永磁体，定子为三相绕组。与异步电机相比，PMSM 具有功率密度高、动态响应快、过载能力强、低速平稳性好等优势。在机械臂应用中，电机通常与谐波减速器或 RV 减速器集成，形成“电机+减速器+编码器”的一体化关节模块。
伺服电机的核心机械特性包括：额定转矩（连续运行允许的最大转矩）、峰值转矩（短时可达最大转矩，通常为额定的 3 倍，持续 1-3 秒）、额定转速（额定电压下连续运行转速）、最高转速（受机械与电气限制的极限转速）以及转子惯量（影响加减速性能与系统刚性）。机械臂关节电机通常选择额定转速 3000-5000 rpm，经减速器后输出端转速降至 10-30 rpm，以获得足够转矩驱动臂杆。
3.2 伺服驱动器与功率变换
伺服驱动器是伺服系统的“大脑与肌肉”，负责接收 PLC 的运动指令，完成位置环、速度环、电流环的三闭环运算，并通过 IGBT 或 MOSFET 功率模块生成 PWM 电压驱动电机。驱动器内部结构可分为：控制板（DSP/FPGA 运行控制算法）、功率板（整流、逆变、制动电阻）、反馈接口（编码器信号解码）、通信接口（EtherCAT、PROFINET、CANopen 等）。
在 PLCopen 架构中，PLC 通过周期同步位置模式（CSP）或周期同步速度模式（CSV）向驱动器发送目标值。驱动器内部的位置环增益（Kp）、速度环增益（Kv）与积分时间常数（Ti）需要根据机械负载惯量比进行整定。现代驱动器普遍具备自动整定功能，通过注入测试信号识别负载惯量，自动计算最优增益，但复杂机械结构（如双连杆耦合）仍需人工微调。
| 驱动器参数 | 典型范围 | 影响 | 调试建议 |
|---|---|---|---|
| 位置环增益 Kp | 20-200 1/s | 跟踪误差、定位时间 | 先调速度环，再调位置环 |
| 速度环增益 Kv | 5-100 Hz | 速度响应、抗扰动 | 从低到高逐步增加，观察振动 |
| 速度环积分时间 Ti | 5-50 ms | 稳态误差、低速爬行 | 过大易振荡，过小有静差 |
| 惯量比设定 | 1-20 倍 | 加减速性能、共振抑制 | 通过自动整定获取初值 |
3.3 编码器：位置反馈的核心传感器
编码器是伺服闭环的“眼睛”，其分辨率与精度直接决定机械臂的重复定位精度。工业机械臂常用编码器分为增量式与式两大类。增量式编码器输出 A/B/Z 正交脉冲信号，通过计数获得相对位置变化，断电后丢失位置，需在开机时执行回零操作。式编码器则通过二进制码或串行协议直接输出位置，断电后位置信息不丢失，适用于需要快速上电恢复的场合。
从信号传输方式看，编码器可分为集电极开路、差分线驱动与串行数字接口。现代高端机械臂普遍采用 BiSS-C、EnDat 或 SSI 协议的式编码器，分辨率可达 23-25 bit（即 838 万-3355 万脉冲/圈），配合高精度减速器可实现 0.001° 级别的关节定位精度。编码器安装位置也需注意：电机端编码器（半闭环）测量电机轴转角，无法补偿减速器齿隙与弹性变形；负载端编码器（全闭环）直接测量输出轴位置，精度更高但成本与安装复杂度增加。
3.4 闭环控制原理：三环结构与整定方法
伺服驱动器的三闭环控制是经典级联控制结构：最内层为电流环，控制电机三相电流跟踪给定值，响应带宽最高（1-2 kHz）；中间层为速度环，根据速度误差调节电流指令，带宽约 200-500 Hz；最外层为位置环，根据位置误差生成速度指令，带宽约 50-150 Hz。级联结构的设计原则是：内环带宽应大于外环带宽的 3-5 倍，以保证各环之间不产生耦合振荡。
在 PLCopen 运动控制中，位置环通常由驱动器内部实现（CSP 模式），也可由 PLC 实现（外部位置环）。当机械臂需要高动态轨迹跟踪（如喷涂、打磨）时，建议使用驱动器内部位置环，因为其采样周期更短（通常 125 μs-1 ms），而 PLC 的周期通常为 1-4 ms。速度环与电流环必须始终由驱动器实现，因为其需要高速 PWM 输出与电流采样。
- 电流环整定：设置电流环 PI 参数，使电流阶跃响应无超调、上升时间小于 1 ms。通常由驱动器厂家提供默认值，无需用户调整。
- 速度环整定：先断开位置环，给速度阶跃指令，观察速度响应。逐步增大 Kv，直到出现轻微振荡，然后回调 20-30%。
- 位置环整定：恢复位置环，给位置阶跃指令，观察跟踪误差与超调量。增大 Kp 可减小跟踪误差，但过大会引起机械振动。
- 前馈补偿：在位置环中加入速度前馈与加速度前馈，可显著减小轨迹跟踪滞后，尤其适用于圆弧插补与连续轨迹运动。
3.5 伺服选型基本参数与计算流程
伺服选型是机械臂设计的关键环节，需综合负载特性、运动曲线、安装空间与成本约束。选型的基本流程为：计算负载转矩 → 计算负载惯量 → 确定电机额定/峰值转矩 → 校核转速与惯量匹配 → 选择编码器分辨率 → 确认驱动器功率与通信接口。以下通过一个具体案例说明。
已知条件：小臂质量 25 kg，质心距关节轴线 0.35 m，最大角加速度 3 rad/s²，减速比 1:100，减速器效率 85%，关节最大转速 60 rpm。
计算步骤：
① 负载静转矩 T_load = 25 × 9.81 × 0.35 = 85.8 N·m（重力矩）；
② 负载惯量 J_load = 25 × 0.35² = 3.06 kg·m²；
③ 折算到电机轴：T_motor = 85.8 / (100 × 0.85) = 1.01 N·m；J_motor_ref = 3.06 / 100² = 0.000306 kg·m²；
④ 动态转矩 T_dyn = J_total × α_motor = (J_motor + J_motor_ref) × (3 × 100) ≈ 0.1 N·m；
⑤ 峰值转矩 T_peak = T_motor + T_dyn ≈ 1.11 N·m，选型取 1.5-2 倍裕量 → 选额定 1.5 N·m、峰值 4.5 N·m 的电机；
⑥ 电机额定转速 = 60 × 100 = 6000 rpm，考虑减速器润滑与寿命，选 5000 rpm 额定转速电机。
惯量匹配是选型中常被忽视的要点。负载惯量与电机转子惯量的比值（惯量比）应控制在 10 倍以内，最佳为 3-5 倍。惯量比过大时，系统响应迟钝、容易振荡，且减速器承受冲击载荷增大。若惯量比超标，可采取以下措施：增大减速比、选用高惯量电机、增加弹性联轴器或采用双电机消隙驱动。
| 选型参数 | 符号 | 单位 | 确定依据 |
|---|---|---|---|
| 额定转矩 | T_n | N·m | 连续运行负载转矩 × 1.5-2 倍安全系数 |
| 峰值转矩 | T_max | N·m | 加减速峰值转矩 × 1.2-1.5 倍 |
| 额定转速 | n_n | rpm | 负载最高转速 × 减速比 |
| 转子惯量 | J_m | kg·m² | 负载惯量折算值 / (3-10) |
| 编码器分辨率 | R | bit | 定位精度要求 / 减速比 / 丝杠导程 |
| 驱动器额定电流 | I_n | A | 电机额定电流 × 1.2 倍 |
3.6 常见误区与工程复盘
误区一：盲目追求高分辨率编码器。编码器分辨率越高，成本与通信负载越大，但实际定位精度还受减速器背隙、机械刚度、热变形等因素限制。当减速器背隙为 1 arcmin 时，即使编码器分辨率达到 23 bit，末端定位精度也无法突破背隙限制。因此应优先提升机械刚度与减速器精度，再匹配编码器分辨率。
误区二：忽略驱动器供电与制动电阻。机械臂在减速或下放负载时，电机会处于发电状态，能量回馈至驱动器直流母线。若母线电压过高，驱动器会触发过压报警。选型时必须核算制动电阻的功率与阻值，或选用带能量回馈单元的驱动器。对于频繁启停的关节，制动电阻的持续功率应大于电机额定功率的 30%。
误区三：位置环增益越高越好。过高的位置环增益会放大编码器噪声与机械共振，导致电机啸叫或臂杆抖动。正确做法是：先通过频率响应测试找到机械共振点，然后启用驱动器的陷波滤波器（Notch Filter）抑制共振，再适当提高增益。
复盘总结：伺服系统选型与调试是一个“机械-电气-控制”耦合的工程问题。选型阶段应预留足够的转矩与惯量裕量，调试阶段应遵循“先内环后外环、先低速后高速、先空载后带载”的原则。PLCopen 程序中的轴参数（如最大速度、最大加速度、跟随误差阈值）必须与驱动器参数匹配，否则会出现 PLC 侧报警与驱动器侧报警不一致的排查困难。建议在 PLCopen 组态中设置合理的动态跟随误差窗口，既避免误报警，又能及时捕捉机械异常。