机动目标跟踪——匀速运动cv模型(代码片段)

脑壳二 脑壳二     2023-03-11     619

关键词:

机动目标跟踪——匀速运动CV模型

原创不易,路过的各位大佬请点个赞

WX: ZB823618313

机动目标跟踪——目标模型概述

1. 对机动目标跟踪的理解

  机动目标跟踪一直是目标跟踪领域研究的难点和重点问题。建立目标运动模型和滤波算法是目标跟踪的两个重要因素。由于目标的机动具有不可预测性,使得我们很难建立精确的目标运动模型。如何建立一种有效的模型来反映目标真实的运动轨迹是高机动目标跟踪系统急需解决的问题。经过近三十年的研究,该领域取得了许多重要成果。

个人理解:机动目标跟踪拥有三要素:

被跟踪目标建模(也是本博客重点)
传感器测量(另一个博客介绍)
滤波器设计(见目标跟踪专栏)

  从算法层面,在目标跟踪系统中,常用的滤波算法是以卡尔曼滤波器为基本框架的估计算法。卡尔曼滤波器是一种线性、无偏、以误差均方差最小为准则的最优估计算法,它有精确的数学形式和优良的使用效能。卡尔曼滤波方法实质上是一种数据处理方法,它采用递推滤波方法,根据获取的量测数据由递推方程递推给出新的状态估计。由于计算量和存储量小,比较容易满足实时计算的要求,在工程实践中得到广泛应用。
  除此之外,非线性滤波也广泛应用与机动目标跟踪,比如:

扩展卡尔曼滤波EKF
无迹卡尔曼滤波UKF
容积卡尔曼滤波CKF
求积卡尔曼滤波QKF
中心差分卡尔曼滤波CDKF
Divided difference filter DDF
高斯混合滤波GSF
强跟踪滤波STF
粒子滤波PF
… …

2. 目标模型概述

  机动目标模型描述了目标状态随着时间变化的过程。一个好的模型抵得上大量的数据。当前几乎所有的目标跟踪算法都是基于模型进行状态估计的。在卡尔曼滤波器被引入目标跟踪领域后,基于状态空间的机动目标建模成为主要研究对象之一。

  1. 目标的空间运动基于不同的运动轨迹和坐标系
    一维运动
    二维运动
    三维运动

  2. 根据不同方向的运动是否相关
    坐标间不耦合模型
    坐标间耦合模型

