09_卡尔曼滤波器的应用介绍.pptVIP

* * 2.5.1卡尔曼滤波器在雷达跟踪系统中的应用 2.5.1卡尔曼滤波器在雷达跟踪系统中的应用 1.雷达跟踪原理运动方程 利用飞行目标对雷达发射脉冲的反射, 根据回波脉冲与发射脉冲的时间间隔,确定目标的径向距离,方位角和速度等状态参数,从而达到跟踪目标的目的. 设 时刻,目标距离 , 径向速度 ;方位角 , 方位角速度 ;其中, 表示平均距离, 表示距离偏离量. 经过 秒后, 到达时刻 , 目标的上述参数相应为： 距离 , 径向速度 ;方位角 , 方位角速度 ; 若 不是太大, 则有下列近似的距离方程和方位角方程: 2.5.1卡尔曼滤波器在雷达跟踪系统中的应用 另设目标的径向加速度和方位角加速度为 和 , 则经过 秒后,目标的径向速度和方位角速度的变化量分别为 2.5.21a 或 2.5.21b 径向速度和方位角速度的变化通常是由于大气扰动或发动机引擎拉力瞬时变化引起的. 下面的分析中,假定 和 都是零均值平稳白噪声,即满足 和 的方差分别为 2.5.1卡尔曼滤波器在雷达跟踪系统中的应用 2.卡尔曼滤波信号模型的状态方程 引入状态变量: 于是式 2.5.20 和 2.5.21 表示的四个方程可表示为 2.5.22 2.5.23 2.5.24 2.5.25 写成矩阵形式 2.5.1卡尔曼滤波器在雷达跟踪系统中的应用 由此得到卡尔曼滤波信号模型的状态方程 2.5.26 其中 2.5.27 2.5.28 2.5.29 2.5.1卡尔曼滤波器在雷达跟踪系统中的应用 的自相关函数 2.5.30 3.量测方程 设雷达天线每 秒旋转一周, 并对目标的距离和方位角进行一次测量, 测量噪声 即距离和方位角观测偏差 分别用 和 表示,得到测量方程为 2.5.31 2.5.32 其中, 和 是零均值高斯白噪声,方差分别为 和 . 以上二式给出距离和方位角的估计值. 写成矢量矩阵形式 2.5.33 2.5.1卡尔曼滤波器在雷达跟踪系统中的应用 其中 2.5.34 2.5.35 2.5.36 由式 2.5.35 可求出 的自相关函数 2.5.37 4.卡尔曼滤波 按以下矢量卡尔曼滤波递推公式进行迭代运算: 2.5.38a 2.5.38b 2.5.38c 2.5.38d 2.5.1卡尔曼滤波器在雷达跟踪系统中的应用 为了进行卡尔曼滤波, 需要确定加权系数矩阵G n 的 初值.为此,应采用适当方法先确定均方误差矢量 的初始值. 根据雷达接收到的相邻两个回波脉冲, 可以测得目标在初始时刻 和 的四个数据: 距离观测数据: 和 ; 方位角观测数据: 和 . 为求误差矢量初值 ,需分别计算 和 ,故先作如下估计: 2.5.39 由测量方程[式 2.5.33 ]可得 2.5.1卡尔曼滤波器在雷达跟踪系统中的应用 2.5.40 2.5.41 将以上二式结果代入式 2.5.39 , 得 2.5.42 2.5.1卡尔曼滤波器在雷达跟踪系统中的应用 另由状态方程[式 2.5.26 ],并考虑到式 2.5.22 和 2.5.24 , 得 2.5.43 因此, 2.5.1卡尔曼滤波器在雷达跟踪系统中的应用 由上式, 可根据定义确定均方误差 的初始值为 其中, 和 通常是给定的,因而可计算 值.为了得到 值, 需指定 和 的方差 和 . 2.5.1卡尔曼滤波器在雷达跟踪系统中的应用 为简单起见, 假定在各个方向上, 加速度 [包括径 向加速度 和方位角加速度 ]服从均匀分布, 在 范围内, 其概率密度函数 因此, 加速度方差 由于 ; ,于是可求得 2.5.1卡尔曼滤波器在雷达跟踪系统中的应用 5.举例 设 km,雷达天线旋转同期 s,目标最大加速度 2.1m/s2.雷达测距误差均方根值等于1 km, ? 10m; 雷达方位角测量误差均方根值等于 或0.017弧度. 由 和 可算出矩阵 ;由 可算出: ， 一.迭代计算 , 和 : （1）求得 的初始值: （2）由 计算 : 2.5.1卡尔曼滤波器在雷达跟踪系统中的应用 （3）由 计算 : （4）由 和 计算 : 再返回步骤 2 ,确良迭代计算下一时刻的 , ? 二.迭代计算 : 2.5.1卡尔曼滤波器在雷达跟踪系统中的应用 图2.5.3 根据测量