4. 概率数据关联 (PDA)

各位好，今天我们聊一个非常实用的话题——概率数据关联，也就是PDA。

说实话，我在做多目标跟踪的头两年，一直用的都是最近邻（NN）和联合概率数据关联（JPDA）。直到有一次，我在做一个密集杂波环境下的行人跟踪项目，NN算法频繁丢跟，JPDA又因为计算量太大跑不动。这时候，我的导师跟我说：「试试PDA吧，它是个很好的折中方案。」

嗯，这一试，就让我对PDA有了全新的认识。

4.1 PDA的基本思想：别急着做决定

PDA的核心思想其实很简单——不要急着决定哪个量测是目标的，哪个是杂波。

你想想看，在雷达或者视觉跟踪中，每一帧都会收到一堆量测点。有的来自目标，有的来自噪声。NN的做法是「我选最近的那个」，JPDA的做法是「我枚举所有可能的关联组合」。而PDA呢？它说：「我全都要，但每个量测的权重不同。」

说白了，PDA是一种软关联方法。它不强制选择一个量测，而是计算每个量测属于目标的概率，然后用这些概率去加权更新目标状态。

我在项目中遇到过这样一个场景：目标在遮挡物附近运动，量测点经常被遮挡物反射干扰。如果用NN，很容易跟到反射点上。但PDA因为考虑了所有量测的概率，反而能保持稳定的跟踪。这就是它的魅力所在。

4.2 关联概率的计算：一步步拆解

好，我们来聊聊关联概率到底怎么算。这部分有点数学，但我尽量讲得通俗些。

假设在时刻k，我们有一个确认门，里面有m个量测。我们需要计算每个量测i（i=1,...,m）来自目标的概率β_i，以及没有量测来自目标的概率β_0。

这些概率满足：

β_0 + β_1 + β_2 + ... + β_m = 1

那么β_i怎么算呢？公式长这样：

β_i = e_i / (b + Σe_j)    （i=1,...,m）
β_0 = b / (b + Σe_j)

其中：

• e_i = 量测i的似然函数值，表示它来自目标的可能性
• b = 杂波密度相关的项，表示所有量测都是杂波的可能性

具体来说，e_i的计算依赖于卡尔曼滤波的新息（innovation）和新息协方差：

e_i = (1 / (2π)^(d/2 * |S|^(1/2))) * exp(-0.5 * v_i^T * S^(-1) * v_i)

这里：

• d是量测维度（比如2D位置就是d=2）
• S是新息协方差矩阵
• v_i是量测i的新息（量测值减去预测值）

而b的计算是：

b = λ * |2πS|^(1/2) * (1 - P_D * P_G) / (P_D)

其中：

• λ是杂波密度（单位体积内的杂波数量）
• P_D是检测概率
• P_G是门概率（量测落入确认门的概率）

4.3 PDA与卡尔曼滤波的结合：黄金搭档

PDA和卡尔曼滤波的结合，可以说是天作之合。卡尔曼滤波负责状态预测和更新，PDA负责处理量测的不确定性。

结合后的流程是这样的：

1. 预测阶段：和标准卡尔曼滤波一样，用状态转移矩阵预测目标状态和协方差
2. 门控（Gating）：根据预测位置和协方差，生成确认门，筛选候选量测
3. 概率计算：计算每个候选量测的关联概率β_i
4. 加权更新：用所有量测的加权组合来更新状态

加权更新的公式是：

状态更新：
x̂(k|k) = x̂(k|k-1) + K(k) * v(k)

其中加权新息：
v(k) = Σ β_i * v_i(k)

协方差更新：
P(k|k) = β_0 * P(k|k-1) + (1 - β_0) * P^c(k|k) + P̃(k)

P^c(k|k) = (I - K(k)H(k)) * P(k|k-1)
P̃(k) = K(k) * [Σ β_i * v_i(k) * v_i(k)^T - v(k) * v(k)^T] * K(k)^T

看到这个公式，你可能会觉得有点复杂。别担心，我解释一下：

• 第一项：β_0 * P(k|k-1) 表示「没有量测时」的协方差，相当于只做预测
• 第二项：(1-β_0) * P^c(k|k) 表示「有量测时」的标准卡尔曼更新
• 第三项：P̃(k) 是一个额外的项，它反映了量测不确定性带来的协方差增加