坐标间不耦合模型: 这类模型假设三维空间三个正交方向上的目标机动过程不耦合。目标机动是飞行器受到外力作用而使得加速度变化所致,所以对机动建模的难点在于对目标加速度的描述。对于无机动目标,常速(Constant Velocity,CV〉模型常用于描述这类目标的运动,而常加速度(Constant Acceleration,CA)模型则常用于描述加速度趋近常数的机动目标的运动。

坐标间耦合模型: 坐标间耦合模型绝大多数情况下指的是转弯运动模型。由于此类模型与坐标密切相关,所以可以分为两类:二维转弯模型和三维转弯模型。二维转弯模型又称为平面转弯模型,即CT模型。

下面讲机动目标不同的模型:

3. 机动目标模型

3.1 匀速运动CV模型

匀速运动模型用来匹配目标做匀速直线运动的情况,这也是目标运动最简单的情况.
其中匀速运动模型包括:

一维匀速运动CV 模型

二维匀速运动CV 模型
三维匀速运动CV 模型

3.1.1 一维匀速运动CV 模型

由于目标做匀速直线运动,则目标加速度为0。实际情况中,速度至少要轻微的变化,则加速度常常看做是具有随机特性的扰动输入,可用连续时间的白噪声来建模,并假设其服从均值为零,方差为的高斯分布,即
X ¨ ( t ) = W ( t ) \\ddotX(t)=W(t) X¨(t)=W(t)
其中 W ( t ) W(t) W(t)零均值白高斯噪声最为普遍。

一维匀速运动模型(连续):
目标状态为:位置和速度、即 X = [ x , x ˙ ] T X=[x, \\dotx]^T X=[x,x˙]T

CV模型为:
X ˙ ( t ) = [ 0 1 0 0 ] X ( t ) + [ 0 1 ] W ( t ) \\dotX(t)=\\beginbmatrix0&1\\\\0&0\\endbmatrixX(t) + \\beginbmatrix0\\\\1\\endbmatrixW(t) X˙(t)=[0010]X(t)+[01]W(t)

离散化上述模型:

一维匀速运动模型(离散):
X k + 1 = [ 1 T 0 1 ] X k + [ T 2 / 2 T ] W k X_k+1=\\beginbmatrix1&T\\\\0&1\\endbmatrixX_k + \\beginbmatrixT^2/2\\\\T\\endbmatrixW_k Xk+1=[10T1]Xk+[T2/2T]Wk
T T T为采样时间。

一维匀速运动CV目标航迹如下:

代码

%% 一维匀速CV运动目标轨迹       
clc;
clear all;
close all;
n=2; % state dimension : 6
T=1; % sample time.
N=100; %the runs atime,跟踪总时长
w_mu=[0]';
%% target model
q=3; % 目标运动学标准差,过程噪声
Qk=q^2*eye(1);% cov. of process noise
% state matrix
Fk= [1 T
     0 T ]; %
 Gk= [ T^2/2  
       T      
       ]; %
   
   
% 
%% define parameter
sV=zeros(n,N,1,1); % state
x=[1000,20]';
P_0=diag([1e5,10^2]); 

x0=mvnrnd(x,P_0); % 初始状态
%x0=(x+normrnd(0,0.001)')';
x=x0';
for k=1:N
   %% %%%%%%% target model %%%%%%%%%%%%%%%%%%%%
   %% 目标运动学模型(被跟踪目标建模),匀速运动CV模型
    w=mvnrnd(w_mu',Qk)';%过程噪声方差
    x=Fk*x+Gk*w;
    sV(:,k,1,1)=x;

end
% 一维匀速CV运动目标轨迹 
ii=1:N;
figure
plot(ii,sV(1,:,1,1),'-*r','LineWidth',1)
grid on
xlabel('时间(s)');ylabel('m');
legend('真实轨迹')
title('一维维匀速运动目标轨迹')




利用扩展卡尔曼滤波EKF跟踪上面的一维匀速运动目标,跟踪轨迹如下

3.1.2 二维匀速运动CV 模型

二维匀速运动模型(连续):
目标状态为:x维位置和速度、y维位置速度、即 X = [ x , x ˙ , y , y ˙ ] T X=[x, \\dotx,y, \\doty]^T X=[x,x˙y,y˙]T

CV模型为:
X ˙ ( t ) = [ 0 1 0 0 0 0 0 0 0 0 0 1 0 0 0 0 ] X ( t ) + [ 0 0 1 0 0 0 0 1 ] W ( t ) \\dotX(t)=\\beginbmatrix0&1&0&0\\\\0&0&0&0\\\\0&0&0&1\\\\0&0&0&0 \\endbmatrixX(t) + \\beginbmatrix0&0\\\\1&0\\\\0&0\\\\0&1\\endbmatrixW(t) X˙(t)=0000100000000010X(t)+01000001W(t)

离散化上述模型:

二维匀速运动模型(离散):
X k + 1 = [ 1 T 0 0 0 1 0 0 0 0 1 T 0 0 0 1 ] X k + [ T 2 / 2 0 T 0 0 T 2 / 2 0 T ] W k X_k+1=\\beginbmatrix1&T&0&0\\\\0&1&0&0\\\\0&0&1&T\\\\0&0&0&1 \\endbmatrixX_k + \\beginbmatrixT^2/2&0\\\\T&0\\\\0&T^2/2\\\\0&T\\endbmatrixW_k Xk+1=1000T100001000T1Xk+机动目标跟踪——当前统计模型(cs模型)(代码片段)

机动目标跟踪——当前统计模型(CS模型)原创不易,路过的各位大佬请点个赞针对机动目标跟踪的探讨、技术支持欢迎联系,也可以站内私信WX:ZB823618313机动目标跟踪——当前统计模型(CS模型)机动目标... 查看详情

机动目标跟踪—匀速转弯ct模型/匀速圆周运动

机动目标跟踪—匀速转弯CT模型/匀速圆周运动原创不易,路过的各位大佬请点个赞针对机动目标跟踪的探讨、技术支持欢迎联系,也可以站内私信WX:ZB823618313机动目标跟踪—匀速转弯CT模型/匀速圆周运动机动目标跟踪—匀... 查看详情

机动目标跟踪——匀加速运动模型(三维)

机动目标跟踪——匀加速运动模型(三维)原创不易,路过的各位大佬请点个赞WX:ZB823618313机动目标跟踪——目标模型概述机动目标跟踪——匀加速运动模型(三维)1.对机动目标跟踪的理解2.目标模型概述3.连... 查看详情

机动目标跟踪——匀加速运动ca模型(二维)

机动目标跟踪——匀加速运动CA模型(二维)原创不易,路过的各位大佬请点个赞WX:ZB823618313机动目标跟踪——目标模型概述机动目标跟踪——匀加速运动CA模型(二维)1.对机动目标跟踪的理解2.目标模型概述3.连续匀加速运动CA模... 查看详情

运动学基于matlabsinger模型算法机动目标跟踪含matlab源码1157期(代码片段)

一、简介目标跟踪是利用各种类型的传感器获得的关于目标信息,对目标的真实状态以及未来的状态进行估计和预测的一门技术。目标跟踪技术在军事以及民用等诸多领域里都有着广泛的应用。随着电子技术以及计算机技术... 查看详情

机动目标跟踪——jerk模型

机动目标跟踪——Jerk模型原创不易,路过的各位大佬请点个赞WX:ZB823618313机动目标跟踪——Jerk模型机动目标跟踪——Jerk模型1.对机动目标跟踪的理解1.1.对机动目标跟踪的理解1.2.目标模型概述2.一维Jerk模型2.1.Jerk模型(连... 查看详情

目标运动模型——匀速运动cv(代码片段)

目标运动模型-——匀速运动CV原创不易,路过的各位大佬请点个赞WX:ZB823618313目标运动模型-——匀速运动CV目标运动模型-——匀速运动CV1.目标模型概述2.目标运动模型2.1匀速运动CV模型2.1.1一维匀速运动CV模型2.1.2二维匀速运... 查看详情

机动目标运动分析——imm篇(代码片段)

目录1.交互式多模型算法1.1交互式多模型算法介绍1.2交互式多模型算法流程1.3交互式多模型算法仿真分析2.参考文献1.交互式多模型算法1.1交互式多模型算法介绍交互式多模型算法(InteractingMultipleModel,IMM)是由Blom和Bar-shalo... 查看详情

机动目标跟踪—当前统计模型(cs模型)扩展卡尔曼滤波/无迹卡尔曼滤波matlab实现(代码片段)

机动目标跟踪——当前统计模型(CS模型)扩展卡尔曼滤波/无迹卡尔曼滤波matlab实现原创不易,路过的各位大佬请点个赞针对机动目标跟踪的探讨、技术支持欢迎联系,也可以站内私信WX:ZB823618313机动目标跟踪—... 查看详情

交互式多模型-无迹卡尔曼滤波imm-ukf——cv/ct/ca模型交互机动目标跟踪(模型维数不同imm算法设计)

交互式多模型-无迹卡尔曼滤波IMM-UKF——CV/CT/CA模型交互机动目标跟踪(模型维数不同IMM算法设计)原创不易,路过的各位大佬请点个赞针对机动目标跟踪的探讨、技术支持欢迎联系,也可以站内私信WX:ZB823618313交... 查看详情

交互式多模型-无迹卡尔曼滤波imm-ukf——cv/ct/ca模型交互机动目标跟踪(模型维数不同imm算法设计)

交互式多模型-无迹卡尔曼滤波IMM-UKF——CV/CT/CA模型交互机动目标跟踪(模型维数不同IMM算法设计)原创不易,路过的各位大佬请点个赞针对机动目标跟踪的探讨、技术支持欢迎联系,也可以站内私信WX:ZB823618313交... 查看详情

机动目标跟踪——jerk模型

机动目标跟踪——Jerk模型原创不易,路过的各位大佬请点个赞针对机动目标跟踪的探讨、技术支持欢迎联系,也可以站内私信WX:ZB823618313机动目标跟踪——Jerk模型机动目标跟踪——Jerk模型1.对机动目标跟踪的理解1.1.对机... 查看详情

机动目标跟踪——singer模型

机动目标跟踪——Singer模型原创不易,路过的各位大佬请点个赞WX:ZB823618313机动目标跟踪——Singer模型机动目标跟踪——Singer模型1.对机动目标跟踪的理解1.1.对机动目标跟踪的理解1.2.目标模型概述2.一维Singer模型2.1.Singer模型&... 查看详情

交互式多模型-扩展卡尔曼滤波imm-ekf——机动目标跟踪中的应用

交互式多模型-扩展卡尔曼滤波IMM-EKF——机动目标跟踪中的应用原创不易,路过的各位大佬请点个赞针对机动目标跟踪的探讨、技术支持欢迎联系,也可以站内私信WX:ZB823618313机动目标跟踪——交互式多模型算法IMM交互式... 查看详情

#粒子滤波pf——三维匀速运动cv目标跟踪(粒子滤波vs扩展卡尔曼滤波)

粒子滤波PF——三维匀速运动CV目标跟踪(粒子滤波VS扩展卡尔曼滤波)对于该博客跟踪代码以及问题探讨可以联系:WX:ZB823618313对于其他跟踪定位问题的代码及探讨也可以联系原创不易,路过的各位大佬请点... 查看详情

#粒子滤波pf——三维匀速运动cv目标跟踪(粒子滤波vs扩展卡尔曼滤波)

粒子滤波PF——三维匀速运动CV目标跟踪(粒子滤波VS扩展卡尔曼滤波)对于该博客跟踪代码以及问题探讨可以联系:WX:ZB823618313对于其他跟踪定位问题的代码及探讨也可以联系原创不易,路过的各位大佬请点... 查看详情

交互式多模型-无迹卡尔曼滤波imm-ukf仿真一——机动目标跟踪中的应用

交互式多模型-无迹卡尔曼滤波IMM-UKF仿真一——机动目标跟踪中的应用原创不易,路过的各位大佬请点个赞针对机动目标跟踪的探讨、技术支持欢迎联系,也可以站内私信WX:ZB823618313机动目标跟踪——交互式多模型算法IMM... 查看详情

交互式多模型算法imm——机动目标跟踪中的应用

机动目标跟踪——交互式多模型算法IMM原创不易,路过的各位大佬请点个赞WX:ZB823618313机动目标跟踪——交互式多模型算法IMM机动目标跟踪——交互式多模型算法IMM1.对机动目标跟踪的理解2.机动目标跟踪方法概述3.交互式多... 查看详情