非线性磁链观测器+PLL(源码+参考文献+仿真模型) ①源码:VESC的无感非线性观测器代码,并做了简单的调试,可以做到0速启动。 代码注释非常详细,快速入门!! ②参考文献(英文+翻译):为VESC非线性观测器的论文出处 ③对应的simulinK仿真 大名鼎鼎的VESC里面的观测器。 对学习非线性观磁链测器有很大帮助 图一:为观测位置角度与真实角度波形。
VESC的开源项目里藏着不少电机控制的黑科技,今天咱们重点扒一扒它那个能零速启动的非线性磁链观测器。这玩意儿配合PLL(锁相环)用起来是真带劲,实测波形显示观测角度和真实角度几乎重合(见图一),手头有板子的朋友可以直接拿源码开搞。
先看代码结构,关键在observer.c这个文件里:
// 观测器核心结构体 typedef struct { float phi_alpha; // α轴磁链观测值 float phi_beta; // β轴磁链观测值 float gamma; // 非线性增益 float w_r_pll; // PLL输出转速 } NonlinearObserver; // PLL参数配置 void pll_config(float kp, float ki) { pll_kp = kp; // 比例系数建议0.5~2.0 pll_ki = ki; // 积分系数建议10~50 }这个gamma参数是观测器的灵魂,调试时你会发现它直接决定系统稳定性。根据论文里的建议,gamma取值在电机额定转速的1.5倍左右效果最佳。但实际调试有个骚操作——先让电机转起来,然后慢慢调低gamma值直到波形不抖。
观测器核心算法长这样:
void update_observer(NonlinearObserver* obs, float i_alpha, float i_beta, float v_alpha, float v_beta) { // 电流微分计算(实际用的是差分代替) float di_alpha = (i_alpha - obs->i_alpha_prev) / DT; float di_beta = (i_beta - obs->i_beta_prev) / DT; // 非线性项计算 float cross_term = obs->gamma * (i_alpha * obs->phi_beta - i_beta * obs->phi_alpha); // 磁链观测更新 obs->phi_alpha += DT * (v_alpha - RS * i_alpha + cross_term * i_alpha); obs->phi_beta += DT * (v_beta - RS * i_beta + cross_term * i_beta); // 更新电流缓存 obs->i_alpha_prev = i_alpha; obs->i_beta_prev = i_beta; }注意看cross_term这个非线性项,它其实是把电流和磁链观测值做了叉乘。这种结构比传统观测器多了一个转矩补偿项,论文里证明这货能有效抑制高速时的相位滞后。实测发现当电机突然加载时,这个补偿项能让角度跟踪速度提升约30%。
PLL部分反而是最简单的:
float pll_update(float theta_observed) { static float theta_pll = 0.0; static float integrator = 0.0; float error = sin(theta_observed - theta_pll); integrator += pll_ki * error * DT; theta_pll += (pll_kp * error + integrator) * DT; return theta_pll; }这里有个坑——用sin而不像常规PLL用相位差本身,其实是为了避免过零点突变。但代价是误差信号幅度被压缩,所以kp和ki的取值要比常规PLL大5倍左右。建议调试时先用示波器同时抓thetaobserved和thetapll,调kp让两条线快速贴合,再调ki消除稳态误差。
Simulink模型更直观展示了磁链观测的动态过程(模型文件在附件)。重点看磁链矢量幅值的变化曲线——空载时应该是个完美圆,加载后会有轻微椭圆化,但观测器输出的角度曲线依然坚挺。这说明非线性项的鲁棒性确实能打。
最后安利下原始论文《Sensorless Control of PMSMs Using a Nonlinear Observer》(作者B. Harnfor),里面对稳定性证明部分用了李雅普诺夫直接法,虽然数学劝退但物理意义讲得透彻。核心结论就一句:只要gamma选得合适,观测误差必定收敛!
源码包里还有个vescobservertuning.py脚本,自动扫频测试观测器带宽。实测某款云台电机能达到200Hz的跟踪带宽,足够应付大多数突发负载场景。下期咱们可以聊聊怎么把这观测器移植到STM32G4系列芯片上...