[发明专利]连续型道路分割物的位姿估计方法、装置及终端

说明书

本发明公开了一种连续型道路分割物的位姿估计方法、装置及终端，属于辅助驾驶技术领域。该方法包括：确定接收图像的U视差图，并在所述U视差图中将满足第一预设条件的像素点确定为候选点；根据像素点、拟合线及置信率之间的第一映射关系，确定所述候选点位于所述拟合线上的置信率，及计算所述候选点的像素值与所述置信率的乘积；确定同一拟合线对应的所述乘积的累加值，并将最大累加值对应的拟合线确定为目标拟合线；根据拟合线、夹角及距离之间的第二映射关系，确定所述目标拟合线对应的夹角和距离，其中，所述夹角和距离分别表示所述连续型道路分割物与相机之间的夹角和距离。应用该方法可以提高连续型道路分割物位姿检测准确度。

技术领域

本发明涉及辅助驾驶技术领域，特别涉及一种连续型道路分割物的位姿估计方法、装置及终端。

背景技术

随着汽车智能化的发展趋势，辅助驾驶系统设计正成为研究热点，在辅助驾驶系统设计中，快速、准确地进行连续型道路分割物(例如栅栏、灌木丛、路肩石)检测是关键，通常基于立体视觉的方法进行连续型道路分割物检测和位姿估计。

日本理光公司提出连续型道路分割物检测方法和装置(CN103390269A)，该方法包括：先在V视差图中选择平行于路面的若干切片，将切片中的视差点分别投影到U视差图中，通过霍夫变换等进行直线拟合，在各U视图中检测到的斜线中，将重合次数最多的斜线确定为连续型道路分割物的投影斜线，根据U视差图和视差图的映射关系可以得到连续型道路分割物在视差图中的位置，根据V视差图中最后一次切片的位置确定连续型道路分割物的高度。但上述方法存在如下缺点：

1)需要对V视差图进行多次切片，并且每次切片后投影到U视差图中进行直线拟合，最终才能确定连续型道路分割物的位置，显然整个过程耗时大、效率低；

2)在实际应用中，受到光线、横向车辆、障碍物、远处物体等干扰，双目摄像机采集到的图像经过立体匹配得到的视差图存在波动性，基于不准确的视差图采用上述现有连续型道路分割物检测方法，会导致拟合的直线不准确，从而导致确定的连续型道路分割物位姿信息偏差较大。

发明内容

为了解决相关技术中，通过立体匹配得到的视差图存在波动性，根据该视差图进行直线拟合，造成连续型道路分割物位姿信息不准确且耗时大的问题，本发明技术方案如下：

本发明实施方式的第一方面，提供一种连续型道路分割物的位姿估计方法，所述方法具体步骤包括：

确定接收图像的U视差图，并在所述U视差图中将满足第一预设条件的像素点确定为候选点；根据像素点、拟合线及置信率之间的第一映射关系，确定所述候选点位于所述拟合线上的置信率，及计算所述候选点的像素值与所述置信率的乘积；确定同一拟合线对应的所述乘积的累加值，并将最大累加值对应的拟合线确定为目标拟合线；根据拟合线、夹角及距离之间的第二映射关系，确定所述目标拟合线对应的夹角和距离，其中，所述夹角和距离分别表示所述连续型道路分割物与相机之间的夹角和距离。

可选的，所述确定接收图像的U视差图，并在所述U视差图中确定满足第一预设条件的像素点，具体步骤包括：在所述U视差图中进行直线拟合得到目标斜线；根据所述目标斜线确定搜索框，并将所述搜索框中的像素点确定为所述候选点，其中，所述目标斜线位于所述搜索框中。

可选的，所述在所述U视差图中进行直线拟合得到目标斜线，步骤之前还包括：确定所述图像的V视差图，并在V视差图进行直线拟合得到第一斜线；基于所述第一斜线确定V视差切片，并将所述V视差切片的像素点对应的U视差图确定为所述U视差图，其中，所述V视差切片中的像素点位于所述第一斜线的上方。

可选的，所述在所述U视差图中进行直线拟合得到目标斜线，具体步骤包括：在所述U视差图中进行直线拟合得到第二斜线，将满足第二预设条件的所述第二斜线确定为目标斜线，其中，所述第二预设条件为所述第二斜线上像素点总数大于预设阈值。