[发明专利]一种计算车辆间相对距离的方法和装置

说明书

技术领域

本发明涉及汽车技术领域，更具体的说是涉及一种计算车辆间相对距离的方法和装置。

背景技术

近年来，随着人们生活水平的不断提高及汽车工业的迅猛发展，我国汽车数量越来越多。

在夜间行车时，由于车外环境的低照度会造成驾驶员获得前方及周围的路况信息比白天少，因此大多数驾驶员会打开车辆的车灯进行照明，然而，如果主车前方车辆车灯的灯光直射，驾驶员可能会因为灯光的强光造成暂时性视力障碍，进而影响行车安全。目前，市场上出现一种驾驶员辅助装置，其可以通过获取前方车辆的车灯信息来计算前方车辆与主车的距离，进而调整主车车灯的照射角度。

但是，现有的驾驶员辅助装置能够有效的发现障碍物，提醒驾驶员进行远近光灯的切换，但是其不能精确计算主车前方车辆相对于主车的距离，进而不能精确调整车灯照射角度。因此，如何根据前方车辆的车灯信息来精确计算前方车辆与主车的距离成为本领域技术人员亟待解决的问题。

发明内容

本发明实施例的目的在于提供一种计算车辆间相对距离的方法和装置，解决现有的驾驶员辅助装置不能精确计算主车前方车辆相对于主车距离的缺陷。

一种计算车辆间相对距离的方法，包括：

获取主车前方车辆的视频信息；

根据所述视频信息得到车灯区域，并对所述车灯区域进行分类；

对所述分类后的车灯区域进行跟踪，并对属于同一车辆的车灯进行配对，跟踪同一车辆的车灯连线的中心；

根据所述中心得到所述前方车辆相对于所述主车的距离。

优选的，在上述方法中，所述根据所述视频信息得到车灯区域，并对所述车灯区域进行分类，包括：

对所述视频信息进行单帧处理，得到单帧图像；

从所述单帧图像中提取光源区域并得到相应的区域参数；

根据所述区域参数去除伪车灯区域，得到车灯区域；

将所述车灯区域的区域参数输入分类器，所述分类器对所述车灯区域进行分类，如果判定所述车灯区域为前灯，则将所述车灯区域归入前灯集合，如果判定所述车灯区域为后灯，则将所述车灯区域归入后灯集合。

优选的，在上述方法中，所述根据所述中心得到所述前方车辆相对于所述主车的距离包括：

选定所述主车最前端在地面上的点为世界坐标系的原点，所述单帧图像中的点为图像坐标系中的坐标点；

根据所述中心在所述图像坐标系中的坐标、从预先生成的坐标查找表中查找所述中心在摄像头坐标系中的坐标，根据所述中心在所述摄像头坐标系中的坐标计算得到所述前方车辆相对于所述原点的垂直距离d_tgt2和水平距离x_tgt2。

优选的，在上述方法中，所述根据所述中心得到所述前方车辆相对于所述主车的距离包括：

选定所述主车最前端在地面上的点为世界坐标系的原点；

利用公式d_tgt1=(h_cam-h_vehicle)/tan(θ_tgt)-d_cam计算所述同一车辆相对于所述原点的垂直距离d_tgt1，其中，θ_tgt=θ_cam+arctan(v/F_v)，θ_cam为图像采集器相对于水平面的俯仰角，所述图像采集器获取主车前方车辆的视频信息，h_vehicle表示所述同一车辆的车灯相对于地面的高度，d_cam表示所述图像采集器到所述原点的垂直距离，v表示在图像坐标系中，所述同一车辆车灯连线中心在垂直方向上相对于图像中心位置的偏移量，F_v表示所述图像采集器的垂直焦距，h_cam为所述图像采集器相对于地面的高度；

利用公式x_tgt1=(d_tgt×u)/F_u-x_cam计算所述同一车辆相对于所述原点的水平距离x_tgt1，其中，u表示在所述图像坐标系中，所述同一车辆的车灯连线中心在水平方向上相对于图像中心位置的偏移量，F_u表示所述图像采集器的水平焦距，x_cam表示所述图像采集器到所述原点的水平距离。

优选的，在上述方法中，所述根据所述中心得到所述前方车辆相对于所述主车的距离，包括：

所述中心在世界坐标系中的坐标为：