一种目标航迹预测优化方法、装置及雷达系统

技术领域

本发明涉及车辆运动轨迹跟踪技术领域，尤其涉及一种目标航迹预测优化方法、目标航迹预测优化装置及雷达系统。

背景技术

目前，随着我国车辆的迅速普及，随之而来的道路交通事故风险也日益提高，车载毫米波雷达也被广泛应用于辅助驾驶员安全驾驶，其中使用雷达对目标（如行人、车辆）进行运动轨迹跟踪是非常重要的。目前主要的跟踪方法主要是通过对数据初始化建立航迹，然后对航迹进行跟踪预测并实时管理航迹来进行目标跟踪的，中间最重要的一步即对目标的跟踪预测。在现有的技术方案中，跟踪预测主要是通过单一的线性均方差估计算法（如卡尔曼滤波或其衍生算法），这种滤波器的滤波效果是最优的，但是该方法是基于固定模型进行滤波计算，如果目标的运动过于机动，则会导致目标预测错误、跟踪轨迹偏离。另一种跟踪预测的方法是和视觉信息做结合，通过将雷达检测目标映射到图像上，将两者目标相互匹配来进行协同预测跟踪。这种方法的缺点是计算量大且视觉检测容易受到天气等外界因素影响。

发明内容

本发明提供了一种目标航迹预测优化方法、目标航迹预测优化装置及雷达系统，解决相关技术中存在的雷达预测目标错误且计算量大的问题。

作为本发明的第一个方面，提供一种目标航迹预测优化方法，其中，包括：

S110、对新起始的航迹进行航迹初始化；

S120、判断新起始的航迹是否满足航迹拟合条件；

S130、若满足，则根据随机抽样一致算法计算目标正确的运动方向；

S140、根据计算得到的目标正确的运动方向将目标的速度还原成真实的大小，并得到目标真实速度的横向和纵向分量；

S150、根据真实速度的横向和纵向分量修正当前帧数据，并预测目标下一帧的状态；

S160、通过航迹关联新的点迹，并重复步骤S130~步骤S150。

进一步地，所述若满足，则根据随机抽样一致算法计算目标正确的运动方向，包括：

S131、确定航迹拟合目标运动轨迹的具体模型；

S132、随机选择被观测数据中部分点，进行模型拟合，得到一组模型参数；

S133、通过剩余被观测数据来测试该组模型参数是否为正确模型；

S134、重复步骤S131~S133，达到一定迭代次数以后，选出正确模型中满足正确数据个数最多的模型参数，即为目标运动模型，并根据模型参数计算得到目标正确的运动方向。

进一步地，所述通过剩余被观测数据来测试该组模型参数，包括：

通过计算剩余被测试点到该组模型的距离来表征计算误差；

若计算误差在阈值范围内，则认为该模型为正确数据；

重复上述步骤，记录所有剩余被观测数据测试后的满足阈值范围点的正确数据的个数。

进一步地，所述航迹拟合目标运动轨迹的具体模型包括：直线模型或曲线模型。

进一步地，所述根据计算得到的目标正确的运动将目标的速度还原成真实的大小，并得到目标真实速度的横向和纵向分量，包括：

根据计算得到的目标正确的运动方向将目标的速度还原成真实的大小，并通过运动方向分解得到当前帧的速度横向和纵向分量。

进一步地，所述根据真实速度的横向和纵向分量修正当前帧数据，并预测目标下一帧的状态，包括：

根据真实速度的横向和纵向分量和模型预测值进行卡尔曼滤波，修正当前的帧数据，并预测目标下一帧的状态。

作为本发明的另一个方面，提供一种目标航迹预测优化装置，其中，包括：

初始化模块，用于对新起始的航迹进行航迹初始化；

判断模块，用于判断新起始的航迹是否满足航迹拟合条件；

计算模块，用于若满足，则根据随机抽样一致算法计算目标正确的运动方向；

还原模块，用于根据计算得到的目标正确的运动方向将目标的速度还原成真实的大小，并得到目标真实速度的横向和纵向分量；

