2、伺服系统基础：伺服电机与驱动器的工作原理、闭环控制概念、位置/速度/力矩三种控制模式
伺服系统（Servo System）是机器人运动控制的核心执行单元，其本质是一个高精度的“电-机械”信号转换与功率放大装置。理解伺服电机与驱动器的工作原理，是拆解驱动器硬件组成的前提。本章将围绕“电流→力矩→速度→位置”的能量与信息传递链路，深入解析伺服系统的闭环控制架构，并详细对比位置、速度、力矩三种控制模式的内在逻辑与适用场景。只有厘清这些基础概念，后续分析驱动器硬件电路（如整流逆变、电流采样、编码器接口）时才能做到“知其然，更知其所以然”。
上图展示了伺服系统最核心的“三环闭环”架构。从内到外依次为电流环、速度环和位置环。电流环完全在驱动器内部由硬件电路和DSP固件构成，响应速度最快（微秒级）；速度环和位置环则根据控制模式的不同，由驱动器或上位机以不同方式闭合。下面逐一展开。
2.1 伺服电机与驱动器的工作原理
核心原理：从电能到机械能的精确转换
工业机器人中广泛使用的伺服电机多为永磁同步电机（PMSM）或无刷直流电机（BLDC）。其转子嵌有永磁体，定子绕组通入三相交流电后产生旋转磁场，与转子磁场相互作用产生电磁转矩。与普通异步电机不同，伺服电机的转子惯量小、极对数多、编码器分辨率高，因此能够实现极高的动态响应和定位精度。
驱动器（Servo Drive）本质上是一个“智能功率放大器”。它接收来自上位机的微弱指令信号（如±10V模拟量、脉冲序列或EtherCAT总线数据），经过内部运算后，通过IGBT或IPM功率模块生成PWM电压，驱动电机运转。驱动器内部包含三大功能单元：控制单元（DSP/FPGA，负责闭环算法）、功率单元（整流、逆变、制动电阻）、检测单元（电流传感器、编码器接口电路）。
判断方法：如何区分伺服电机与普通电机
- 看反馈元件：伺服电机尾部必然装有编码器（增量式或绝对值式）或旋转变压器，普通电机没有。
- 看铭牌参数：伺服电机标有额定转矩（N·m）、额定转速（rpm）、转子惯量（kg·m²）等，且转矩/惯量比通常大于10。
- 看接线端子：伺服电机除三相动力线（U/V/W）外，还有编码器线（通常为屏蔽双绞线）和可能的抱闸线。
小型场景化说明：
想象你用手拧动一个旋钮，如果旋钮连接的是普通电机，你会感到均匀的阻力；如果连接的是伺服电机（断电状态），你会感到明显的“齿槽感”——这是因为永磁体与定子齿槽之间的磁阻变化。上电后，伺服电机会自动锁定转子位置，你再拧动它，会感到一股“弹性阻力”，这就是伺服系统的位置闭环在起作用。
2.2 闭环控制概念
核心原理：反馈与校正
闭环控制（Closed-Loop Control）的核心思想是“检测偏差→计算校正→输出调整→再检测”。伺服系统中，编码器实时测量电机轴的实际位置和速度，与指令值比较后产生误差信号，控制器根据误差的大小和变化率，通过PID（比例-积分-微分）算法计算出修正量，调整PWM占空比，使电机向减小误差的方向运动。
三环控制的带宽（响应速度）从内到外递减：电流环带宽通常为1-2kHz，速度环为100-500Hz，位置环为10-100Hz。这种带宽分配保证了内环响应快于外环，系统才能稳定。如果位置环带宽高于速度环，就会产生振荡甚至发散。
| 控制环 | 反馈量 | 执行器 | 典型带宽 | 主要作用 |
|---|---|---|---|---|
| 电流环（最内环） | 相电流（Ia/Ib/Ic） | PWM逆变器 | 1-2 kHz | 控制转矩，限制过流 |
| 速度环（中间环） | 编码器速度（微分） | 电流环指令 | 100-500 Hz | 控制转速，抑制扰动 |
| 位置环（最外环） | 编码器位置 | 速度环指令 | 10-100 Hz | 控制位置，实现定位 |
操作流程：伺服系统上电与闭环建立
- 上电初始化：驱动器读取编码器绝对位置（绝对值编码器）或执行寻零操作（增量式编码器）。
- 使能（Servo On）：驱动器闭合接触器，向电机注入励磁电流，建立磁场。
- 电流环闭合：DSP以10-20kHz频率采样相电流，执行Clarke/Park变换，实现电流闭环。
- 速度环闭合：对编码器位置信号微分得到速度，与速度指令比较，输出电流指令。
- 位置环闭合：根据控制模式，位置环生成速度指令或直接生成电流指令。
2.3 位置/速度/力矩三种控制模式
核心原理：三环的取舍与组合
三种控制模式本质上是“使用哪几个闭环”的问题：
- 位置模式（Position Mode）：三环全闭。上位机给出目标位置，驱动器内部完成位置环、速度环、电流环的全部运算。适用于点胶机、CNC、机器人关节等需要精确定位的场景。
- 速度模式（Speed Mode）：速度环+电流环闭合，位置环由上位机或外部控制器完成。上位机给出速度指令（模拟量或总线），驱动器只保证电机转速精确跟随。适用于传送带同步、绕线机等场景。
- 力矩模式（Torque Mode）：仅电流环闭合。上位机给出力矩指令（对应电流指令），驱动器只控制输出转矩，速度和位置完全由外部负载决定。适用于拧紧枪、张力控制、力控打磨等场景。
| 控制模式 | 闭环结构 | 指令类型 | 反馈元件 | 典型应用 |
|---|---|---|---|---|
| 位置模式 | 位置+速度+电流 | 脉冲/总线位置指令 | 编码器（高分辨率） | 机器人关节、贴片机 |
| 速度模式 | 速度+电流 | ±10V模拟量/总线速度 | 编码器或测速机 | 传送带、飞剪 |
| 力矩模式 | 仅电流 | 模拟量/总线力矩指令 | 电流传感器（无需编码器） | 力控打磨、张力控制 |
案例拆解：机器人关节的力矩模式与位置模式切换
背景与约束：某六轴机器人末端执行器需要完成“先力控打磨（力矩模式），再精确移动到下一工位（位置模式）”的任务。机器人控制器（上位机）通过EtherCAT总线与各关节伺服驱动器通信。
初始现象：在力控打磨阶段，若使用位置模式，机器人刚性过大，无法适应工件表面不平整，导致打磨力波动大，甚至损坏工件。
关键参数：打磨接触力目标值10N，力控精度±1N；关节电机额定转矩7.8N·m，电流环带宽1.5kHz。
分析判断过程：力控打磨要求电机输出力矩随接触力实时调整，因此必须使用力矩模式。但力矩模式下电机无位置保持能力，一旦工件突然移开，电机可能加速飞车。因此需要设置“力矩限幅”和“速度前馈限制”。
实际操作步骤：
- 将驱动器参数Pn000设为“力矩模式”，设定最大力矩限制为额定值的80%（防止过载）。
- 通过总线周期（1ms）发送力矩指令，同时读取编码器速度，若速度超过安全阈值（如300rpm），驱动器自动切换回速度模式并减速。
- 打磨完成后，上位机发送“模式切换”指令，驱动器在10ms内从力矩模式切换到位置模式，并执行点到点运动。
结果对比：切换前，打磨力波动±3N；切换后，打磨力波动±0.8N，且模式切换过程无冲击，位置定位精度达到±0.02mm。
风险与代价：模式切换期间，电流环和速度环参数需要重新整定，若切换过快可能导致短暂振荡。代价是驱动器需要支持“动态模式切换”功能，且上位机控制逻辑更复杂。
复盘经验：力矩模式不是“没有位置控制”，而是“位置控制交给外部环境”。实际工程中，力矩模式必须配合速度限制和位置软限位，否则一旦负载消失，电机可能高速飞转。