北航信号分析与处理中的数学方法课堂作业..doc

EKF EKF：Extended Kalman Filter 的简写，即扩展卡尔曼滤波器。 首先来介绍一下卡尔曼滤波 扩展卡尔曼滤波：卡尔曼最初提出的滤波理论只适用于线性系统,Bucy，Sunahara等人提出并研究了扩展卡尔曼滤波(Extended Kalman Filter，简称EKF)，将卡尔曼滤波理论进一步应用到非线性领域。EKF的基本思想是将非线性系统 线性化，然后进行卡尔曼滤波，因此EKF是一种次优滤波。其后，多种二阶广义卡尔曼滤波方法的提出及应用进一步提高了卡尔曼滤波对非线性系统的估计性能。二阶滤波方法考虑了Taylor级数展开的二次项，因此减少了由于 线性化所引起的 估计误差，但大大增加了运算量，因此在实际中反而没有一阶EKF应用广泛。 EKF的原理： （1） （2） 这里为了便于数学处理，假定没有控制量的输入，并假定过程噪声是均值为零的高斯白噪声，且噪声分布矩阵是已知的。其中，观测噪声也是加性均值为零的高斯白噪声。假定过程噪声和观测噪声序列是彼此独立的，并且有初始状态估计和协方差矩阵。和线性系统的情况一样，我们可以得到扩展Kalman滤波算法如下 （3） （4） （5） （6） （7） 这里需要重要说明的是，状态转移和量测矩阵 是由和的雅克比矩阵代替的。其雅克比矩阵的求法如下： 假如状态变量有n维，即，则对状态方程对各维求偏导， （8） （9） UKF原理如下： 传统的非线性滤波的方法主要是扩展卡尔曼滤波算法( EKF) ,但是该算法存在着精度不高、稳定性差、对目标机动反应迟缓等缺点. 近年来,提出了一种非线性滤波算法- Unscented卡尔曼滤波(UnscentedKalman Filter,即UKF). 它是根据Unscented变化和卡尔曼滤波相结合得到的一种算法. 这种算法主要运用卡尔曼滤波的思想,但是在求解目标后续时刻的预测值和量测值时,则需要应用采样点来计算. UKF通过设计加权点δ,来近似表示n维目标采样点,计算这些δ点经由非线性函数的传播,通过非线性状态方程获得更新后的滤波值 ,从而实现了对目标的跟踪. UKF有效地克服了扩展卡尔曼滤波的估计精度低、稳定性差的缺陷. 无损卡尔曼滤波是一种新型的滤波估计算法。UKF以UT变换为基础，摒弃了对非线性函数进行线性化的传统做法，采用卡尔曼线性滤波框架，对于一步预测方程，使用无迹(UT)变换来处理均值和协方差的非线性传递，就成为UKF算法。 构造sigma点 根据随机向量x的统计量 和，构造sigma点集： K为尺度参数，调整它可以提高精度。用这组采样点可以近似表示状态x的高斯分布。 (2)对sigma点进行非线性变换 对所构造出的点集进行非线性变换，得到变换后的sigma点集： 变换后的点集Yi可近似地表示为的分布。 (3)计算y的均值和方差 对变换后的点集Yi进行加权处理，从而得到输出量y的均值和方差 和分别为计算均值方差的加权： 其中：。在均值和方差加权中需要确定、和的参数。 粒子滤波原理如下： 粒子滤波的思想基于蒙特卡洛方法(Monte Carlo methods)，它是利用粒子集来表示概率，可以用在任何形式的状态空间模型上。其核心思想是通过从后验概率中抽取的随机状态粒子来表达其分布，是一种顺序重要性采样法(Sequential Importance Sampling)。简单来说，粒子滤波法是指通过寻找一组在状态空间传播的随机样本对概率密度函数进行近似，以样本均值代替积分运算，从而获得状态最小方差分布的过程。这里的样本即指粒子,当样本数量N→∝时可以逼近任何形式的概率密度分布。 尽管算法中的概率分布只是真实分布的一种近似，但由于非参数化的特点，它摆脱了解决非线性滤波问题时随机量必须满足高斯分布的制约，能表达比高斯模型更广泛的分布，也对变量参数的非线性特性有更强的建模能力。因此，粒子滤波能够比较精确地表达基于观测量和控制量的后验概率分布，可以用于解决SLAM问题。 ，它仅包含一维变量，即，系统状态方程为 （2-1） 观测方程为 （2-2） 其中，式（1）是包含分式，平方，三角函数在内的严重非线性的方程，为过程噪声，其均值为0，方差为，观测方程中，观测信号与状态的关系也是非线性的，也是均值为0，方差为的高斯白噪声。因此关于（1）和（2-2）是一个状态和观测都为非线性的一维系统。以此为通用的