一种应用于无人驾驶汽车的目标跟踪系统及跟踪方法技术方案

本发明专利技术公开了一种应用于无人驾驶汽车的目标跟踪系统及跟踪方法，跟踪系统包括由激光雷达和毫米波雷达组成的车载雷达系统与机器人操作系统Robot Operating System(ROS)；激光雷达安装在车辆的顶部，其测量精度相对较高，但容易受光照等环境影响，毫米波雷达安装在车辆前方的车牌处，测量精度相对较低，但是受外界环境影响较小，该车载雷达系统组合在一起可提高测量准确性；在机器人操作系统ROS的节点集合中存在雷达传感器节点和无迹卡尔曼滤波估计器节点，通过无损卡尔曼滤波算法它使用一系列sigma点通过非线性变换生成状态，并使用这些估计过的sigma点覆盖状态估计点和协方差，从而完成对雷达系统所接收的数据的融合，实现目标跟踪。

A target tracking system and tracking method applied to unmanned vehicle

The invention discloses a target tracking system and a tracking method for an unmanned vehicle. The tracking system comprises a vehicle-borne radar system composed of a lidar and a millimeter-wave radar and a robot operating system Robot Operating System (ROS); the lidar is mounted on the top of the vehicle, and the measuring accuracy is relatively high, but the measuring capacity is high. It is easy to be affected by illumination and other environment. Millimeter-wave radar is installed at the license plate in front of the vehicle. Its measurement accuracy is relatively low, but it is less affected by external environment. The combination of the radar system can improve the measurement accuracy. There are radar sensor nodes and traceless Kalman in the node set of ROS. Filter estimator node, through lossless Kalman filter algorithm, uses a series of sigma points to generate state through nonlinear transformation, and uses these estimated sigma points to cover state estimation points and covariance, thus completing the fusion of the data received by the radar system and achieving target tracking.