修正与预测模块，用于根据真实速度的横向和纵向分量修正当前帧数据，并预测目标下一帧的状态；

关联模块，用于通过航迹关联新的点迹。

作为本发明的另一个方面，提供一种雷达系统，其中，包括：信号发射单元、信号接收单元和信号处理单元，所述信号发射单元和所述信号接收单元均与所述信号处理单元通信连接，所述信号处理单元包括前文所述的目标航迹预测优化装置。

本发明提供的目标航迹预测优化方法，通过随机抽样一致算法计算目标正确的运动方向，然后确定目标真实速度的横向和纵向分量，从而实现对当前帧数据的修正，并预测下一帧的状态，这种目标航迹预测优化方法仅利用毫米波雷达检测结果，无需和其他传感器结合，降低了成本及计算复杂度，且不受天气等因素的影响，易用性高；基于离散点迹来拟合目标运动方向，利用RANSAC算法，降低探测过程中野值点的影响，具有可靠性高、准确度高、鲁棒性好的特点；自适应各种路况，降低不同道路状况下单一的模型导致的模型发散问题，提高系统稳定性；同样基于卡尔曼滤波算法，在本身修正的基础上，加入目标运动方向协助预测，加快轨迹修正速度，响应更快。

附图说明

附图是用来提供对本发明的进一步理解，并且构成说明书的一部分，与下面的具体实施方式一起用于解释本发明，但并不构成对本发明的限制。

图1为本发明提供的雷达系统的结构框图。

图2为本发明提供的目标航迹预测优化方法的流程图。

具体实施方式

需要说明的是，在不冲突的情况下，本发明中的实施例及实施例中的特征可以相互结合。下面将参考附图并结合实施例来详细说明本发明。

为了使本领域技术人员更好地理解本发明方案，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分的实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都应当属于本发明保护的范围。

需要说明的是，本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象，而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换，以便这里描述的本发明的实施例。此外，术语“包括”和“具有”以及他们的任何变形，意图在于覆盖不排他的包括，例如，包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元，而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。

雷达系统主要包括信号发射单元、信号接收单元、信号处理单元。其中，信号发射单元主要对外辐射毫米波信号探测信号，信号接收单元主要用于接收经目标发射后的回波信号，信号处理单元则将接收到的回波信号和发射信号进行混频，得到中频信号进行一系列处理最终得到目标的角度、距离和速度的信息，并根据需求进行一些其他处理。以上循环一次的持续时间称为帧。帧与帧之间，相同目标因为运动方向和运动速度的原因，在雷达探测上会得到不同的信息。为了得到相同目标的连续变化过程，需要跟踪帧与帧之间的相同目标。普适的方法是通过卡尔曼滤波器利用最小均方误差准则获得目标的动态估计，通过一系列算法，将帧间的相同目标进行关联，过滤虚假目标，并利用观测到的数据对运动目标状态进行修正和预测，使得目标数据更平滑、更稳定。在卡尔曼滤波过程中，估计理论非常重要，它需要建立目标运动模型，来描述目标动态行为和雷达本身的量测过程。因此在卡尔曼滤波过程中，将模型分为状态方程和量测方程，通过目标运动模型来构建状态方程，同时又利用量测结果构建的量测方程来不停地修正状态方程。机动目标跟踪过程的难点就在于目标运动的不确定性。

常用的目标运动模型有匀速（CV）模型、匀加速（CA）模型等。以常见的CV模型来说，由以下式子给出了状态向量X：

X(k+1)=F(k)X(k)+V(k)，

状态向量X在时间k+1时刻表现为[Rx(k+1),Ry(k+1),vx(k+1),vy(k+1)]’，其中Rx(k+1)和Ry(k+1)为目标的在时刻k+1时的二维坐标；vx(k+1)和vy(k+1) 为目标的在时刻k+1时速度沿x轴和y轴的分量。在这里的x轴和y轴是以雷达为原点的笛卡尔坐标系。式1中F(k)为状态转移矩阵，V(k)为均值为0且满足正态分布的过程噪声，其协方差为Q(k)。

