伺服系统数学模型:从物理世界到控制方程

做速度环调参,第一件事不是拧增益,而是搞清楚你手里这个电机到底长什么样。说白了,数学模型就是电机的「身份证」。我刚开始做伺服驱动时,总觉得数学推导太绕,直接上PI参数试错不就完了?结果有一次在高速主轴项目上,电机一跑就震荡,调了三天都没搞定。后来老老实实把模型拉了一遍,才发现是机械谐振频率刚好落在速度环带宽附近。嗯,从那以后我再也不敢跳过建模这一步了。

永磁同步电机(PMSM)的数学模型

PMSM 的数学模型,核心就是电压方程和磁链方程。咱们先看最常用的 d-q 旋转坐标系下的形式:

d 轴电压方程:u_d = R_s · i_d + L_d · (di_d/dt) - ω_e · L_q · i_q
q 轴电压方程:u_q = R_s · i_q + L_q · (di_q/dt) + ω_e · (L_d · i_d + ψ_f)

这里每个符号都有物理含义:

符号 含义 单位
u_d, u_q d、q 轴电压 V
i_d, i_q d、q 轴电流 A
R_s 定子电阻 Ω
L_d, L_q d、q 轴电感 H
ω_e 电角速度 rad/s
ψ_f 永磁体磁链 Wb

关键点:对于表贴式 PMSM(SPMSM),有 L_d ≈ L_q;对于内置式 PMSM(IPMSM),L_q > L_d。这个差异直接影响弱磁控制和最大转矩电流比(MTPA)策略。我在做电动汽车驱动时,IPMSM 的 L_q 比 L_d 大了将近 3 倍,速度环参数必须分开整定。

电磁转矩方程也很重要:

T_e = 1.5 · p_n · [ψ_f · i_q + (L_d - L_q) · i_d · i_q]

其中 p_n 是极对数。对于 SPMSM,L_d = L_q,转矩只与 i_q 成正比,控制起来简单很多。IPMSM 则多了一项磁阻转矩,可以利用 i_d 负向注入来提升效率。

机械运动方程:转动惯量说了算

电机的机械侧,用一个二阶微分方程就能描述:

J · (dω_m/dt) = T_e - T_L - B · ω_m

各符号含义:

  • J:系统总转动惯量(kg·m²),包括电机转子 + 负载折算值
  • ω_m:机械角速度(rad/s)
  • T_e:电磁转矩(N·m)
  • T_L:负载转矩(N·m)
  • B:粘性阻尼系数(N·m·s/rad)

这个方程是速度环设计的根基。你想想看,速度环本质上就是在对抗 J 和 T_L 的变化。J 越大,系统响应越慢;T_L 突变时,速度跌落越深。我遇到过一台大型机床主轴,J 是电机转子本身的 20 倍,速度环增益必须压得很低,否则一启动就过冲。

实战技巧:在做惯量辨识时,可以用「加减速法」——给定一个梯形速度曲线,记录转矩电流和加速度,通过最小二乘拟合出 J 和 B。我习惯在电机空载和带载两种状态下各测一次,对比结果能判断负载惯量是否在合理范围内。

电气时间常数与机械时间常数

这两个时间常数,是连接电气动态和机械动态的桥梁。理解它们,你就能预判速度环的带宽极限在哪里。

电气时间常数 τ_e

定义很简单:

τ_e = L_s / R_s

其中 L_s 是定子电感(对于 SPMSM 取 L_d 或 L_q 均可)。τ_e 反映了电流环的响应速度。一般来说:

  • τ_e 越小,电流响应越快,但电流纹波也越大
  • τ_e 越大,电流越平滑,但带宽受限

典型值范围:小功率伺服电机 τ_e ≈ 1~5 ms,大功率电机 τ_e ≈ 5~20 ms。我在做一款 400W 的伺服驱动器时,τ_e 只有 1.2 ms,电流环带宽可以推到 2 kHz 以上。

机械时间常数 τ_m

定义:

τ_m = J / B

它反映了机械系统对转矩变化的响应速度。τ_m 越大,系统越「迟钝」——比如大惯量负载,速度变化很慢。τ_m 越小,系统越「灵敏」——比如小惯量空心杯电机,轻轻一给转矩速度就变了。

实际工程中,τ_m 的范围跨度极大:

应用场景 典型 τ_m 速度环带宽参考
小惯量伺服(机器人关节) 10~50 ms 100~300 Hz
中惯量(通用工业) 50~200 ms 30~100 Hz
大惯量(机床主轴) 200 ms~2 s 5~30 Hz

避坑指南:我曾经在一个包装机械项目上,默认把速度环带宽设到 150 Hz,结果电机高频啸叫,负载端震动剧烈。后来一测 τ_m 接近 500 ms,机械谐振频率只有 80 Hz。速度环带宽必须低于机械谐振频率的 1/3 到 1/5,否则必出问题。

知识体系总览

下面这张图把本章的核心逻辑串起来了。你可以看到,从 PMSM 的电磁模型到机械运动方程,再到两个时间常数,最终都指向速度环参数整定这个目标。

伺服系统数学模型知识体系 伺服系统数学模型知识体系 PMSM 电磁模型 d-q 电压方程 电磁转矩方程 机械运动方程 J · dω/dt = T_e - T_L - Bω 转动惯量 J、阻尼 B 时间常数 τ_e = L_s / R_s τ_m = J / B 关键电磁参数 R_s, L_d, L_q, ψ_f, p_n 关键机械参数 J, B, T_L, 谐振频率 动态特性指标 电流环带宽、速度环带宽 速度环参数辨识与优化 惯量辨识 → 带宽设计 → PI 参数整定 → 谐振抑制 💡 核心思路: 电气时间常数 τ_e 决定电流环带宽上限,机械时间常数 τ_m 决定速度环带宽上限。 两者相差越大(τ_m ≫ τ_e),速度环设计越容易;相差接近时,需要解耦设计。

从模型到实战:参数辨识的起点

有了数学模型,下一步就是把这些参数「认」出来。我个人习惯把参数分成两类:

  • 电气参数:R_s、L_d、L_q、ψ_f —— 可以通过直流注入、交流阻抗测试、空载反电动势法获取
  • 机械参数:J、B —— 需要通过加减速实验、转矩扰动观测来辨识

这里有个常见的误区:很多人以为电机铭牌上的参数可以直接用。其实铭牌参数是额定工况下的标称值,实际运行时 R_s 会随温度变化(铜线温升每 10°C 电阻增加约 4%),L_d、L_q 会随电流饱和而下降。我在做一款高功率密度伺服时,实测 L_d 只有铭牌值的 70%,因为磁路已经深度饱和了。

建议:每次上电前,先做一次静态参数辨识。用 PWM 占空比注入直流电压,测出 R_s;再注入高频小信号,测出 L_d 和 L_q。整个过程不到 1 秒,但能让你的速度环参数更靠谱。