【技术实现步骤摘要】
一种应用于无人驾驶汽车的目标跟踪系统及跟踪方法
本专利技术涉及车用目标跟踪系统及方法，具体地说是一种用于装载有车载雷达系统的无人驾驶汽车的基于无损卡尔曼滤波的目标跟踪系统及方法。
技术介绍
无人驾驶汽车在进行无人驾驶的时候需要对环境进行感知，从而根据环境信息实现对车辆的控制和路径的规划，而这一过程要依靠相对应的车载传感器。这些传感器主要包括摄像头、激光雷达、毫米波雷达、红外相机、GPS和惯导系统等。毫米波雷达穿透雾、烟、灰尘的能力强，具有全天候、全天时的优点，但是探测精度低；而激光雷达探测精度高但容易受外界环境干扰。因此，相比于单一传感器，激光雷达和毫米波雷达组合而成的车载雷达系统，稳定性更强。针对上述的车载雷达系统，可以实现对行人、其他车辆以及车辆自身等目标的状态估计和跟踪。在众多相关的信息融合算法中，无损卡尔曼滤波更适用于非线性系统，并且能够避免普通卡尔曼滤波和增强卡尔曼滤波的缺陷。因此将无损卡尔曼滤波与搭载有该系统的无人驾驶汽车结合起来，可以使得探测结果更加稳定，系统整体的实用性更强。机器人操作系统RobotOperatingSystem(ROS),提供一组实用工具和软件库以及开源功能包，可以搭建一整套针对无人驾驶系统的运行框架。ROS运行时是由被称之为节点(Node)的多个松耦合的进程组成，在实际工程中，这种结构的设计可以根据要求快速地修改所需的功能模块。因此将目标跟踪算法在ROS中实现可以大大提高算法的灵活性。当前技术中，申请号“201210555170.7”，申请公布号为“CN103889047A”的专利“一种基于卡尔曼滤波的目标跟踪算法”以及申请号为“201610809777.1”，申请公布号“106443661A”的专利“基于无迹卡尔曼滤波的机动扩展目标跟踪方法”都未将无损卡尔曼滤波与无人驾驶汽车的车载雷达系统结合起来应用，也并未形成完整的目标跟踪以及信息处理系统。
技术实现思路
本专利技术的目的是为了克服现有技术中的不足，提供一种应用于无人驾驶汽车的目标跟踪系统及跟踪方法，将无损卡尔曼滤波算法应用到由激光雷达和毫米波雷达组成的无人驾驶汽车车载雷达系统上，并在机器人操作系统ROS中完成算法的实现以及功能模块的构建。本专利技术的目的是通过以下技术方案实现的：一种应用于无人驾驶汽车的目标跟踪系统，该系统包括由激光雷达和毫米波雷达组成的车载雷达系统与机器人操作系统RobotOperatingSystem(ROS)；所述激光雷达安装在车辆的顶部，其测量精度相对较高，但容易受光照等环境影响，所述的毫米波雷达安装在车辆前方的车牌处，测量精度相对较低，但是受外界环境影响较小，该车载雷达系统组合在一起可提高测量准确性；在机器人操作系统ROS的节点集合中存在雷达传感器节点和无迹卡尔曼滤波估计器节点，通过无损卡尔曼滤波算法它使用一系列sigma点通过非线性变换生成状态，并使用这些估计过的sigma点覆盖状态估计点和协方差，从而完成对雷达系统所接收的数据的融合，实现目标跟踪。一种应用于无人驾驶汽车的目标跟踪方法，将无损卡尔曼滤波(UnscentedKalmanFilter，简称UKF)算法应用到无人驾驶汽车车载雷达系统中，其具体包括以下步骤：(1)对车载雷达系统进行标定；(2)接收解算雷达系统的数据并进行标记(其中0.0代表激光雷达数据，1.0代表毫米波雷达数据)；(3)基于ROS系统使用无损卡尔曼滤波处理数据，得到目标状态的估计。这其中，步骤(3)应用了ROS系统中的无损卡尔曼滤波器节点ukf_localization_node，该滤波器节点所包含的滤波器包括以下步骤：a)预测目标状态量的均值和方差，其公式分别为：其中，wi为无损变换中各个先验分布中采集的点(也称为sigma点)的权重，为状态向量；b)雷达系统测量更新，其中激光雷达和毫米波雷达测量映射函数分别为：Zl,k+1/k＝(x,y)T公式中，x,y是相对于车辆坐标系的坐标值,v为目标在主车到目标连线上的速度分量；c)预测目标的雷达测量值非线性变换后的测量均值和协方差，其公式分别为：公式中，R是测量噪声；d)更新状态估计以及状态协方差矩阵，其公式分别为：xk+1/k+1＝xk+1/k-Kk+1/k(zk+1-zk+1/k)其中，K为卡尔曼增益，可以通过互相关函数与变换后的协方差得到。与现有技术相比，本专利技术的技术方案所带来的有益效果是：1.将无损卡尔曼滤波与由激光雷达和毫米波雷达组成的无人驾驶汽车车载雷达系统结合。该雷达系统相对于单一雷达传感器组成的系统的稳定性更强，而无损卡尔曼滤波算法相较于其他算法的实用性也更强；2.基于机器人操作系统RobotOperatingSystem(ROS)实现信息的处理和算法的完成，系统框架更加完整，功能模块的应用更加灵活。附图说明图1为本专利技术的系统布局示意图；图2为本专利技术的方法流程图；图3为本专利技术的滤波算法流程图；图4为本专利技术的机器人操作系统ROS系统框架图；图5为本专利技术的实例结果图。具体实施方式下面结合附图和实例进一步说明本专利技术的实质内容，但本专利技术的内容并不限于此。如图1所示为本专利技术的系统布局图，系统包括由激光雷达和毫米波雷达组成的车载雷达系统以及机器人操作系统RobotOperatingSystem(ROS)；激光雷达安装在车辆的顶部，其测量精度相对较高，但容易受光照等环境影响，所述的毫米波雷达安装在车辆前方的车牌处，测量精度相对较低，但是受外界环境影响较小，该车载雷达系统组合在一起可提高测量准确性；在机器人操作系统ROS的节点集合中存在雷达传感器节点和无迹卡尔曼滤波估计器节点，通过无损卡尔曼滤波算法它使用一系列sigma点通过非线性变换生成状态，并使用这些估计过的sigma点覆盖状态估计点和协方差，从而完成对雷达系统所接收的数据的融合，实现目标跟踪。如图2所示为本专利技术的方法流程图，其具体包括以下步骤：(1)对车载雷达系统进行标定；(2)接收解算雷达系统的数据并进行标记(其中0.0代表激光雷达数据，1.0代表毫米波雷达数据)；(3)基于ROS系统使用无损卡尔曼滤波处理数据，得到目标状态的估计。如图3所示为本专利技术的无损卡尔曼滤波算法流程图，其具体内容如下：a)预测状态量的均值和方差，其公式分别为：其中，wi为无损变换中各个先验分布中采集的点(也称为sigma点)的权重，为状态向量；b)雷达系统测量更新，其中激光雷达和毫米波雷达测量映射函数分别为：Zl,k+1/k＝(x,y)T公式中，x,y是相对于车辆坐标系的坐标值,v为目标在主车到目标连线上的速度分量；c)预测目标的雷达测量值非线性变换后的测量均值和协方差，其公式分别为：公式中，R是测量噪声；d)更新状态估计以及状态协方差矩阵，其公式分别为：xk+1/k+1＝xk+1/k-Kk+1/k(zk+1-zk+1/k)其中，K为卡尔曼增益，可以通过互相关函数与变换后的协方差得到。上述的算法都在如图4所示的基于机器人操作系统ROS所搭建的系统框架里实现。如图5所示，根据本专利技术中所述的应用于无人驾驶汽车的目标跟踪的系统和方法，对采集到的实际无人驾驶工程中的一组目标探测数据进行处理，可以得到目标的状态估计值，并且可以对状态估计值、雷达测量值以及目标真实轨迹值进行比较。本专利技术并不限本文档来自技高网...

【技术保护点】
1.一种应用于无人驾驶汽车的目标跟踪系统，其特征在于，包括由激光雷达和毫米波雷达组成的车载雷达系统与机器人操作系统ROS；所述激光雷达安装在车辆的顶部，所述毫米波雷达安装在车辆前方车牌处；机器人操作系统ROS的节点集合中存在雷达传感器节点和无损卡尔曼滤波估计器节点。

【技术特征摘要】
1.一种应用于无人驾驶汽车的目标跟踪系统，其特征在于，包括由激光雷达和毫米波雷达组成的车载雷达系统与机器人操作系统ROS；所述激光雷达安装在车辆的顶部，所述毫米波雷达安装在车辆前方车牌处；机器人操作系统ROS的节点集合中存在雷达传感器节点和无损卡尔曼滤波估计器节点。2.一种应用于无人驾驶汽车的目标跟踪方法，基于权利要求1的目标跟踪系统，其特征在于，将无损卡尔曼滤波算法(UKF)应用到无人驾驶汽车车载雷达系统中，具体包括以下步骤：(1)对车载雷达系统进行标定；(2)接收解算车载雷达系统的数据并进行标记；(3)基于机器人操作系统ROS使用无损卡尔曼滤波处理数据，得到目标状态的估计。3.根据权利要求2所述的一种应用于无人驾驶汽车的...

【专利技术属性】
技术研发人员：陈晓冬，向易，蔡怀宇，汪毅，
申请(专利权)人：天津大学，
类型：发明
国别省市：天津,12