4.4 一个简单的PDA实现示例

下面是一个简化的PDA实现，我用Python写的，方便你理解核心逻辑：

import numpy as np

def pda_update(x_pred, P_pred, measurements, H, R, lambda_c, P_D, P_G, gate_threshold):
    """
    PDA更新步骤
    x_pred: 预测状态 (n,)
    P_pred: 预测协方差 (n,n)
    measurements: 量测列表，每个量测是 (d,) 向量
    H: 量测矩阵 (d,n)
    R: 量测噪声协方差 (d,d)
    lambda_c: 杂波密度
    P_D: 检测概率
    P_G: 门概率
    gate_threshold: 确认门阈值（卡方分布分位数）
    """
    d = R.shape[0]  # 量测维度
    n = len(measurements)  # 量测数量
    
    # 计算新息协方差
    S = H @ P_pred @ H.T + R
    
    # 门控：筛选落入确认门的量测
    valid_measurements = []
    valid_innovations = []
    
    for z in measurements:
        v = z - H @ x_pred  # 新息
        mahalanobis_dist = v.T @ np.linalg.inv(S) @ v
        if mahalanobis_dist < gate_threshold:
            valid_measurements.append(z)
            valid_innovations.append(v)
    
    m = len(valid_measurements)  # 有效量测数量
    
    if m == 0:
        # 没有量测，只做预测
        return x_pred, P_pred
    
    # 计算每个量测的似然
    e = []
    for v in valid_innovations:
        likelihood = np.exp(-0.5 * v.T @ np.linalg.inv(S) @ v)
        likelihood /= np.sqrt((2*np.pi)**d * np.linalg.det(S))
        e.append(likelihood)
    
    # 计算b（杂波项）
    b = lambda_c * np.sqrt((2*np.pi)**d * np.linalg.det(S))
    b *= (1 - P_D * P_G) / P_D
    
    # 计算关联概率
    sum_e = sum(e)
    beta = [ei / (b + sum_e) for ei in e]  # 每个量测的概率
    beta_0 = b / (b + sum_e)  # 没有量测的概率
    
    # 计算加权新息
    v_weighted = np.zeros(d)
    for i in range(m):
        v_weighted += beta[i] * valid_innovations[i]
    
    # 卡尔曼增益
    K = P_pred @ H.T @ np.linalg.inv(S)
    
    # 状态更新
    x_updated = x_pred + K @ v_weighted
    
    # 协方差更新
    P_std = (np.eye(len(x_pred)) - K @ H) @ P_pred  # 标准卡尔曼更新
    P_updated = beta_0 * P_pred + (1 - beta_0) * P_std
    
    # 额外项：量测不确定性
    P_tilde = np.zeros_like(P_pred)
    for i in range(m):
        P_tilde += beta[i] * valid_innovations[i][:, None] @ valid_innovations[i][None, :]
    P_tilde -= v_weighted[:, None] @ v_weighted[None, :]
    P_tilde = K @ P_tilde @ K.T
    
    P_updated += P_tilde
    
    return x_updated, P_updated

4.5 PDA的优缺点

聊了这么多，我们来总结一下PDA的优缺点：

优点	缺点
计算量小，适合实时系统	只适用于单目标跟踪
在中等杂波密度下性能稳定	多目标场景需要扩展为JPDA
不需要枚举关联假设	对杂波密度估计敏感
与卡尔曼滤波天然结合	无法处理目标出生/消亡

我个人觉得，PDA最适合的场景是：单目标、中等杂波、实时性要求高。比如雷达跟踪单个飞机、声纳跟踪单个潜艇，或者视觉中跟踪一个特定的行人。

4.6 知识体系图

最后，我用一张图来总结PDA的核心逻辑：

嗯，PDA的内容就讲到这里。它不像JPDA那样能处理多目标间的复杂关联，但在单目标场景下，它用最小的计算代价换来了不错的鲁棒性。如果你刚开始接触数据关联，我建议先从PDA入手，理解「软关联」的思想，再去看JPDA和MHT会轻松很多。

可可精品资料库