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 速度。在低速换向时,摩擦非线性会造成“爬行”和反向死区,是精密定位误差的重要来源。
四、建立面向控制的简化模型
把上述关系整理为状态空间形式,取状态量 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,因此位置环设计可安全采用二阶简化模型。
五、参数辨识与模型验证
模型建立后必须验证。常用方法有两种:一是频响辨识,给位置指令叠加扫频信号,测量实际位移幅值与相位,与模型 Bode 图对比,若谐振峰位置偏差超过 15%,说明 kc 或 mL 估计不准;二是阶跃响应对比,施加 1 mm 阶跃指令,观察上升时间、超调量和稳态误差。若实测超调明显大于模型预测,通常是摩擦死区或电流环饱和所致,需要在模型中补充相应非线性环节。
| 参数 | 符号 | 示例值 | 获取方式 | 对控制的影响 |
|---|---|---|---|---|
| 等效总质量 | M | 4.7 kg | 推力—加速度实验 | 决定加速度能力与增益上限 |
| 推力常数 | K_f | 28 N/A | 恒流推力标定 | 决定电流到推力的换算精度 |
| 粘性阻尼 | B | 12 N·s/m | 匀速段推力—速度斜率 | 影响稳态速度误差 |
| 电气时间常数 | τ_e | 1.2 ms | L_q / R_s | 决定电流环带宽 |
| 导轨谐振频率 | ω_n | 约 320 Hz | 频响辨识 | 限制位置环带宽 |
综上,面向控制的直线电机定位模型可概括为“电气一阶 + 机械二阶 + 摩擦扰动”三层结构。建模的关键不是追求高阶精确,而是明确当前精度目标下哪些动态必须保留、哪些可以等效或忽略,并用辨识与验证闭环确认模型可信。只有模型与真实对象在关注频段内一致,后续的控制器设计、前馈补偿和误差抑制才有可靠基础。