机器人 / 系统课时

用PID参数分析超调和稳态误差

用PID参数分析超调和稳态误差

把六轴机械臂中的一个关节简化为带惯量、阻尼和恒定负载的转动系统,对同一个 30° 位置阶跃运行五组 PID 参数。读者将得到可复现的超调率、8 秒末位置误差和调节时间,并学会判断哪些“响应更快”的参数反而会造成振荡或力矩触限。

学习目标

  • 解释比例、积分、微分增益对单轴阶跃响应的不同影响。
  • 运行 Python 仿真,计算超调率、位置偏差和 2% 调节时间。
  • 区分仿真整定与真实工业机器人伺服调参的安全边界。

建立带恒定负载的单轴模型

设关节从 0° 跟踪 30° 位置指令,转动惯量 J=0.05J=0.05 kg·m²,粘性阻尼 b=0.20b=0.20 N·m·s/rad,恒定反向负载力矩 τL=0.25\tau_L=0.25 N·m,驱动输出限幅为 ±2.0 N·m。采样周期为 0.002 s,观察时间为 8 s。恒定负载只近似某个姿态邻域的重力影响,不代表完整六轴耦合模型。

转动方程为 Jω˙=τ−bω−τLJ\dot{\omega}=\tau-b\omega-\tau_L,其中 θ\theta 为角度,ω\omega 为角速度。位置误差 e=θr−θe=\theta_r-\theta,控制律采用 τ=Kpe+Ki∫e dt−Kdω\tau=K_p e+K_i\int e\,dt-K_d\omega。微分项取测量角速度,而非对突然变化的目标角度求导,可避免阶跃指令引起微分冲击。

此处 KpK_p、KiK_i、KdK_d 的单位依次是 N·m/rad、N·m/(rad·s)、N·m·s/rad。只有比例或比例微分控制时,静止状态下必须由 KpeK_p e 抵消 0.25 N·m 负载,因此 Kp=2K_p=2 对应的理论稳态误差是 0.25/2=0.1250.25/2=0.125 rad,约 7.16°;单独增加微分增益无法消除它。

运行五组参数的阶跃仿真

使用 Python 3.10 或更高版本,以下示例仅依赖标准库。角度在模型内部一律使用弧度,输出时再转换为度;力矩触限且积分还会推动饱和时,暂停该步的积分累加,以减少积分饱和。

python
import math

DT, DURATION = 0.002, 8.0
TARGET = math.radians(30.0)
TORQUE_LIMIT = 2.0

def simulate(kp, ki, kd):
    angle = velocity = integral = 0.0
    angles = [0.0]
    for _ in range(round(DURATION / DT)):
        error = TARGET - angle
        proposed_integral = integral + error * DT
        raw = kp * error + ki * proposed_integral - kd * velocity

        # 力矩触限且误差继续推向饱和时,暂停积分以抑制积分饱和
        if ki > 0 and abs(raw) > TORQUE_LIMIT and raw * error > 0:
            raw = kp * error + ki * integral - kd * velocity
        else:
            integral = proposed_integral

        torque = max(-TORQUE_LIMIT, min(TORQUE_LIMIT, raw))
        # 惯量 J=0.05、阻尼 b=0.20、恒定反向负载=0.25 N·m
        acceleration = (torque - 0.20 * velocity - 0.25) / 0.05
        velocity += acceleration * DT
        angle += velocity * DT
        angles.append(angle)

    values = [math.degrees(a) for a in angles]
    peak = max(values)
    overshoot = max(0.0, (peak / 30.0 - 1.0) * 100.0)
    error_at_8s = 30.0 - values[-1]
    # 调节时间:进入并始终保持在目标 ±0.6° 带内的最早时刻
    outside = [i for i, a in enumerate(values) if abs(a - 30.0) > 0.6]
    settled = (outside[-1] + 1) * DT if outside and outside[-1] < len(values) - 1 else None
    return peak, overshoot, error_at_8s, settled

cases = [
    ("P", 2.0, 0.0, 0.0),
    ("PD", 2.0, 0.0, 0.6),
    ("PID", 2.0, 0.8, 0.6),
    ("HighKp", 8.0, 0.0, 0.0),
    ("HighKi", 2.0, 8.0, 0.6),
]

