第3章电子齿轮数学模型

3、电子齿轮数学模型：主从轴运动学模型、电子齿轮比的计算公式、位置环与速度环的传递函数

好，咱们今天来聊聊电子齿轮的数学模型。说实话，这部分内容在很多人看来就是一堆公式推导，枯燥得很。但我个人觉得，搞懂了数学模型，你才算真正理解了电子齿轮的本质。否则你调参数的时候，就跟瞎子摸象一样，全靠运气。

电子齿轮说白了，就是让从轴跟着主轴转，但转的比例可以任意设定。这个比例就是电子齿轮比。但光知道比例还不够，你得知道整个系统是怎么动态响应的。这就涉及到运动学模型和传递函数了。

先说说运动学模型。我习惯把主轴和从轴看成两个独立的旋转体，中间通过一个虚拟的齿轮连接。这个虚拟齿轮就是电子齿轮。

主轴的运动，通常用位置指令 θ_m(t) 来表示。从轴的目标位置 θ_s*(t) 就是主轴位置乘以电子齿轮比：

θs*(t) = R · θm(t)

其中 R 就是电子齿轮比。但实际从轴的位置 θ_s(t) 会有误差，这个误差就是我们要分析的。

我在项目中遇到过一种情况：主轴是凸轮机构，速度变化特别剧烈。如果只做简单的比例跟随，从轴根本跟不上，误差大得离谱。后来我意识到，运动学模型里必须考虑加速度前馈，才能让从轴跑得稳。

所以完整的运动学模型应该是：

θs*(t) = R · θm(t)
ωs*(t) = R · ωm(t)
αs*(t) = R · αm(t)

位置、速度、加速度都要同步。你想想看，如果只同步位置，速度突变时从轴就会猛冲一下，然后被拉回来，这就是震荡的根源。

电子齿轮比的计算，其实没那么玄乎。它就是把机械齿轮的齿数比，换算成电子信号的比例。

假设主轴编码器每转脉冲数为 P_m，从轴编码器每转脉冲数为 P_s。机械上我们希望主轴转一圈，从轴转 N 圈。那么电子齿轮比 R 就是：

R = (N · Ps) / Pm

举个例子：主轴编码器 2500 线，从轴编码器 2500 线，希望主轴转 1 圈，从轴转 2 圈。那么：

R = (2 × 2500) / 2500 = 2.0

就这么简单。但实际应用中，我建议你注意两点：

注意：电子齿轮比不是越大越好。R 太大，从轴的位置分辨率会下降。比如 R=10 时，主轴走 1 个脉冲，从轴要走 10 个脉冲，相当于从轴的步距被放大了 10 倍，精度自然就差了。

嗯，这里要重点讲一下。传递函数是分析系统稳定性的利器。我刚开始做伺服调试时，总觉得调 PI 参数就是瞎试，后来学会了看传递函数的伯德图，才真正有了方向。

先看速度环。速度环的典型结构是 PI 控制器加电机模型。电机模型可以简化为一阶惯性环节：

Gv(s) = Kt / (J·s + B)

其中 Kt 是转矩常数，J 是转动惯量，B 是阻尼系数。PI 控制器的传递函数是：

Cv(s) = Kpv + Kiv / s

那么速度环的开环传递函数就是：

Gv_open(s) = Cv(s) · Gv(s) = (Kpv + Kiv/s) · Kt / (J·s + B)

速度环的闭环传递函数呢？我习惯写成：

Gv_close(s) = Gv_open(s) / (1 + Gv_open(s))

这个公式看着简单，但实际调试时你会发现，Kpv 和 Kiv 的比值决定了系统的带宽和阻尼。我建议你先把 Kiv 设小一点，只调 Kpv，等系统不震荡了，再慢慢加 Kiv 来消除静差。

接下来是位置环。位置环通常只有比例控制，因为积分项会导致位置超调。位置环的控制器就是：

Cp(s) = Kpp

位置环的闭环传递函数，是把速度环当成一个整体来看：

Gp_close(s) = Kpp · Gv_close(s) / (s + Kpp · Gv_close(s))

这里 s 是微分算子，因为位置是速度的积分。你看，位置环的带宽受限于速度环的带宽。速度环响应越快，位置环才能跟得越紧。

核心结论：

我的经验：调试时先让电子齿轮比 R=1，调好速度环和位置环。然后再改 R 到目标值。这样能排除齿轮比带来的干扰，定位问题更快。

最后，我用一张图来总结电子齿轮的数学模型。这张图展示了从主轴位置指令到从轴实际位置的完整信号流。

从这张图你能看到，主轴位置经过电子齿轮比放大后，成为从轴的目标位置。然后位置环和速度环串联起来，驱动电机到达实际位置。反馈回路把实际位置拿回来跟目标位置比较，形成闭环控制。

说白了，电子齿轮的数学模型就是三个环节的串联：运动学映射、位置环、速度环。搞懂了这三个环节的传递函数，你就能定量分析跟随误差，知道误差是从哪来的，怎么去补偿。

我曾经在一个贴片机项目上，就是因为没搞懂速度环带宽对位置环的限制，导致高速贴装时位置误差一直超标。后来把速度环带宽从 50Hz 提到 200Hz，位置误差直接降了一半。你看，数学模型不是纸上谈兵，它是实实在在能帮你解决问题的工具。

公众号:蓝海资料掘金营，微信deep3321