在目标跟踪领域,准确描述目标运动规律是实现精准跟踪的前提。CV(匀速)、CA(匀加速)、CT(协调转弯)模型作为最基础的运动模型,通过对目标加速度、角速度等动力学特性的假设,构建了状态空间的数学表达,是卡尔曼滤波、粒子滤波等算法的核心输入。其核心价值在于:
目标作匀速直线运动,加速度恒为零,适用于短时间内运动状态稳定的场景。
状态向量(二维场景):
X ( k ) = [ x ( k ) x ˙ ( k ) y ( k ) y ˙ ( k ) ] T X(k) = \begin{bmatrix} x(k) & \dot{x}(k) & y(k) & \dot{y}(k) \end{bmatrix}^T X(k)=[x(k)x˙(k)y(k)y˙(k)]T
状态转移方程:
X ( k ) = A ⋅ X ( k − 1 ) X(k) = A \cdot X(k-1) X(k)=A⋅X(k−1)
其中,状态转移矩阵(采样时间间隔为 Δ t \Delta t Δt):
A = [ 1 Δ t 0 0 0 1 0 0 0 0 1 Δ t 0 0 0 1 ] A = \begin{bmatrix} 1 & \Delta t & 0 & 0 \\ 0 & 1 & 0 & 0 \\ 0 & 0 & 1 & \Delta t \\ 0 & 0 & 0 & 1 \\ \end{bmatrix} A= 1000Δt100001000Δt1
未建模加速度,对急加速 / 减速目标跟踪误差显著。
目标加速度为随机过程(通常假设为零均值白噪声驱动的一阶马尔可夫过程),适用于加速度缓慢变化的场景。
状态向量(二维场景):
X ( k ) = [ x ( k ) x ˙ ( k ) x ¨ ( k ) y ( k ) y ˙ ( k ) y ¨ ( k ) ] T X(k) = \begin{bmatrix} x(k) & \dot{x}(k) & \ddot{x}(k) & y(k) & \dot{y}(k) & \ddot{y}(k) \end{bmatrix}^T X(k)=[x(k)x˙(k)x¨(k)y(k)y˙(k)y¨(k)]T
状态转移方程:
X ( k ) = A ⋅ X ( k − 1 ) + W ⋅ u ( k ) X(k) = A \cdot X(k-1) + W \cdot u(k) X(k)=A⋅X(k−1)+W⋅u(k)
其中,状态转移矩阵:
A = [ 1 Δ t Δ t 2 2 0 0 0 0 1 Δ t 0 0 0 0 0 α 0 0 0 0 0 0 1 Δ t Δ t 2 2 0 0 0 0 1 Δ t 0 0 0 0 0 α ] A = \begin{bmatrix} 1 & \Delta t & \frac{\Delta t^2}{2} & 0 & 0 & 0 \\ 0 & 1 & \Delta t & 0 & 0 & 0 \\ 0 & 0 & \alpha & 0 & 0 & 0 \\ 0 & 0 & 0 & 1 & \Delta t & \frac{\Delta t^2}{2} \\ 0 & 0 & 0 & 0 & 1 & \Delta t \\ 0 & 0 & 0 & 0 & 0 & \alpha \\ \end{bmatrix} A= 100000Δt100002Δt2Δtα000000100000Δt100002Δt2Δtα
通过引入加速度状态及随机噪声,弥补了 CV 模型对动态变化的适应性不足。
目标作恒角速度圆周运动(转弯时切向加速度恒定,向心加速度由角速度决定),适用于曲线运动场景。
状态向量(二维平面运动):
X ( k ) = [ x ( k ) y ( k ) v ( k ) θ ( k ) ω ( k ) ] T X(k) = \begin{bmatrix} x(k) & y(k) & v(k) & \theta(k) & \omega(k) \end{bmatrix}^T X(k)=[x(k)y(k)v(k)θ(k)ω(k)]T
状态转移方程( ω ≠ 0 \omega \neq 0 ω=0时):
[ x ( k ) y ( k ) v ( k ) θ ( k ) ] = [ cos ( ω Δ t ) − sin ( ω Δ t ) sin ( ω Δ t ) ω 0 sin ( ω Δ t ) cos ( ω Δ t ) 1 − cos ( ω Δ t ) ω 0 0 0 1 0 0 0 0 1 ] ⋅ [ x ( k − 1 ) y ( k − 1 ) v ( k − 1 ) θ ( k − 1 ) ] \begin{bmatrix} x(k) \\ y(k) \\ v(k) \\ \theta(k) \end{bmatrix} = \begin{bmatrix} \cos(\omega \Delta t) & -\sin(\omega \Delta t) & \frac{\sin(\omega \Delta t)}{\omega} & 0 \\ \sin(\omega \Delta t) & \cos(\omega \Delta t) & \frac{1 - \cos(\omega \Delta t)}{\omega} & 0 \\ 0 & 0 & 1 & 0 \\ 0 & 0 & 0 & 1 \end{bmatrix} \cdot \begin{bmatrix} x(k-1) \\ y(k-1) \\ v(k-1) \\ \theta(k-1) \end{bmatrix} x(k)y(k)v(k)θ(k) = cos(ωΔt)sin(ωΔt)00−sin(ωΔt)cos(ωΔt)00ωsin(ωΔt)ω1−cos(ωΔt)100001 ⋅ x(k−1)y(k−1)v(k−1)θ(k−1)
仅适用于角速度恒定的转弯,无法处理角速度变化的复杂机动。
特性 | CV 模型 | CA 模型 | CT 模型 |
---|---|---|---|
状态维度 | 4(位置 + 速度) | 6(位置 + 速度 + 加速度) | 5(位置 + 速度 + 航向角 + 角速度) |
运动假设 | 匀速直线 | 匀加速(随机扰动) | 恒角速度转弯 |
状态转移矩阵 | 线性时不变(仅含 Δ t \Delta t Δt) | 线性时变(含 α \alpha α) | 非线性(含 sin / cos \sin/\cos sin/cos) |
噪声模型 | 无加速度噪声 | 加速度白噪声 | 角速度随机扰动 |
典型应用 | 匀速目标(如高铁) | 加减速目标(如城市车辆) | 转弯目标(如无人机绕飞) |
cv、ct、ca模型matlab效果对比见https://m.tb.cn/h.6gxIyKl?
CV、CA、CT 模型是目标跟踪的 “动力学语言”,其核心价值在于通过数学假设将复杂运动转化为可计算的状态转移方程。实际应用中,需结合目标特性(如是否转弯、加速频繁度)、传感器精度(如雷达采样率)及场景约束(如实时性要求)选择模型,并通过多模型融合、参数自适应等技术提升鲁棒性。下一阶段,随着无人系统智能化发展,融合物理模型与数据驱动的新型运动建模方法将成为研究热点。