[论文解读] The Convergence of the Extended Kalman Filter

Arthur J. Krener|ArXiv.org|Dec 18, 2002

Target Tracking and Data Fusion in Sensor Networks被引用 6

一句话总结

本论文在可验证条件下，建立了扩展卡尔曼滤波器（EKF）在一大类非线性系统中的局部收敛性：$C^2$ 动力学、特定典型形式下的统一可观测性，以及有界二阶导数。关键结果表明，若初始估计误差足够小，则误差呈指数衰减至零，将收敛保证扩展至先前受限的可检测性条件之外。

ABSTRACT

We demonstrate that the extended Kalman filter converges locally for a broad class of nonlinear systems. If the initial estimation error of the filter is not too large then the error goes to zero exponentially as time goes to infinity. To demonstrate this, we require that the system be $C^2$ and uniformly observable with bounded second partial derivatives.

研究动机与目标

• 建立非线性系统中扩展卡尔曼滤波器（EKF）的局部收敛性，其中先前的条件过于严格或不可验证。
• 解决在先前可检测性准则下，某些可观测线性系统中EKF收敛失败的问题。
• 提供可验证的、几何性的条件——特别是典型形式下的统一可观测性——以确保EKF收敛。
• 将收敛结果推广至非线性系统，超越线性系统，并克服早期工作（如Baras等人，1984年）的局限性，后者要求难以验证的统一可检测性。

提出的方法

• 将系统变换为可观测典型形式，其中状态动力学以李导数的嵌套积分形式表达，从而实现结构化分析。
• 构造一个类似李雅普诺夫的函数 $ \tilde{x}^T Q(t) \tilde{x} $ 以分析误差动力学，其中 $ Q(t) $ 由EKF的里卡蒂方程导出。
• 利用 $ \partial^2 \bar{f}/\partial x_i \partial x_j $ 的有界性，通过二阶泰勒余项的积分表示来界定误差动力学。
• 与高增益观测器技术进行比较，以利用可观测性形式的结构，推导出误差的指数衰减。
• 通过证明当初始误差足够小时，李雅普诺夫函数的时间导数为负定，从而推导出收敛条件。
• 证明过程中使用了矩阵范数不等式和噪声矩阵 $ G $ 的可逆性，以界定增益项并确保误差能量的指数衰减。

实验结果

研究问题

• RQ1 在具有有界二阶导数的非线性系统中，扩展卡尔曼滤波器在何种条件下实现局部收敛？
• RQ2 对于那些不满足先前研究中统一可检测性条件的可观测线性系统，能否保证EKF收敛？
• RQ3 可观测典型形式的结构是否能实现比先前方法更可验证、更通用的收敛性证明？
• RQ4 初始估计误差的大小如何影响非线性系统中EKF的收敛速率？
• RQ5 对于非统一可检测但具有指定形式下统一可观测性的系统，能否证明EKF呈指数收敛？

主要发现

• 若初始误差满足 $ \| \tilde{x}^T(0) Q(0) \tilde{x}(0) \|^{1/2} < \frac{m_7}{2 m_1^{7/2} m_5^2 L} $，则扩展卡尔曼滤波器在局部范围内实现指数衰减的估计误差，其中 $ m_7, m_1, m_5, L $ 是由系统和噪声参数导出的常数。
• 收敛条件是可验证的，且不依赖于先前失效的严格统一可检测性条件，后者在某些可观测线性系统中不成立。
• 该结果适用于具有 $ C^2 $ 动力学和非线性项有界二阶导数的可观测典型形式系统。
• 证明表明，当初始误差足够小时，误差能量 $ \tilde{x}^T Q(t) \tilde{x} $ 呈指数衰减，意味着当 $ t \to \infty $ 时 $ \tilde{x}(t) \to 0 $。
• 该方法克服了一个已知反例（例如 $ \dot{x} = x(1 - x^2), y = x^2 - x/2 $）中EKF不收敛的问题，证明在新条件下收敛性成立。
• 对于满足新条件的线性系统，EKF退化为标准卡尔曼滤波器，并实现全局收敛，而不仅限于局部收敛。