针对工程实际应用中存在的未知输入会导致经典的非线性滤波器状态估计精度下降甚至滤波发散的问题,提出了一种基于最小方差无偏估计(minimum variance unbiased estimation,MVUE)准则的扩展平方根容积卡尔曼滤波(extended square-root cubature Kalman filter,ESRCKF)算法.首先,结合上一时刻未知输入估计值对状态一步预测值进行修正,得到含未知输入条件下的状态预测值.其次,设计新息并采用加权最小二乘(weighted least squares,WLS)法获取当前时刻未知输入的无偏估计.最后,通过最小化协方差矩阵的迹,同时采用拉格朗日乘子法和舒尔补引理得到系统状态的最小方差无偏估计.仿真结果表明,相比于现有的非线性滤波算法,ESRCKF算法提高了在处理含未知输入非线性系统时的状态估计精度,并能同时实现系统状态和未知输入的最优估计,验证了该算法的有效性.
Extended Square-root Cubature Kalman Filtering Algorithm for Nonlinear Systems with Unknown Inputs
The unknown inputs in practical engineering applications will lead to the decline of the accuracy of the classical nonlinear filter state estimation and even the divergence of the filter.In order to address this problem,an extended square-root cubature Kalman filter(ESRCKF)algorithm according to the minimum variance unbiased estimation(MVUE)criterion was proposed.Firstly,the one-step predicted value of state was modified by combining with the unknown input estimated value at the previous time to obtain the pre-dicted value of state under the condition of unknown input.Secondly,the unbiased estimation of the unknown input at the current time was obtained by using innovation and weighted least squares(WLS)method.Finally,the minimum variance unbiased estimation of the system state was obtained by minimizing the trace of the covariance matrix,while using the Lagrange multiplier method and the Schur complement lemma.Simulation results demonstrate that compared with the existing nonlinear filtering algorithms,ESRCKF algorithm improves the accuracy of state estimation when dealing with nonlinear systems with unknown inputs,and can simultaneously achieve the optimal estimation of system state and unknown inputs,which validates the effectiveness of the algorithm.