同样的，k+1时刻的目标的观测值或量测值z(k+1)由下式给出：

z(k+1)=H(k+1)X(k+1)+W(k+1) [式2]

量测值z在时间k+1时刻表现为[Rx(k+1)’,Ry(k+1)’,vx(k+1)’,vy(k+1)’]’， 其中Rx(k+1)’和Ry(k+1)’为雷达测量到的目标在时刻k+1时的二维坐标；vx(k+1)’和vy(k+1)’ 为目标测量到的在时刻k+1时速度沿x轴和y轴的分量。在式2中H(k+1)为量测矩阵， W(k+1)为具有高斯性均值为0的白噪声，其协方差为R(k+1)。

在基础运动模型上，可以额外引入加速度变量、转向角变量，从而更好的描述目标的运动。如果目标不是遵循线性运动模型，和预设的运动方向有很大的运动偏差，则会造成目标真实的运动和模型预测运动之间的偏差。因此，获取目标正确的运动方向就非常重要。

根据本发明的示例性实施例，图1是使用卡尔曼滤波器进行目标跟踪的雷达系统框图。如图1所示，为目标跟踪的雷达系统框图。根据示例性案例，雷达12装在车辆11的前保险杠处。在该状态下，与雷达夹角θ度13方向有一目标14，经过雷达测量后的解算，可以得到该目标的距离、角度θ度13，以及速度，速度为沿目标与雷达连线上即方向15的真实速度的分量。根据以上信息，无法判断出目标真实的运动方向，则无法获得正确的vx和vy。如按照常规的预测模型，目标预测可能会沿着方向15进行运动。根据示例性案例，目标真实运动沿方向17，运动到位置16。如完全按照模型进行预测则预测完全错误，造成很大的偏差。真实的运动方向17和错误预测方向15之间的误差运动角度为ω18。基于以上描述，通过雷达的探测数据计算目标正确的运动方向，提高目标航迹预测的正确性是非常必要的。

本发明实施例采用一种随机抽样一致算法(Random sample Consensus,RANSAC)，在被观测数据中包含正确数据和异常数据（outliers）的假设下，采用迭代的方式，反复选择数据中的一组随机子集，来估算数学模型参数的方法。该方法相比于最小二乘法，考虑到了噪声对数据拟合的干扰，能鲁棒的估计模型参数。

在本实施例中提供了一种目标航迹预测优化方法，图2是根据本发明实施例提供的目标航迹预测优化方法的流程图，如图2所示，包括：

S110、对新起始的航迹进行航迹初始化；

S120、判断新起始的航迹是否满足航迹拟合条件；

S130、若满足，则根据随机抽样一致算法计算目标正确的运动方向；

S140、根据计算得到的目标正确的运动方向将目标的速度还原成真实的大小，并得到目标真实速度的横向和纵向分量；

S150、根据真实速度的横向和纵向分量修正当前帧数据，并预测目标下一帧的状态；

S160、通过航迹关联新的点迹，并重复步骤S130~步骤S150。

本发明提供的目标航迹预测优化方法，通过随机抽样一致算法计算目标正确的运动方向，然后确定目标真实速度的横向和纵向分量，从而实现对当前帧数据的修正，并预测下一帧的状态，这种目标航迹预测优化方法仅利用毫米波雷达检测结果，无需和其他传感器结合，降低了成本及计算复杂度，且不受天气等因素的影响，易用性高；基于离散点迹来拟合目标运动方向，利用RANSAC算法，降低探测过程中野值点的影响，具有可靠性高、准确度高、鲁棒性好的特点；自适应各种路况，降低不同道路状况下单一的模型导致的模型发散问题，提高系统稳定性；同样基于卡尔曼滤波算法，在本身修正的基础上，加入目标运动方向协助预测，加快轨迹修正速度，响应更快。

具体地，所述若满足，则根据随机抽样一致算法计算目标正确的运动方向，包括：

S131、确定航迹拟合目标运动轨迹的具体模型；

