企业官网建设流程全解析

导航网站怎么推广,湖北公众号定制开发,义乌网络,怎样做网店生意在《跟踪导论#xff08;六#xff09;》中阐述了卡尔曼滤波的基本定义和三大关键参数#xff1a;卡尔曼增益 k {\bf{k}} k、预测均方误差 M {\bf{M}} M、状态转移矩阵 F {\bf{F}} F释义的理解。基本定义如公式#xff08;1#xff09;所示。其中 x ^ [ n ] {\bf{\hat x}}…在《跟踪导论六》中阐述了卡尔曼滤波的基本定义和三大关键参数卡尔曼增益k {\bf{k}}k、预测均方误差M {\bf{M}}M、状态转移矩阵F {\bf{F}}F释义的理解。基本定义如公式1所示。其中x ^ [ n ] {\bf{\hat x}}\left[ n \right]x^[n]表示卡尔曼滤波后的状态估计值、x ~ [ n ] {\bf{\tilde x}}\left[ n \right]x~[n]表示状态观测值、x ˙ [ n ] {\bf{\dot x}}\left[ n \right]x˙[n]表示状态预测值。状态包含位置和速度。x ^ [ n ] x ˙ [ n ] k ( x ~ [ n ] − x ˙ [ n ] ) 1 {\bf{\hat x}}\left[ n \right] {\bf{\dot x}}\left[ n \right] {\bf{k}}\left( {{\bf{\tilde x}}\left[ n \right] - {\bf{\dot x}}\left[ n \right]} \right)1x^[n]x˙[n]k(x~[n]−x˙[n])1但是三大参数是如何动态迭代的呢迭代的过程中卡尔曼滤波是如何逼近客观真实的呢这个就必须揭开各参数之间联动的真相了。在《跟踪导论六》中已经阐述了卡尔曼增益k {\bf{k}}k与预测均方误差M {\bf{M}}M的联动关系即k [ n ] M [ n ] σ w [ n ] 2 M [ n ] 2 {\bf{k}}\left[ n \right] {{{\bf{M}}\left[ n \right]} \over {\sigma _{{\bf{w}}\left[ n \right]}^2 {\bf{M}}\left[ n \right]}}2k[n]σw[n]2​M[n]M[n]​2这个联动关系表达的物理逻辑即当预测均方误差M [ n ] {\bf{M}}\left[ n \right]M[n]过大时状态预测值x ˙ [ n ] {\bf{\dot x}}\left[ n \right]x˙[n]不太可信了此时卡尔曼增益k [ n ] {\bf{k}}\left[ n \right]k[n]将随之变大公式1中的状态估计值x ^ [ n ] {\bf{\hat x}}\left[ n \right]x^[n]将更依赖于观测值x ~ [ n ] {\bf{\tilde x}}\left[ n \right]x~[n]使之对状态预测值x ˙ [ n ] {\bf{\dot x}}\left[ n \right]x˙[n]进行修正当预测均方误差M [ n ] {\bf{M}}\left[ n \right]M[n]很小时状态预测值x ˙ [ n ] {\bf{\dot x}}\left[ n \right]x˙[n]可信度高此时卡尔曼增益k [ n ] {\bf{k}}\left[ n \right]k[n]将随之变小公式1中的状态估计值x ^ [ n ] {\bf{\hat x}}\left[ n \right]x^[n]将更依赖于状态预测值x ˙ [ n ] {\bf{\dot x}}\left[ n \right]x˙[n]从而减少状态观测值x ~ [ n ] {\bf{\tilde x}}\left[ n \right]x~[n]对状态预测值x ˙ [ n ] {\bf{\dot x}}\left[ n \right]x˙[n]的修正比例。这个联动关系的物理逻辑是十分直观的那么预测均方误差M {\bf{M}}M与状态转移矩阵F {\bf{F}}F的联动关系又是怎样的呢一、预测均方误差M {\bf{M}}M与状态转移矩阵F {\bf{F}}F的联动真相回顾《跟踪导论六》中阐述的状态转移矩阵F {\bf{F}}F的物理意义是根据目标的运动状态用上一时刻的状态估计值x ^ [ n − 1 ] {\bf{\hat x}}\left[ {n - 1} \right]x^[n−1]对当下时刻状态预测值x ˙ [ n ] {\bf{\dot x}}\left[ n \right]x˙[n]进行预测的数学模型即x ˙ [ n ] F ⋅ x ^ [ n − 1 ] 3 {\bf{\dot x}}\left[ n \right] {\bf{F}} \cdot {\bf{\hat x}}\left[ {n - 1} \right]3x˙[n]F⋅x^[n−1]3因此根据预测均方误差M {\bf{M}}M的物理来源可知当下时刻的预测均方误差M {\bf{M}}M应该也可以由状态转移矩阵F {\bf{F}}F和过程噪声q {\bf{q}}q得到。过程噪声q {\bf{q}}q是预测阶段独有的干扰比如跟踪无人机时气流的随机扰动会让无人机偏离预期轨迹再比如雷达设备本身的电路噪声会在基于历史数据推算预测值时悄悄叠加微小偏差。因此表面上预测均方误差M {\bf{M}}M与状态转移矩阵F {\bf{F}}F的联动关系可表述为M [ n ] F ⋅ M [ n − 1 ] ⋅ F T g ⋅ q ⋅ g T 4 {\bf{M}}\left[ n \right] {\bf{F}} \cdot {\bf{M}}\left[ {n - 1} \right] \cdot {{\bf{F}}^T} {\bf{g}} \cdot {\bf{q}} \cdot {{\bf{g}}^T}4M[n]F⋅M[n−1]⋅FTg⋅q⋅gT4然而这里有一个关键问题即M {\bf{M}}M的本质是雷达在当下时刻t n {t_n}tn​的预测均方误差而状态转移矩阵F {\bf{F}}F和过程噪声q {\bf{q}}q都是以雷达探测时自己设定的目标运动模型来进行构建的也就是说目标在运动过程中改变了运动模型那么其由不变的状态转移矩阵F {\bf{F}}F和过程噪声q {\bf{q}}q表征当下时刻t n {t_n}tn​预测均方误差M {\bf{M}}M的逻辑就不能完全成立其必然会引来因目标当下运动状态改变而导致的更大误差。因此实际上F ⋅ M [ n − 1 ] ⋅ F T g ⋅ q ⋅ g T {\bf{F}} \cdot {\bf{M}}\left[ {n - 1} \right] \cdot {{\bf{F}}^T} {\bf{g}} \cdot {\bf{q}} \cdot {{\bf{g}}^T}F⋅M[n−1]⋅FTg⋅q⋅gT并不能完全表征雷达在当下时刻的预测均方误差其仍然是一种预测状态即根据上一时刻t n − 1 {t_{n - 1}}tn−1​的运动模型确定的状态转移矩阵F {\bf{F}}F和过程噪声q {\bf{q}}q来预测的当下时刻的预测均方误差M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]。因此公式4应改为M ˙ [ n ] F ⋅ M ^ [ n − 1 ] ⋅ F T g ⋅ q ⋅ g T 5 {\bf{\dot M}}\left[ n \right] {\bf{F}} \cdot {\bf{\hat M}}\left[ {n - 1} \right] \cdot {{\bf{F}}^T} {\bf{g}} \cdot {\bf{q}} \cdot {{\bf{g}}^T}5M˙[n]F⋅M^[n−1]⋅FTg⋅q⋅gT5二、卡尔曼增益k {\bf{k}}k与预测均方误差M {\bf{M}}M的联动真相根据上面的阐述公式2应表示为k [ n ] M ˙ [ n ] σ w [ n ] 2 M [ n ] 6 {\bf{k}}\left[ n \right] {{{\bf{\dot M}}\left[ n \right]} \over {\sigma _{{\bf{w}}\left[ n \right]}^2 {\bf{M}}\left[ n \right]}}6k[n]σw[n]2​M[n]M˙[n]​6公式6将公式2中的分子M [ n ] {\bf{M}}\left[ n \right]M[n]换成了M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]但分母没有替换这是因为分母中的σ w [ n ] 2 \sigma _{{\bf{w}}\left[ n \right]}^2σw[n]2​仍是雷达无法观测到的一个值而σ w [ n ] 2 \sigma _{{\bf{w}}\left[ n \right]}^2σw[n]2​和M [ n ] {\bf{M}}\left[ n \right]M[n]共同组成了另一个雷达可观测的值这点我们放在后面阐述。这里就有两个预测“预测均方误差M {\bf{M}}M”一词中的预测是指这个变量M {\bf{M}}M的含义是表征状态预测值x ˙ {\bf{\dot x}}x˙与状态客观真实值x {\bf{x}}x的均方误差M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]变量中含有的预测是指M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]变量不是精准表征状态预测值x ˙ {\bf{\dot x}}x˙与状态客观真实值x {\bf{x}}x的均方误差而是这个值是根据雷达自身设定的目标运动状态进行预测得到的。两个预测之间的关系示意图如图1所示也就是说我们在当下时刻得到的预测均方误差M ^ [ n − 1 ] {\bf{\hat M}}\left[ {n - 1} \right]M^[n−1]并不能表征我们设定的状态转移矩阵F {\bf{F}}F和过程噪声q {\bf{q}}q与客观真实之间的差距而状态转移矩阵F {\bf{F}}F和过程噪声q {\bf{q}}q与客观真实之间的差距是我们对目标运动状态估计得准与不准之间的重要反映通过公式6可知只有让预测均方误差尽量准确地逼近真实均方误差才能得到尽量符合客观现实的卡尔曼滤波增益k {\bf{k}}k也就是对观测值和预测值进行符合客观事实的信任。当然在当下时刻t n {t_n}tn​我们只能通过公式5得到由上一时刻设定的运动模型预测得到的预测均方误差M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]也就只能用这个预测均方误差M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]计算卡尔曼滤波增益k [ n ] {\bf{k}}\left[ n \right]k[n]公式6但是在我们获取了当下时刻的最新观测值x ~ [ n ] {\bf{\tilde x}}\left[ n \right]x~[n]后我们就可以通过最新的观测值来修正我们之前通过设定的运动模型预测得到的预测均方误差M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]从而得到更靠近客观真实情况的预测均方误差M ^ [ n ] {\bf{\hat M}}\left[ n \right]M^[n]。图1 根据设定运动状态预测和根据客观真实运动状态预测均方误差示意图如何利用最新的观测值x ~ [ n ] {\bf{\tilde x}}\left[ n \right]x~[n]来修正我们之前通过设定的运动模型预测得到的预测均方误差M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]呢这里我们来观察公式2中的分母即σ w [ n ] 2 M [ n ] \sigma _{{\bf{w}}\left[ n \right]}^2 {\bf{M}}\left[ n \right]σw[n]2​M[n]。观测噪声功率σ w [ n ] 2 \sigma _{{\bf{w}}\left[ n \right]}^2σw[n]2​观测噪声功率σ w [ n ] 2 \sigma _{{\bf{w}}\left[ n \right]}^2σw[n]2​表征的是观测值x ~ [ n ] {\bf{\tilde x}}\left[ n \right]x~[n]与客观真实值x [ n ] {\bf{x}}\left[ n \right]x[n]之间的均方误差而预测均方误差M [ n ] {\bf{M}}\left[ n \right]M[n]表征的是预测值x ˙ [ n ] {\bf{\dot x}}\left[ n \right]x˙[n]与客观真实值x [ n ] {\bf{x}}\left[ n \right]x[n]之间的均方误差因此可以知道观测值x ~ [ n ] {\bf{\tilde x}}\left[ n \right]x~[n]与预测值x ˙ [ n ] {\bf{\dot x}}\left[ n \right]x˙[n]之间的均方误差可以抽象地等效于观测值x ~ [ n ] {\bf{\tilde x}}\left[ n \right]x~[n]与客观真实值x [ n ] {\bf{x}}\left[ n \right]x[n]之间的均方误差加上预测值x ˙ [ n ] {\bf{\dot x}}\left[ n \right]x˙[n]与客观真实值x [ n ] {\bf{x}}\left[ n \right]x[n]之间的均方误差即σ ~ 2 σ w [ n ] 2 M [ n ] {\tilde \sigma ^2} \sigma _{{\bf{w}}\left[ n \right]}^2 {\bf{M}}\left[ n \right]σ~2σw[n]2​M[n]表征的是观测值x ~ [ n ] {\bf{\tilde x}}\left[ n \right]x~[n]与预测值x ˙ [ n ] {\bf{\dot x}}\left[ n \right]x˙[n]之间的均方误差。而观测值x ~ [ n ] {\bf{\tilde x}}\left[ n \right]x~[n]和预测值x ˙ [ n ] {\bf{\dot x}}\left[ n \right]x˙[n]都是雷达可观测到的值。也就是说公式6在计算时分子用的是通过设定的运动模型预测得到的预测均方误差M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]而分母用的是实际观测值x ~ [ n ] {\bf{\tilde x}}\left[ n \right]x~[n]与预测值x ˙ [ n ] {\bf{\dot x}}\left[ n \right]x˙[n]的均方误差。此时我们观察公式6可知若我们通过设定的运动模型预测得到的预测均方误差M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]小于由真实运动模型预测得到的预测均方误差M [ n ] {\bf{M}}\left[ n \right]M[n]M ˙ [ n ] M [ n ] {\bf{\dot M}}\left[ n \right] {\bf{M}}\left[ n \right]M˙[n]M[n]我们对误差的预测过于乐观那么观测值实际观测值x ~ [ n ] {\bf{\tilde x}}\left[ n \right]x~[n]与预测值x ˙ [ n ] {\bf{\dot x}}\left[ n \right]x˙[n]的均方误差σ ~ 2 σ w [ n ] 2 M [ n ] σ w [ n ] 2 M ˙ [ n ] {\tilde \sigma ^2} \sigma _{{\bf{w}}\left[ n \right]}^2 {\bf{M}}\left[ n \right] \sigma _{{\bf{w}}\left[ n \right]}^2 {\bf{\dot M}}\left[ n \right]σ~2σw[n]2​M[n]σw[n]2​M˙[n]就会偏大此时卡尔曼滤波增益k {\bf{k}}k就会偏小若我们通过设定的运动模型预测得到的预测均方误差M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]大于由真实运动模型预测得到的预测均方误差M [ n ] {\bf{M}}\left[ n \right]M[n]M ˙ [ n ] M [ n ] {\bf{\dot M}}\left[ n \right] {\bf{M}}\left[ n \right]M˙[n]M[n]我们对误差的预测过于悲观那么观测值实际观测值x ~ [ n ] {\bf{\tilde x}}\left[ n \right]x~[n]与预测值x ˙ [ n ] {\bf{\dot x}}\left[ n \right]x˙[n]的均方误差σ ~ 2 σ w [ n ] 2 M [ n ] σ w [ n ] 2 M ˙ [ n ] {\tilde \sigma ^2} \sigma _{{\bf{w}}\left[ n \right]}^2 {\bf{M}}\left[ n \right] \sigma _{{\bf{w}}\left[ n \right]}^2 {\bf{\dot M}}\left[ n \right]σ~2σw[n]2​M[n]σw[n]2​M˙[n]就会偏小那我们得到的卡尔曼滤波增益k [ n ] {\bf{k}}\left[ n \right]k[n]就偏大如图2所示。图2 卡尔曼滤波增益的大小随预测均方误差偏差情况变化而变化示意图那么此时我们就可以用卡尔曼滤波增益的值k [ n ] {\bf{k}}\left[ n \right]k[n]的反面来对预测均方误差M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]进行修正和制约让预测均方误差M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]偏大的时候经过修正则减小在预测均方误差M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]偏小的时候经过修正则增大从而达到收敛。那么要用卡尔曼滤波增益的值k [ n ] {\bf{k}}\left[ n \right]k[n]的反面来对预测均方误差M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]进行修正的最直观的方式即M ^ [ n ] ( I − k [ n ] ) M ˙ [ n ] 7 {\bf{\hat M}}\left[ n \right] \left( {{\bf{I}} - {\bf{k}}\left[ n \right]} \right){\bf{\dot M}}\left[ n \right]7M^[n](I−k[n])M˙[n]7如此我们便得到了卡尔曼滤波算法各参数之间的所有联动关系M ˙ [ n ] F ⋅ M ^ [ n − 1 ] ⋅ F T g ⋅ q ⋅ g T 8 {\bf{\dot M}}\left[ n \right] {\bf{F}} \cdot {\bf{\hat M}}\left[ {n - 1} \right] \cdot {{\bf{F}}^T} {\bf{g}} \cdot {\bf{q}} \cdot {{\bf{g}}^T}8M˙[n]F⋅M^[n−1]⋅FTg⋅q⋅gT8k [ n ] M ˙ [ n ] σ w [ n ] 2 M ˙ [ n ] ( σ ~ 2 σ w [ n ] 2 ) 9 {\bf{k}}\left[ n \right] {{{\bf{\dot M}}\left[ n \right]} \over {\sigma _{{\bf{w}}\left[ n \right]}^2 {\bf{\dot M}}\left[ n \right]}}\left( {{{\tilde \sigma }^2} \sigma _{{\bf{w}}\left[ n \right]}^2} \right)9k[n]σw[n]2​M˙[n]M˙[n]​(σ~2σw[n]2​)9M ^ [ n ] ( I − k [ n ] ) M ˙ [ n ] 10 {\bf{\hat M}}\left[ n \right] \left( {{\bf{I}} - {\bf{k}}\left[ n \right]} \right){\bf{\dot M}}\left[ n \right]10M^[n](I−k[n])M˙[n]10观察该公式状态转移矩阵F {\bf{F}}F与过程噪声状态转移矩阵q {\bf{q}}q均是由根据雷达自身设定的目标运动状态模型构建的独立于目标的真实运动状态和每一时刻的观测值但是状态转移矩阵F {\bf{F}}F与过程噪声状态转移矩阵q {\bf{q}}q是否与目标真实运动状态贴合会作用在预测均方误差M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]上而预测均方误差M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]的准确与否会表征在观测值与预测值的差距上。因此利用观测值与预测值的均方误差σ ~ 2 {\tilde \sigma ^2}σ~2构建了卡尔曼滤波增益k [ n ] {\bf{k}}\left[ n \right]k[n]与预测均方误差M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]之间的关系使得卡尔曼滤波增益k [ n ] {\bf{k}}\left[ n \right]k[n]的大小会随着预测均方误差M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]的偏差而改变从而利用卡尔曼滤波增益k [ n ] {\bf{k}}\left[ n \right]k[n]不断修正和约束预测均方误差M ˙ [ n ] {\bf{\dot M}}\left[ n \right]M˙[n]使之紧紧贴合目标真实的运动状态而不断修正。整个过程中雷达只需设定好目标运动模型、从而确定状态转移矩阵F {\bf{F}}F与过程噪声状态转移矩阵q {\bf{q}}q就可利用每一时刻的观测值不断修正因设定的目标运动模型和目标真实运动模型不同带来的滤波误差。这就是卡尔曼滤波的核心要以。