机器人 / 系统课时

区分位置速度电流三级伺服环

区分位置速度电流三级伺服环

六轴机械臂接收到目标关节角度后,并不是直接给电机施加固定电压,而是通过位置、速度和电流三级闭环逐级生成控制指令。本课用单关节信号链和数字算例,说明每一级控制什么、反馈从哪里来,以及三级环为什么需要不同的响应速度。

学习目标

  • 说清位置外环、速度中环、电流内环的控制目标、输入、输出和反馈信号。
  • 理解三级环的级联关系,区分控制周期、闭环带宽和机械响应速度。
  • 根据位置误差、速度误差和电流跟踪情况,初步判断伺服系统的问题所在。

三级伺服环如何级联

工业伺服通常采用由外向内的级联闭环:位置环决定需要多快地运动,速度环决定需要多大的驱动转矩,电流环控制电机产生相应的电磁转矩。

三个环不是各自独立控制同一台电机,而是前一级的输出成为后一级的给定值。

位置速度电流三级伺服环的级联结构与反馈路径

各环的职责可以直接对照以下表格:

控制环 比较的信号 控制器输出 主要反馈来源
位置外环 目标位置与实际位置 速度指令 编码器测得的位置,必要时按减速比换算
速度中环 目标速度与实际速度 转矩或转矩电流指令 编码器信号经过速度估计与滤波
电流内环 目标电流与实际电流 电压调制指令 电流传感器采样及坐标变换

位置控制器常使用比例控制并配合速度前馈;速度控制器通常采用PI调节;在常见的永磁同步伺服电机磁场定向控制(FOC)中,电流控制器也通常采用PI调节,并分别处理d轴和q轴电流。

在常规FOC工作区,q轴电流与电磁转矩近似成正比。因此速度环要求更大转矩时,通常需要提高q轴电流给定,而不是直接修改PWM占空比。

反馈信号怎样形成闭环

位置反馈通常来自电机编码器,也可能结合关节输出端编码器。如果使用电机侧编码器,必须依据减速比和零位偏置换算关节角度。例如减速比为100:1时,忽略弹性变形和传动误差,电机旋转100°对应关节旋转约1°。

速度反馈可以由编码器位置变化量估算。假设关节角度在10 ms内增加0.08°,平均关节速度就是8°/s。实际控制器需要考虑采样量化、滤波延迟以及编码器分辨率,不能直接把带噪声的位置差分当作稳定速度反馈。

电流反馈则来自驱动器内部的电流采样电路。对于三相永磁同步伺服电机,FOC通过坐标变换获得d轴和q轴电流,并根据电机电角度完成控制。电流控制器调整电压指令,逆变器再通过PWM向电机供电。

这种反馈路径决定了三级环各自能够纠正的误差:

  • 位置环负责最终关节位置的跟踪偏差,但不能直接消除电机相电流的快速扰动。
  • 速度环负责转速偏差,并通过转矩指令抵抗负载变化。
  • 电流环负责快速跟踪电流给定,但不能单独保证关节到达目标位置。

例如机械臂夹取工件后负载转矩增大,关节速度可能先下降。速度环检测到速度误差后提高转矩要求,电流环随之增加实际电流;如果位置尚未达到目标,位置环仍会继续给出运动指令。

用一组数值追踪三级误差

假设某个关节正在低速运动,控制器已把电机侧和关节侧的速度单位正确换算。下面是一组用于理解级联关系的示例数据,并非特定厂商的控制参数。

项目 示例数值
目标关节角度 30°
实际关节角度 28°
位置环比例系数 5 s⁻¹
实际关节速度 8°/s
速度环计算出的电机转矩要求 2 N·m
电机转矩常数 0.5 N·m/A
实际q轴电流 3.6 A

首先计算位置误差:30°减去28°,得到2°。忽略前馈和限幅时,比例位置环的输出为:

vref=Kp(qref−qfb)v_{ref}=K_p(q_{ref}-q_{fb})

代入比例系数5 s⁻¹,得到目标关节速度10°/s。假设关节实际速度为8°/s,则速度误差为2°/s。