S132、随机选择被观测数据中部分点，进行模型拟合，得到一组模型参数；

S133、通过剩余被观测数据来测试该组模型参数是否为正确模型；

S134、重复步骤S131~S133，达到一定迭代次数以后，选出正确模型中满足正确数据个数最多的模型参数，即为目标运动模型，并根据模型参数计算得到目标正确的运动方向。

进一步具体地，所述通过剩余被观测数据来测试该组模型参数，包括：

通过计算剩余被测试点到该组模型的距离来表征计算误差；

若计算误差在阈值范围内，则认为该模型为正确数据；

重复上述步骤，记录所有剩余被观测数据测试后的满足阈值范围点的正确数据的个数。

需要说明的是，所述航迹拟合目标运动轨迹的具体模型包括：直线模型或曲线模型。

具体地，所述根据计算得到的目标正确的运动将目标的速度还原成真实的大小，并得到目标真实速度的横向和纵向分量，包括：

根据计算得到的目标正确的运动方向将目标的速度还原成真实的大小，并通过运动方向分解得到当前帧的速度横向和纵向分量。

具体地，所述根据真实速度的横向和纵向分量修正当前帧数据，并预测目标下一帧的状态，包括：

根据真实速度的横向和纵向分量和模型预测值进行卡尔曼滤波，修正当前的帧数据，并预测目标下一帧的状态。

应当理解的是，在预测该目标下一帧的状态后，进入下一帧，该目标有新的量测值，则通过航迹关联进轨迹中，再次重复步骤S130~步骤S150，计算即时的目标运动方向，并通过运动方向解算正确的速度进行当前帧的修正和再下一帧的预测。

作为本发明的另一实施例，提供一种目标航迹预测优化装置，其中，包括：

初始化模块，用于对新起始的航迹进行航迹初始化；

判断模块，用于判断新起始的航迹是否满足航迹拟合条件；

计算模块，用于若满足，则根据随机抽样一致算法计算目标正确的运动方向；

还原模块，用于根据计算得到的目标正确的运动方向将目标的速度还原成真实的大小，并得到目标真实速度的横向和纵向分量；

修正与预测模块，用于根据真实速度的横向和纵向分量修正当前帧数据，并预测目标下一帧的状态；

关联模块，用于通过航迹关联新的点迹。

本发明实施例提供的目标航迹预测优化装置，通过随机抽样一致算法计算目标正确的运动方向，然后确定目标真实速度的纵向分量，从而实现对当前帧数据的修正，并预测下一帧的状态，这种目标航迹预测优化装置仅利用毫米波雷达检测结果，无需和其他传感器结合，降低了成本及计算复杂度，且不受天气等因素的影响，易用性高；基于离散点迹来拟合目标运动方向，利用RANSAC算法，降低探测过程中野值点的影响，具有可靠性高、准确度高、鲁棒性好的特点；自适应各种路况，降低不同道路状况下单一的模型导致的模型发散问题，提高系统稳定性；同样基于卡尔曼滤波算法，在本身修正的基础上，加入目标运动方向协助预测，加快轨迹修正速度，响应更快。

作为本发明的另一实施例，提供一种雷达系统，其中，包括：信号发射单元、信号接收单元和信号处理单元，所述信号发射单元和所述信号接收单元均与所述信号处理单元通信连接，所述信号处理单元包括前文所述的目标航迹预测优化装置。

应当理解的是，本发明实施例提供的信号处理单元具体可以采用前文的目标航迹预测优化装置实现。

关于本发明实施例提供的雷达系统的具体工作原理可以参照前文的目标航迹预测优化方法的描述，此处不再赘述。

本发明实施例提供的雷达系统，可以准确且高效的实现对目标方向的预测。

可以理解的是，以上实施方式仅仅是为了说明本发明的原理而采用的示例性实施方式，然而本发明并不局限于此。对于本领域内的普通技术人员而言，在不脱离本发明的精神和实质的情况下，可以做出各种变型和改进，这些变型和改进也视为本发明的保护范围。