3. 精密定位系统建模

精密定位系统的控制器设计,第一步不是调参数,而是建立一个“够用”的模型。所谓够用,是指模型能抓住影响定位精度与动态响应的主导因素,同时阶次不过高、参数可辨识、便于在控制器中实时计算。直线电机定位平台通常由永磁同步直线电机(PMSM-LM)、直线导轨、工作台与负载、光栅尺反馈和驱动器构成。若把每个部件都精确建模,会得到包含电磁暂态、结构柔性、摩擦非线性和热变形的复杂系统;而面向控制的简化模型,一般保留“电气一阶 + 机械二阶 + 摩擦/扰动”这一主干结构。

一、直线电机的动力学方程

先约定坐标系与正方向:设工作台沿导轨向右运动为正,位移记为 x,速度 v = dx/dt,电磁推力 Fe 向右为正,摩擦力与扰动阻力向左为负。直线电机的机械运动遵循牛顿第二定律:

M · dv/dt = F_e − F_f − F_d
F_e = K_f · i_q

其中 M 为动子、工作台与负载的等效总质量(kg),Ff 为导轨摩擦力,Fd 为齿槽力、线缆拖拽等扰动力,Kf 为推力常数(N/A),iq 为交轴电流。对采用磁场定向控制的 PMSM-LM,驱动器内部电流环带宽通常远高于机械环,因此可把“电流指令→实际推力”近似为比例环节,这就是简化模型的第一层假设。

二、电气时间常数与推力常数

电流环并非理想,其动态可用一阶惯性描述。设 uq 为交轴电压指令,Rs 为相电阻,Lq 为交轴电感,反电动势系数为 Ke,则:

L_q · di_q/dt = u_q − R_s · i_q − K_e · v
τ_e = L_q / R_s

电气时间常数 τe 典型在 0.5~5 ms 量级。若机械时间常数 τm = M/B(B 为粘性阻尼)远大于 τe,则可在位置环设计中忽略电气动态,把推力视为直接可控量;若追求高带宽或 τe 与机械带宽接近,则必须保留该一阶环节。推力常数 Kf 与反电动势系数 Ke 在理想情况下满足 Kf = Ke(国际单位制),实际因端部效应、磁路饱和会有偏差,需通过推力标定获得。

三、机械导轨与负载耦合模型

导轨与负载不是刚体,而是“质量—阻尼—刚度”耦合链。工作台通过滑块与导轨连接,滑块内部有滚动体或气浮间隙,负载通过连接件固定在工作台上。若只关心低频定位,可把导轨等效为粘性阻尼 B 与库仑摩擦 Fc;若关心微米级定位,则需考虑连接刚度 kc 与负载质量 mL 构成的二阶谐振:

ω_n = sqrt(k_c / m_L)
ζ  = c_c / (2 · sqrt(k_c · m_L))

该谐振频率 ωn 常落在 100~800 Hz,是位置环带宽的上限约束。摩擦模型可写为:

F_f = B · v + F_c · sgn(v) + (F_s − F_c) · exp(−(v/v_s)^2) · sgn(v)

其中 Fs 为最大静摩擦,vs 为 Stribeck 速度。在低速换向时,摩擦非线性会造成“爬行”和反向死区,是精密定位误差的重要来源。

直线电机精密定位系统:面向控制的简化模型结构 电气层(一阶惯性) u_q → 电流环 → i_q τ_e = L_q / R_s F_e = K_f · i_q 典型 τ_e:0.5~5 ms 机械层(质量—阻尼) M · dv/dt = F_e − F_f − F_d v = dx/dt M = 动子 + 工作台 + 负载 机械时间常数 τ_m = M/B 导轨—负载耦合 k_c、c_c、m_L ω_n = √(k_c/m_L) ζ = c_c/(2√(k_c·m_L)) 谐振:100~800 Hz F_e v, x 位置/速度反馈(光栅尺) 摩擦与扰动 F_f = B·v + F_c·sgn(v) + Stribeck 项 F_d:齿槽力、线缆拖拽 F_f + F_d 简化条件 电流环带宽 ≫ 机械带宽 忽略结构高阶柔性 摩擦用等效模型替代 模型输出 x(t)、v(t)、i_q(t) 用于位置环/速度环设计 预测带宽与稳态误差

四、建立面向控制的简化模型

把上述关系整理为状态空间形式,取状态量 x = [x, v, iq]T,输入 u = uq,忽略摩擦非线性时:

d/dt [x]   = [0   1      0    ] [x]   + [0    ] u
     [v]     [0  −B/M   K_f/M ] [v]     [0    ]
     [i_q]   [0  −K_e/L_q −R_s/L_q] [i_q]  [1/L_q]

若电气动态可忽略,则降为二阶模型:

d²x/dt² = (K_f · u − B · v − F_f − F_d) / M

这就是位置环设计最常用的对象模型。实际工程中,常把 Kf、M、B 作为待辨识参数:M 可由推力—加速度实验估计,Kf 由恒流推力标定获得,B 由匀速段推力—速度曲线斜率得到。以某示例平台为例,动子加工作台质量 3.2 kg,负载 1.5 kg,则 M ≈ 4.7 kg;推力常数标定值 28 N/A;粘性阻尼约 12 N·s/m。由此机械时间常数 τm = 4.7/12 ≈ 0.39 s,远大于电气时间常数 1.2 ms,因此位置环设计可安全采用二阶简化模型。

建模取舍原则:若目标定位精度在 ±10 μm 以上,二阶模型加摩擦前馈通常足够;若要求 ±1 μm 以内,需保留电气一阶环节并考虑导轨谐振;若要求 ±0.1 μm,则必须引入热漂移与结构柔性的慢变模型。

五、参数辨识与模型验证

模型建立后必须验证。常用方法有两种:一是频响辨识,给位置指令叠加扫频信号,测量实际位移幅值与相位,与模型 Bode 图对比,若谐振峰位置偏差超过 15%,说明 kc 或 mL 估计不准;二是阶跃响应对比,施加 1 mm 阶跃指令,观察上升时间、超调量和稳态误差。若实测超调明显大于模型预测,通常是摩擦死区或电流环饱和所致,需要在模型中补充相应非线性环节。

参数符号示例值获取方式对控制的影响
等效总质量M4.7 kg推力—加速度实验决定加速度能力与增益上限
推力常数K_f28 N/A恒流推力标定决定电流到推力的换算精度
粘性阻尼B12 N·s/m匀速段推力—速度斜率影响稳态速度误差
电气时间常数τ_e1.2 msL_q / R_s决定电流环带宽
导轨谐振频率ω_n约 320 Hz频响辨识限制位置环带宽
注意:表中数值为教学示例假设,并非某台实际设备的实测结果。实际建模时必须以本机标定数据为准,且参数会随负载、温度与润滑状态变化,需定期复辨识。

综上,面向控制的直线电机定位模型可概括为“电气一阶 + 机械二阶 + 摩擦扰动”三层结构。建模的关键不是追求高阶精确,而是明确当前精度目标下哪些动态必须保留、哪些可以等效或忽略,并用辨识与验证闭环确认模型可信。只有模型与真实对象在关注频段内一致,后续的控制器设计、前馈补偿和误差抑制才有可靠基础。