速度PI控制器根据当前速度误差和已经积累的积分状态计算转矩要求。这里假设其输出为电机侧2 N·m。注意,不能仅凭2°/s的瞬时速度误差直接推导出2 N·m,实际输出还取决于PI增益、积分状态和限幅等条件。

在忽略转矩常数变化、磁饱和及其他非理想因素的简化模型下,q轴电流要求为:

iq∗=Tm∗/Kt=2/0.5=4 Ai_q^*=T_m^*/K_t=2/0.5=4\ \mathrm{A}

假设实际q轴电流只有3.6 A,电流误差就是0.4 A。电流PI控制器通过调整电压指令促使实际电流接近4 A,电机转矩随之变化,最终影响关节速度和位置。

完整的误差传递关系是:位置误差2°产生速度指令10°/s;速度误差2°/s经过速度PI调节形成转矩指令;转矩要求2 N·m换算为4 A的q轴电流指令;电流环继续纠正0.4 A的跟踪误差。

如果电流达到驱动器限制,或者电机已受到母线电压、机械负载和热保护等约束,内环就可能无法实现外环提出的要求。此时持续提高位置环增益并不能创造额外转矩,反而可能造成积分饱和、振荡或过冲。

为什么内环需要更快

三级环不仅控制对象不同,工作时间尺度也不同。电流直接影响电磁转矩,需要快速抑制电气扰动;速度变化受到转动惯量约束;位置运动则涉及完整的机械位移过程。

以下给出一组便于理解的假设控制周期,不代表所有工业机器人或伺服驱动器的固定规格。

控制环 示例控制周期 对应更新频率
位置环 2 ms 500 Hz
速度环 0.5 ms 2 kHz
电流环 0.05 ms 20 kHz

在这组配置中,位置环更新一次的2 ms期间,速度环可以更新4次,电流环可以更新40次。速度环更新一次期间,电流环可以更新10次。这样内环能够在外环下一次更新之前,多次修正较快变化的电流误差。

必须区分控制更新频率与闭环带宽。20 kHz的电流采样或控制更新频率,不等于电流环能以20 kHz的闭环带宽稳定跟踪信号。闭环带宽还受电机电感、逆变器延迟、传感器噪声、数字滤波和控制器稳定裕度等因素约束。

工程上通常希望电流环的有效闭环带宽高于速度环,速度环再高于位置环,让内层动态能够相对充分地跟随外层指令。具体带宽间隔应依据设备模型、机械共振频率及厂商整定要求确定,不能简单按更新频率的比例设置增益。

现场如何区分是哪一级出了问题

联调时可以记录目标关节位置、实际位置、目标速度、实际速度、转矩或q轴电流指令、实际q轴电流,以及驱动器限流和故障状态。分析时按照内环是否能够跟随指令,再检查外环跟踪效果的顺序进行。

观测现象 优先检查 判断依据
位置跟踪误差大,但速度跟踪正常 位置环、轨迹给定和前馈 速度指令本身是否足以消除位置误差
目标速度与实际速度偏差持续较大 速度环、负载转矩和限流状态 转矩指令是否达到限制、速度估计是否可信
q轴电流指令与反馈明显不一致 电流环及驱动器电气约束 电流采样、母线电压、PWM限制及故障状态
运动中出现周期性抖动 增益、滤波及机械共振 抖动频率与速度、电流波形是否对应

例如,一个关节在运动时出现明显滞后,若目标电流为4 A而实际只有2 A,并且驱动器报告限流或供电受限,应先查明电流受限原因,而不是立即提高位置环比例增益。反过来,如果电流和速度跟踪都正常,但轨迹给出的速度指令过小,就应回查位置环或轨迹规划参数。

判断三级伺服环时,沿着位置给速度、速度给转矩、电流实现转矩的方向检查指令,再沿传感器反馈方向核对实际值。这样才能区分目标轨迹不合理、机械负载过大和驱动器跟踪能力不足等不同问题。

按自己的节奏,确认真正理解。

目录与阅读设置

阅读设置

17

记录一个想法

区分位置速度电流三级伺服环

0 / 10000 · 笔记保存到账号。未提交的修改会在关闭、离开或刷新后丢失。

登录哪都通