2. 运动控制对象建模

虚拟调试的核心前提,是让仿真环境中的“被控对象”在动态行为上足够接近真实设备。运动控制系统通常由伺服电机、传动机构、执行末端和负载四部分串联组成,任何一环的模型失真,都会在位置环、速度环甚至电流环上放大成明显的跟随误差或振荡。本节围绕这四类对象,说明从物理量到数学模型的建模方法,并给出可用于虚拟调试的示例参数与验证思路。

一、建模对象的分解与信号约定

在建模前必须先统一参照系与正方向。约定:电机轴旋转正方向为逆时针(从负载侧看向电机),对应执行末端沿导轨向正方向移动;转矩、转速、位移均以该方向为正。四类对象的输入输出关系为:伺服电机接收电压/电流指令,输出电磁转矩与转速;传动机构将转速转换为直线速度或降低转速放大转矩;执行末端把运动转换为工艺动作;负载则对系统施加反作用转矩与惯量。

建模的最终目标,是得到从“指令”到“末端实际位置”的传递关系,并能在仿真中复现超调、爬行、共振等典型现象。因此模型不是越复杂越好,而是要在虚拟调试关心的频段内保持幅频与相频特性一致。

二、伺服电机的数学建模

永磁同步伺服电机在矢量控制下可等效为直流电机模型。电枢回路电压方程为:

u = R·i + L·di/dt + Ke·ω
Te = Kt·i
Jm·dω/dt = Te - TL - Bm·ω

其中 R 为定子电阻,L 为等效电感,Ke 为反电动势系数,Kt 为转矩系数,Jm 为电机转子惯量,Bm 为粘滞阻尼系数,TL 为折算到电机轴的负载转矩。以某 400W 伺服电机为例,示例参数可取 R=1.2Ω、L=6mH、Kt=0.55N·m/A、Ke=0.55V·s/rad、Jm=0.3×10⁻⁴kg·m²。由电气时间常数 τe=L/R=5ms、机械时间常数 τm=Jm·R/(Kt·Ke)≈1.2ms 可知,电流环响应远快于速度环,虚拟调试中常将电流环简化为增益为1的环节,重点建模速度环与位置环。

若使用步进电机或直流有刷电机,模型形式相同,仅参数含义与数值不同。建模时应优先通过电机手册获取 Kt、Ke、Jm,再通过堵转实验或阶跃响应辨识 R、L 与 Bm。

三、传动机构的建模

传动机构包括联轴器、减速机、丝杠、同步带等。其核心作用有两个:变换运动形式(旋转→直线)和变换力矩与惯量。以滚珠丝杠为例,导程为 Ph(mm/r),减速比为 i,则电机转角 θ 与末端位移 x 的关系为:

x = (Ph · θ) / (2π · i)
v = (Ph · ω) / (2π · i)

负载惯量折算到电机轴为 Jl' = Jl / i²,负载力折算为 TL = F · Ph / (2π · i · η),η 为传动效率。丝杠自身惯量 Js 也需折算。传动机构还会引入弹性与间隙:联轴器和丝杠的扭转刚度 Ks 使系统出现双质量共振,共振频率 f = (1/2π)·√(Ks·(1/Jm+1/Jl'))。虚拟调试中若忽略该弹性,往往无法复现真实设备在高速段出现的机械谐振。

四、执行末端与负载特性

执行末端可能是夹爪、吸嘴、刀具或喷涂头,其建模重点在于把工艺动作转换为附加的力或转矩。负载特性则分为三类:惯性负载(如转台、滑台)、阻力负载(如摩擦力、切削力)、位能负载(如垂直轴重力)。摩擦力常用 Stribeck 模型描述:

Ff = Fc·sgn(v) + (Fs-Fc)·exp(-(v/vs)²)·sgn(v) + Bv·v

其中 Fc 为库仑摩擦力,Fs 为最大静摩擦力,vs 为 Stribeck 速度,Bv 为粘滞摩擦系数。垂直轴还需叠加恒定重力 mg。这些非线性项是造成低速爬行和定位死区的主要原因,在虚拟调试中应至少保留库仑摩擦与重力项。

运动控制对象建模:从指令到末端位置的信号链与参数折算 位置指令 θ_ref / x_ref 伺服电机 u = R·i + L·di/dt + Ke·ω Te = Kt·i Jm·dω/dt = Te − TL − Bm·ω Kt=0.55 N·m/A Jm=0.3×10⁻⁴ kg·m² τe=5ms, τm≈1.2ms 传动机构 x = Ph·θ / (2π·i) Jl' = Jl / i² TL = F·Ph / (2π·i·η) Ph=10mm/r, i=10 Ks 引起双质量共振 f=(1/2π)√(Ks(1/Jm+1/Jl')) 执行末端 夹爪 / 吸嘴 / 刀具 工艺动作 → 力/转矩 末端位置 x_act 末端速度 v_act 接触力 F_c 负载特性 惯性负载 Jl | 阻力负载 Ff | 位能负载 mg Ff = Fc·sgn(v) + (Fs−Fc)·exp(−(v/vs)²)·sgn(v) + Bv·v 低速爬行与定位死区的主要来源 TL 反作用转矩 位置/速度反馈(编码器) 建模顺序建议 ① 统一正方向与坐标系 ② 电机电气+机械参数 ③ 传动比/导程/效率折算 ④ 负载力/惯量/摩擦叠加

五、综合建模与虚拟调试验证

将上述四部分串联,可得到完整的机电耦合模型。以水平丝杠滑台为例,示例参数为:滑台质量 m=5kg,丝杠导程 Ph=10mm/r,减速比 i=10,传动效率 η=0.9,导轨摩擦 Fc=8N、Fs=12N、vs=0.01m/s、Bv=2N·s/m。折算到电机轴的负载惯量 Jl' = m·(Ph/2πi)² ≈ 5×(0.01/62.8)² ≈ 1.27×10⁻⁵kg·m²,与电机转子惯量 0.3×10⁻⁴kg·m² 同量级,说明该负载对动态响应影响显著。

在虚拟调试中,建议按以下顺序验证模型:先给电机施加 1V 阶跃电压,观察电流响应时间是否接近 τe;再闭合速度环,输入 1000r/min 阶跃,检查上升时间与超调;最后闭合位置环,输入 10mm 阶跃,观察末端位置是否出现爬行或振荡。若仿真中出现明显超调而实际设备没有,应检查是否遗漏了摩擦项;若仿真中高速段平稳而实际设备有啸叫,应补充传动弹性环节。

建模精度应与调试目标匹配:只做逻辑联调时,可用“增益+一阶惯性”简化模型;做伺服参数整定或共振分析时,必须保留电流环、传动弹性与非线性摩擦。
常见错误:把负载惯量直接加到电机转子惯量上而不除以 i²,会导致折算惯量偏大 i² 倍,使仿真响应明显慢于真实设备。务必先确认减速比方向与折算公式。

完成建模后,应把模型参数整理成可追溯的表格,标注来源(手册、辨识实验或假设值),并在虚拟调试记录中保留每次参数修改前后的响应曲线。这样,当现场调试出现偏差时,才能快速判断是模型参数问题还是控制参数问题。