print(f"{'case':<7} {'peak':>6} {'OS%':>6} {'e8(deg)':>8} {'t2%(s)':>7}")
for name, kp, ki, kd in cases:
    peak, overshoot, error_at_8s, settled = simulate(kp, ki, kd)
    t = "--" if settled is None else f"{settled:.2f}"
    print(f"{name:<7} {peak:>6.2f} {overshoot:>6.1f} {error_at_8s:>8.2f} {t:>7}")

预期输出(浮点数末位可能存在平台差异):

text
case      peak    OS%  e8(deg)  t2%(s)
P        30.83    2.8     7.16      --
PD       22.84    0.0     7.16      --
PID      29.96    0.0     0.04    2.80
HighKp   41.89   39.6     1.79      --
HighKi   43.26   44.2     0.01    3.88

这里 peak 是 8 秒内最大角度,OS% 是相对 30° 指令的超调百分比,e8(deg) 是 8 秒末的带符号位置误差。t2%(s) 要求进入 29.4°~30.6° 容差带后一直保持在带内;-- 表示观察期内不满足条件,并不代表程序失败。

用响应曲线解释数据

五组PID参数的单关节位置阶跃响应对比

P 组最大角度 30.83°,仅超调 2.8%,但振荡衰减后停在 22.84°,仍离目标 7.16°。因此“曾经越过目标”和“最终跟踪到目标”是两项独立指标,不能只看超调峰值判断控制质量。

加入 Kd=0.6K_d=0.6 后,PD 组消除了越过 30° 的瞬态,却仍停在 22.84°;微分项抑制运动时的变化速度,但当角速度归零后并不提供负载补偿。PID 组再加入 Ki=0.8K_i=0.8,8 秒末误差降至 0.04°,并在 2.80 s 后保持在目标 ±0.6° 范围内。

按超调与静差分别调整增益

整定时先保持 Ki=0K_i=0,用小幅度的 KpK_p 找到足够的响应,再逐步增加 KdK_d 抑制振荡,最后在有持续负载静差时缓慢引入 KiK_i。每次只修改一个参数,并记录同一目标、同一负载下的最大角度、末端误差和调节时间。

本例中仅把 KpK_p 从 2 增至 8,8 秒末误差从 7.16° 缩小到 1.79°,但超调升至 39.6%。初始比例力矩需求约 4.19 N·m,已超过 2.0 N·m 限幅;更大的比例增益并不意味着执行机构能提供更大力矩。

把 KiK_i 从 0.8 提高到 8,虽然 8 秒末误差仅 0.01°,峰值却达到 43.26°,超调 44.2%,调节时间延长到 3.88 s。这说明只检查最终误差,会漏掉中途的严重过冲。积分限幅抑制积分累积,并不能替代合适的闭环增益;真实编码器噪声还可能被过大的微分增益放大。

把仿真结论转成安全验收条件

对本例 30° 仿真阶跃,可先设定一组教学验收线:最终绝对误差不超过 0.6°、超调不超过 10%(峰值不超过 33°)、2% 调节时间不超过 3.0 s,且没有持续的力矩饱和。上述五组参数中,只有 PID 组同时满足这三项数值要求;它们是教学阈值,不是工业机器人通用安全标准。

真实工位通常还有电流环、速度环和位置环,控制器内部结构与调参权限因设备而异。不要把这份仿真的力矩 PID 代码直接下发到机器人,也不要绕过厂商限位或安全回路。应在厂商允许的调试模式下先用低速、小行程的平滑运动测试,记录指令位置、实际位置、跟随误差、驱动电流和报警;检查正反方向及不同负载姿态后,再依据设备手册决定是否调整增益。

若出现反复跨越目标、异常噪声、持续触及电流限值或跟随误差报警,应停止测试并回退参数,核查机械松动、编码器反馈、负载估计与控制周期。可接受的参数组合必须同时满足位置精度、瞬态响应和驱动约束,而不是单纯追求更短的到位时间。

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

目录与阅读设置

阅读设置

17

记录一个想法

用PID参数分析超调和稳态误差

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

登录哪都通