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

权利要求书

1.一种计算车辆间相对距离的方法，其特征在于，包括：

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

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

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

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

2.根据权利要求1所述的方法，其特征在于，所述根据所述视频信息得到车灯区域，并对所述车灯区域进行分类，包括：

对所述视频信息进行单帧处理，得到单帧图像，从所述单帧图像中提取光源区域并得到相应的区域参数；

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

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

3.根据权利要求2所述的方法，其特征在于，所述根据所述中心得到所述前方车辆相对于所述主车的距离包括：

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

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

4.根据权利要求2所述的方法，其特征在于，所述根据所述中心得到所述前方车辆相对于所述主车的距离包括：

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

利用公式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表示所述图像采集器到所述原点的水平距离。