道路障碍物预警方法、装置及终端与流程

文档序号:15313205发布日期:2018-08-31 22:21阅读:231来源:国知局

本申请涉及辅助驾驶技术领域,尤其涉及一种道路障碍物预警方法、装置及终端。



背景技术:

基于双目立体视觉技术检测道路上的障碍物是汽车辅助驾驶领域中比较热门的研究课题,道路障碍物预警系统则应用双目立体视觉技术检测道路上可能妨碍车辆行驶的障碍物,并在确定检测到的障碍物与车头之间的距离过近时发出预警信号,以及时提醒车辆驾驶员采取有效避让措施,避免车辆与障碍物发生碰撞。

目前,道路障碍物预警系统是通过判断障碍物是否位于设定的妨碍车辆行驶区域,以确定该障碍物是否可能妨碍车辆行驶的,并且,道路障碍物预警系统是以车辆的车头朝向为基准设置上述妨碍车辆行驶区域的,该妨碍车辆行驶区域基本位于车头正前方。

正由于妨碍车辆行驶区域设定于车头正前方,从而上述方式仅适用于车辆行驶方向与车头朝向相同,也即车辆直行的场景,在车辆拐弯时,车轮行进方向将与车头朝向呈现一定夹角,也即车辆行驶速度的方向与车头朝向并不相同,从而,所确定的位于妨碍车辆行驶区域中的障碍物并非会真正妨碍车辆行驶,在该情形下,道路障碍物预警系统也就出现误预警,从而影响驾驶员的驾驶体验;同时,真正妨碍车辆行驶的障碍物则有可能并不落入妨碍车辆行驶区域中,也就无法实现障碍物预警。



技术实现要素:

有鉴于此,本申请提供一种道路障碍物预警方法、装置及终端,以实现在车辆拐弯时,准确有效地实现障碍物预警,有效避免车辆与障碍物发生碰撞。

具体地,本申请是通过如下技术方案实现的:

根据本申请实施例的第一方面,提供一种道路障碍物预警方法,所述方法包括:

获取车辆当前的行驶速度与转向角,其中,所述转向角用于表征所述车辆的车头朝向与车轮行进方向之间的夹角;

基于所述转向角在道路上确定妨碍车辆行驶区域,所述妨碍车辆行驶区域位于所述车轮行进方向上;

基于所述道路的视差图像确定整体或部分位于所述妨碍车辆行驶区域中的至少一个障碍物;

在所述至少一个障碍物中确定距离所述车辆最近的目标障碍物;

基于所述行驶速度与所述转向角预测出所述车辆行驶至所述目标障碍物处的行驶时长,若所述行驶时长小于预设阈值,则进行障碍物预警。

在一实施例中,所述基于所述转向角在道路上确定妨碍车辆行驶区域,包括:

按照预设规则建立与道路所在物理空间对应的三维坐标系;

基于所述转向角在所述三维坐标系中确定指定坐标点;

连接所述指定坐标点,将连接所述指定坐标点的连线所围成的区域确定为妨碍车辆行驶区域。

在一实施例中,所述按照预设规则建立与道路所在物理空间对应的三维坐标系,包括:

以所述车辆的车头中心点为坐标原点,以平行于地面指向车头正前方为z轴正方向,以垂直于地面指向地面上方为y轴正方向,以平行于地面指向车头右侧方向为x轴正方向建立三维坐标系。

在一实施例中,所述按照预设规则建立与道路所在物理空间对应的三维坐标系,包括:

以所述车辆的车头中心点为坐标原点,以平行于地面指向车轮行进方向为z轴正方向,以垂直于地面指向地面上方为y轴正方向,以平行于地面指向右侧车轮方向为x轴正方向建立三维坐标系。

在一实施例中,确定出的所述指定坐标点在所述三维坐标系中的坐标分别为:

所述xl为预设的左侧安全距离阈值,所述xr为预设的右侧安全距离阈值,所述wcar为所述车辆的宽度,所述zobs为预设的最远检测距离阈值,所述h为车头中心点至地面的高度,所述zx通过第一预设公式确定;

所述第一预设公式为:zx=zobs*tanα,其中,所述α为转向角。

在一实施例中,确定出的所述指定坐标点在所述三维坐标系中的坐标分别为:

所述xl为预设的左侧安全距离阈值,所述xr为预设的右侧安全距离阈值,所述zobs为预设的最远检测距离阈值,所述h为车头中心点至地面的高度,所述wd通过第二预设公式确定;

所述第二预设公式为:其中,所述wcar为所述车辆的宽度,所述α为转向角。

在一实施例中,所述基于所述道路的视差图像确定整体或部分位于所述妨碍车辆行驶区域中的至少一个障碍物,包括:

基于双目摄像机当前拍摄到的第一图像与第二图像生成所述道路的视差图像、u视差图以及v视差图;

基于所述u视差图与v视差图在所述道路的视差图像中确定用于表示障碍物的矩形区域;

根据所述矩形区域中障碍物视差点的视差值,计算出所述障碍物在所述三维坐标系中的坐标;

基于所述障碍物在所述三维坐标系中的坐标与所述指定坐标点,确定整体或部分位于所述妨碍车辆行驶区域中的至少一个障碍物。

根据本申请实施例的第二方面,提供一种道路障碍物预警装置,所述装置包括:

参数获取模块,用于获取车辆当前的行驶速度与转向角,其中,所述转向角用于表征所述车辆的车头朝向与车轮行进方向之间的夹角;

区域确定模块,用于基于所述转向角在道路上确定妨碍车辆行驶区域,所述妨碍车辆行驶区域位于所述车轮行进方向上;

障碍物确定模块,用于基于所述道路的视差图像确定整体或部分位于所述妨碍车辆行驶区域中的至少一个障碍物;

目标确定模块,用于在所述至少一个障碍物中确定距离所述车辆最近的目标障碍物;

预警模块,用于基于所述行驶速度与所述转向角预测出所述车辆行驶至所述目标障碍物处的行驶时长,若所述行驶时长小于预设阈值,则进行障碍物预警。

在一实施例中,所述区域确定模块包括:

坐标系建立子模块,用于按照预设规则建立与道路所在物理空间对应的三维坐标系;

坐标点确定子模块,用于基于所述转向角在所述三维坐标系中确定指定坐标点;

连接子模块,用于连接所述指定坐标点,将连接所述指定坐标点的连线所围成的区域确定为妨碍车辆行驶区域。

在一实施例中,所述坐标系建立子模块,具体用于:

以所述车辆的车头中心点为坐标原点,以平行于地面指向车头正前方为z轴正方向,以垂直于地面指向地面上方为y轴正方向,以平行于地面指向车头右侧方向为x轴正方向建立三维坐标系。

在一实施例中,所述坐标系建立子模块,具体用于:

以所述车辆的车头中心点为坐标原点,以平行于地面指向车轮行进方向为z轴正方向,以垂直于地面指向地面上方为y轴正方向,以平行于地面指向右侧车轮方向为x轴正方向建立三维坐标系。

在一实施例中,确定出的所述指定坐标点在所述三维坐标系中的坐标分别为:

所述xl为预设的左侧安全距离阈值,所述xr为预设的右侧安全距离阈值,所述wcar为所述车辆的宽度,所述zobs为预设的最远检测距离阈值,所述h为车头中心点至地面的高度,所述zx通过第一预设公式确定;

所述第一预设公式为:zx=zobs*tanα,其中,所述α为转向角。

在一实施例中,确定出的所述指定坐标点在所述三维坐标系中的坐标分别为:

所述xl为预设的左侧安全距离阈值,所述xr为预设的右侧安全距离阈值,所述zobs为预设的最远检测距离阈值,所述h为车头中心点至地面的高度,所述wd通过第二预设公式确定;

所述第二预设公式为:其中,所述wcar为所述车辆的宽度,所述α为转向角。

在一实施例中,所述障碍物确定模块包括:

视差图生成子模块,用于基于双目摄像机当前拍摄到的第一图像与第二图像生成所述道路的视差图像、u视差图以及v视差图;

第一确定子模块,用于基于所述u视差图与v视差图在所述道路的视差图像中确定用于表示障碍物的矩形区域;

计算子模块,用于根据所述矩形区域中障碍物视差点的视差值,计算出所述障碍物在所述三维坐标系中的坐标;

第二确定子模块,用于基于所述障碍物在所述三维坐标系中的坐标与所述指定坐标点,确定整体或部分位于所述妨碍车辆行驶区域中的至少一个障碍物。

根据本申请实施例的第三方面,提供一种道路障碍物预警终端,包括存储器、处理器、通信接口、摄像头组件,以及通信总线;

其中,所述存储器、处理器、通信接口、摄像头组件通过所述通信总线进行相互间的通信;

所述摄像头组件,用于采集道路图像,并通过所述通信总线将所述道路图像发送至所述处理器;

所述存储器,用于存放计算机程序;

所述处理器,用于执行所述存储器上所存放的计算机程序,所述处理器执行所述计算机程序时实现本申请实施例提供的任一道路障碍物预警方法的步骤。

根据本申请实施例的第四方面,提供一种计算机可读存储介质,所述计算机可读存储介质内存储有计算机程序,所述计算机程序被处理器执行时实现本申请实施例提供的任一道路障碍物预警方法的步骤。

由上述实施例可见,通过获取车辆当前的行驶速度与用于表征车辆的车头朝向与车轮行进方向之间夹角的转向角,基于该转向角在道路上确定妨碍车辆行驶区域,该妨碍车辆行驶区域位于车轮行进方向上,基于道路的视差图像确定整体或部分位于该妨碍车辆行驶区域中的至少一个障碍物,在该至少一个障碍物中确定距离车辆最近的目标障碍物,基于行驶速度与转向角预测出车辆行驶至目标障碍物处的行驶时长,若该行驶时长小于预设阈值,则进行障碍物预警。

由于在车辆的方向盘刚开始转动时,车轮行进方向发生变化,但车头朝向还未发生变化,双目相机的镜头朝向也未发生变化,拍摄得到的图像视角也就未发生变化,若以现有技术的方式确定的妨碍车辆行驶区域是位于车头朝向不是位于车轮行进方向,因此,在本申请中,基于转向角在道路上确定妨碍车辆行驶区域,使得所确定的妨碍车辆行驶区域位于车轮行进方向的前方,从而后续基于道路的视差图像确定出的整体或部分位于该妨碍车辆行驶区域中的至少一个障碍物,则位于车轮行进方向上,也就是真正可能会妨碍车辆行驶的障碍物。后续,基于该至少一个障碍物所确定出的目标障碍物进行障碍物预警,从而实现了及时提醒驾驶员行驶前方存在碰撞风险,以及时提醒驾驶员采取避让措施,避免车辆与障碍物发生碰撞。

综上所述,本申请提供的道路障碍物预警方法可以实现在车辆拐弯时,准确有效地实现障碍物预警,有效避免车辆与障碍物发生碰撞。

附图说明

图1所示,为现有技术中妨碍车辆行驶区域的一种示例;

图2为本申请一示例性实施例提供的道路障碍物预警方法的实施例流程图;

图3a为本申请一示例性实施例中三维坐标系的一种示例;

图3b为在道路上设置的妨碍车辆行驶区域的俯视图的一种示例;

图4a为本申请另一示例性实施例中三维坐标系的一种示例;

图4b为在道路上设置的妨碍车辆行驶区域的俯视图的另一种示例;

图5为图3a所示例的三维坐标系与图4a所示例的三维坐标系的一种示例;

图6为图3a所示三维坐标系的xz平面的一种示例;

图7为图4a所示三维坐标系的xz平面的一种示例;

图8为本申请一示例性实施例提供的道路障碍物预警装置的实施例框图;

图9为本申请道路障碍物预警装置所在道路障碍物预警终端的一种硬件结构图。

具体实施方式

这里将详细地对示例性实施例进行说明,其示例表示在附图中。下面的描述涉及附图时,除非另有表示,不同附图中的相同数字表示相同或相似的要素。以下示例性实施例中所描述的实施方式并不代表与本申请相一致的所有实施方式。相反,它们仅是与如所附权利要求书中所详述的、本申请的一些方面相一致的装置和方法的例子。

在本申请使用的术语是仅仅出于描述特定实施例的目的,而非旨在限制本申请。在本申请和所附权利要求书中所使用的单数形式的“一种”、“所述”和“该”也旨在包括多数形式,除非上下文清楚地表示其他含义。还应当理解,本文中使用的术语“和/或”是指并包含一个或多个相关联的列出项目的任何或所有可能组合。

应当理解,尽管在本申请可能采用术语第一、第二、第三等来描述各种信息,但这些信息不应限于这些术语。这些术语仅用来将同一类型的信息彼此区分开。例如,在不脱离本申请范围的情况下,第一信息也可以被称为第二信息,类似地,第二信息也可以被称为第一信息。取决于语境,如在此所使用的词语“如果”可以被解释成为“在……时”或“当……时”或“响应于确定”。

目前,道路障碍物预警系统是以相机的镜头朝向为基准在道路上设置妨碍车辆行驶区域的,并且,由于相机通常安装于车头前挡风玻璃处,从而相机的镜头朝向也就是车辆的车头朝向,从而也可以理解为道路障碍物预警系统是以车辆的车头朝向为基准设置妨碍车辆行驶区域的。具体的,所设置的妨碍车辆行驶区域位于车头正前方,且以经过车头中心的轴线为对称轴呈对称分布,例如,如图1所示,为现有技术中妨碍车辆行驶区域的一种示例,其中,图1(a)为道路图像的一种示例,在图1(a)中,黑色实线所框定的不规则区域(非矩形区域)为妨碍车辆行驶区域,图1(b)为真实道路场景俯视图的一种示例,在图1(b)中,虚线框13所表示的区域为妨碍车辆行驶区域,虚线框12所表述的区域为检测区域。

道路障碍物预警系统检测上述妨碍车辆行驶区域中是否存在障碍物,具体的,道路障碍物预警系统可以在道路的视差图像中检测出障碍物,例如,图1(a)中所示例的黑色实线矩形框即表示检测出的障碍物(本领域技术人员可以理解的是,视差图像与原图像的大小相同,每一像素点所对应的实体也相同,从而障碍物在视差图像中与原图像中的位置相同),进一步确定所检测出的障碍物是否位于妨碍车辆行驶区域中。

本领域技术人员可以理解的是,仅仅通过图1(a)中表示障碍物的实线矩形框以及妨碍车辆行驶区域在图1(a)中的范围,是无法确定障碍物是否位于妨碍车辆行驶区域中的,同时,由于上述妨碍车辆行驶区域位于车头正前方,从而所检测出的位于妨碍车辆行驶区域中的障碍物也是位于车头正前方,而在车辆拐弯时,车头朝向与车轮行进方向呈现一定夹角,也即车辆行驶速度的方向与车头朝向并不相同,从而所检测出的位于妨碍车辆行驶区域中的障碍物并非会妨碍车辆行驶。

例如,图1(b)中所示例的障碍物10,该障碍物10落入虚线框13表示的妨碍车辆行驶区域中,假设根据车辆当前的行驶速度进行计算,预测出车辆行驶至该障碍物10所在位置处的时长,若该时长小于预设的时长阈值,此时,道路障碍物预警系统将进行预警。但是,从图1(b)中可见,车辆正在转弯,从而导致该障碍物10并不位于车辆的行驶方向上,也即该障碍物10并不会妨碍车辆行驶,从而此时的预警则为误预警;并且,真正妨碍车辆行驶的障碍物,例如图1(b)中所示例的障碍物11,则并不位于虚线框13表示的妨碍车辆行驶区域中,从而,道路障碍物预警系统也就无法实现针对真正妨碍车辆行驶的障碍物11进行障碍物预警。

基于此,本申请提供一种道路障碍物预警方法,在该方法中,基于车头朝向与车轮行进方向之间的夹角设置妨碍行驶区域,以使得妨碍行驶区域位于车轮行进方向上,并且,将检测出的障碍物与妨碍车辆行驶区域统一“映射”到一个三维坐标系中,由于三维坐标系是立体的,从而基于障碍物与妨碍车辆行驶区域各自在三维坐标系中的位置,即可确定障碍物是否位于妨碍车辆行驶区域中,进一步,则可以在落入妨碍车辆行驶区域的障碍物中确定距离车辆最近的障碍物,并预测出车辆行驶至该最近的障碍物所在位置处的行驶时长,若该行驶时长低于预设阈值,则可以认为车辆与该障碍物存在碰撞风险,即进行障碍物预警,以及时提醒驾驶员采取相应措施,例如转向、减速等措施,有效规避碰撞风险。

如下,示出下述实施例对本申请提供的道路障碍物预警方法进行详细说明:

请参见图2,为本申请一示例性实施例提供的道路障碍物预警方法的实施例流程图,包括以下步骤:

步骤201:获取车辆当前的行驶速度与转向角,其中,转向角用于表征车辆的车头朝向与车轮行进方向之间的夹角。

首先说明,在本申请实施例中,为了描述方便,将车头朝向与车轮行进方向之间的夹角称为转向角。

在本申请实施例中,可以采用obd(on-boarddiagnostic,车载诊断系统)检测装置获取车辆当前的行驶速度与转向角,采用obd检测装置获取车辆当前的行驶速度与转向角的具体过程可以参见现有技术中的相关描述,本申请对此不再详述。

需要说明的是,在实际应用中,也可以采用gps(globalpositioningsystem,全球定位系统)、测速装置等获取车辆当前的行驶速度,以及采用陀螺仪、惯性测量单元等获取车辆当前的转向角,本申请实施例对获取车辆当前的行驶速度与转向角的具体手段并不作限制。

步骤202:基于转向角在道路上确定妨碍车辆行驶区域,该妨碍车辆行驶区域位于车轮行进方向上。

在本申请实施例中,为了便于描述妨碍车辆行驶区域,以及便于后续步骤203中确定整体或部分位于妨碍车辆行驶区域中的障碍物,提出:按照预设规则建立与道路所在物理空间对应的三维坐标系,并基于转向角在该三维坐标系中确定指定坐标点,以指定坐标点为顶点,在三维坐标系中确定妨碍车辆行驶区域。

在本申请实施例中,以妨碍车辆行驶区域的形状为规则的四边形为例,示出如下基于转向角在道路上确定妨碍车辆行驶区域的具体方式:

在一个可选的实现方式中,可以以车头中心为坐标原点,以平行于地面指向车头正前方为z轴正方向,以垂直于地面指向地面上方为y轴正方向,以平行于地面指向车头右侧方向为x轴正方向建立三维坐标系,例如,如图3a所示,为本申请一示例性实施例中三维坐标系的一种示例。假设车辆向右侧拐弯行驶,那么,在图3a所示例的三维坐标系中,所确定的四个指定坐标点,即妨碍车辆行驶区域的四个顶点的坐标分别为

其中,xl为预设的左侧安全距离阈值,即车辆距离车道的左侧边界的安全距离,xr为预设的右侧安全距离阈值,即车辆距离车道的右侧边界的安全距离,通过设定xl与xr,可以使得所设定的妨碍车辆行驶区域的宽度大于车辆宽度,以增大针对妨碍车辆行驶的障碍物的检测范围,wcar为车辆的宽度,zobs为预设的最远检测距离阈值,例如为100米,h为车头中心点至地面的高度,zx则可以通过第一预设公式确定,该第一预设公式具体如下述公式(一)所示:

zx=t*v*sinα公式(一)

在上述公式(一)中,其中,α为当前的转向角,v为当前的行驶速度,也即上述公式(一)还可以表示为:

需要说明的是,上述xl与xr可以相同,也可以不同,若两者不同,则可以基于转弯方向设置上述xl与xr,例如,若向右侧转弯,则可以设置xr大于xl,若向左侧转弯,则可以设置xl大于xr,本申请对此并不作限制。

为了使本领域技术人员更加清楚地理解上述妨碍车辆行驶区域,本申请实施例还示出了图3b,如图3b所示,为在道路上设置的妨碍车辆行驶区域的俯视图的一种示例,图3b中所示例的虚线框即表示妨碍车辆行驶区域。

在另一可选的实现方式中,可以以车辆的车头中心点为坐标原点,以平行于地面指向车轮行进方向为z轴正方向,以垂直于地面指向地面上方为y轴正方向,以平行于地面指向右侧车轮方向为x轴正方向建立三维坐标系,例如,如图4a所示,为本申请另一示例性实施例中三维坐标系的一种示例,在该图4a所示例的三维坐标系中,所确定的四个指定坐标点,即妨碍车辆行驶区域的四个顶点的坐标分别为

其中,wd可以通过第二预设公式确定,该第二预设公式具体如下述公式(三)所示:

为了使本领域技术人员更加清楚地理解上述妨碍车辆行驶区域,本申请实施例还示出了图4b,如图4b所示,为在道路上设置的妨碍车辆行驶区域的俯视图的另一种示例。

步骤203:基于道路的视差图像确定整体或部分位于妨碍车辆行驶区域中的至少一个障碍物。

本领域技术人员可以理解的是,基于双目相机的“左眼”和“右眼”各自拍摄到的两幅道路图像可以生成道路的视差图像,为了描述方便,将该两幅图像分别称为第一图像和第二图像,进一步,基于该视差图像,还可以得到u视差图与v视差图,其中,视差图像可以为稀疏视差图,也可以为稠密视差图,本申请对此并不做限制;同时,基于视差图像得到u视差图与v视差图的具体过程,也可以参见现有技术中的相关描述,本申请对此不再详述。

首先说明,在本申请实施例中,为了准确、完整地检测出道路上的障碍物,可以在道路图像上设定一个较大的检测区域,这里所说的“较大”是指,检测区域对应的实际物理区域包含并大于妨碍车辆检测区域,例如,如图1(a)中的虚线框所框定的区域表示检测区域,相应的,图1(b)中的虚线框12为实际物理空间中的检测区域。通过该种处理,可以避免障碍物只有一部分落入妨碍车辆行驶区域的情形下,若直接仅检测妨碍车辆检测区域中的障碍物,导致无法检测到完整障碍物,检测效果较差的问题。

后续,基于上述u视差图与v视差图,在道路图像上的检测区域中检测出障碍物,例如,图1(a)中的实线矩形框所框定的矩形区域即表示检测出的障碍物。进一步,将检测出的障碍物“映射”至上述三维坐标系中,即确定障碍物在三维坐标系中的坐标,基于该坐标确定整体或部分位于妨碍车辆行驶区域中的至少一个障碍物。

具体的,可以根据表示障碍物的矩形区域中障碍物视差点的视差值,计算出障碍物在三维坐标系中的坐标,以图1(a)中的实线矩形框所框定的矩形区域为例,首先可以在该矩形区域中,滤除不符合预设障碍物视差范围的视差点,也即滤除噪点与背景像素点,滤除这些视差点之后,剩余视差点则为障碍物上的视差点,为了描述方便,将障碍物上的视差点称为障碍物视差点,后续,即可基于障碍物视差点确定障碍物在三维坐标系中的坐标。

(1)确定障碍物在图3a所示例的三维坐标系的z轴上的坐标:

根据上述建立图3a所示例的三维坐标系的相关描述可知,障碍物在三维坐标系的z轴上的坐标即表示障碍物距离双目相机的实际距离,而本领域技术人员可以理解的是,该实际距离与障碍物视差点的视差值具有一定关系,因此,在本申请实施例中,首先确定障碍物视差点的视差值。

而障碍物视差点具有多个,其视差值也分布在上述预设障碍物视差范围内,为了节省计算量,在一实施例中则提出,计算出所有障碍物视差点的平均视差值,计算出该平均视差值对应的实际距离,将所计算出的实际距离作为障碍物距离双目相机的实际距离,也即障碍物在三维坐标系的z轴上的坐标。

具体的,根据三维测距原理,可以通过如下公式(四)计算出障碍物在三维坐标系的z轴上的坐标:

上述公式(四)中,b为双目相机基线长度,f为双目相机的焦距,d为上述平均视差值,δd为无限远处的视差,其具体值通常为大于0小于1的小数,l为双目相机与车头中心点之间的纵向距离。

根据三维测距原理,推导得出上述公式(四)的具体过程,本领域技术人员可以参见现有技术中的相关描述,本申请对此不再详述。

(2)确定障碍物在图3a所示例的三维坐标系的x轴上的坐标:

本领域技术人员可以理解的是,障碍物具有一定的宽度,因此,可以分别确定障碍物的左侧边缘与右侧边缘在三维坐标系的x轴上的坐标。

1、确定障碍物的左侧边缘在三维坐标系的x轴上的坐标:

在表示障碍物的矩形区域中,选取左侧预设数量的列,计算出该些列中视差点的平均视差值,为了描述方便,将该平均视差值记为dl,后续,根据三维测距原理,可以通过如下公式(五)计算出障碍物的左侧边缘在三维坐标系中x轴上的坐标位置,为了描述方便,将该坐标位置记为xl。

2、确定障碍物的右侧边缘在三维坐标系的x轴上的坐标:

在表示障碍物的矩形区域中,选取右侧预设数量的列,计算出该些列中视差点的平均视差值,为了描述方便,将该平均视差值记为dr,后续,根据三维测距原理,可以通过如下公式(六)计算出障碍物的右侧边缘在三维坐标系中x轴上的坐标位置,为了描述方便,将该坐标位置记为xr。

在上述公式(五)与公式(六)中,w为道路的视差图像的宽度,u为视差点在图像坐标系中的x轴上坐标(图像坐标系以视差图像左上角顶点为坐标原点,水平向右为x轴正方向,水平向下为y轴正方向),δx为在三维坐标系的x轴方向上,双目相机与车头中心之间的实际距离,其中,若双目相机位于车头中心右侧,则δx为正值,若双目相机位于车头中心左侧,则δx为负值。

根据三维测距原理,推导得出上述公式(五)、(六)的具体过程,本领域技术人员可以参见现有技术中的相关描述,本申请对此不再详述。

(3)确定障碍物在图3a所示例的三维坐标系的y轴上的坐标:

本领域技术人员可以理解的是,障碍物具有一定的高度,因此,可以分别确定障碍物的底部边缘与顶部边缘在三维坐标系中y轴上的坐标。

1、确定障碍物的底部边缘在三维坐标系的y轴上的坐标:

与上述(2)中的描述类似,可以在表示障碍物的矩形区域中,选取底部预设数量的行,计算出该些行中视差点的平均视差值,为了描述方便,将该平均视差值记为dd,后续,根据三维测距原理,可以通过如下公式(七)计算出障碍物的底部边缘在三维坐标系中y轴上的坐标,为了描述方便,将该坐标位置记为yd。

2、确定障碍物的顶部边缘在三维坐标系的y轴上的坐标:

与上述(2)中的描述类似,可以在表示障碍物的矩形区域中,选取顶部预设数量的行,计算出该些行中视差点的平均视差值,为了描述方便,将该平均视差值记为du,后续,根据三维测距原理,可以通过如下公式(八)计算出障碍物的顶部边缘在三维坐标系中y轴上的坐标,为了描述方便,将该坐标位置记为yu。

在上述公式(七)与公式(八)中,h为道路的视差图像的高度,v为视差点在图像坐标系中的y轴上坐标(图像坐标系以视差图像左上角顶点为坐标原点,水平向右为x轴正方向,水平向下为y轴正方向),δy为在三维坐标系的y轴方向上,双目相机与车头中心之间的实际距离,其中,若双目相机位于车头中心上部,则δy为正值,若双目相机位于车头中心下部,则δy为负值。

根据三维测距原理,推导得出上述公式(七)、(八)的具体过程,本领域技术人员可以参见现有技术中的相关描述,本申请对此不再详述。

(4)确定障碍物在图4a所示例的三维坐标系的z轴上的坐标:

请参见图5,为图3a所示例的三维坐标系与图4a所示例的三维坐标系的一种示例,在图5中,z轴与x轴为图3a所示例的三维坐标系中的z轴与x轴,z’轴与x’轴为图4a所示例的三维坐标系中的z轴与x轴,根据上述建立图3a所示例的三维坐标系与建立图4a所示例的三维坐标系的相关描述可知,在图5中,z轴z’轴之间的夹角为α(转向角),x轴与x’轴之间的夹角也为α,假设a点为障碍物,根据数学概念可以得知:

bc=ob*tanα;ad=ac*cosα;ac=ab+bc;

据此,即可推导出:

ad=(ab+ob*tanα)*cosα=ab*cosα+ob*sinα。

本领域技术人员可以理解的是,上述ad的值可以表示障碍物在图4a所示例三维坐标系中z轴上的坐标,ab的值可以表示同一障碍物在图3a所示例三维坐标系中z轴上的坐标,因此,结合上述公式(四)与公式(五)(或公式(六)),即可得到下述公式(九),根据该公式(九)即可计算出障碍物在图4a所示例三维坐标系中z轴上的坐标:

(5)确定障碍物在图4a所示例的三维坐标系的x轴上的坐标:

继续参见图5,根据数学概念可知:

od=cd-oc;cd=ac*sinα;ac=ab+bc;bc=ob*tanα

据此,即可推导出:

本领域技术人员可以理解的是,上述od的值可以表示障碍物在图4a所示例三维坐标系中x轴上坐标的相反数,ob可以表示同一障碍物在图3a所示例三维坐标系中x轴上的坐标,ab可以表示同一障碍物在图3a所示例三维坐标系中z轴上的坐标,因此,结合上述公式(四)与公式(五)(或公式(六)),即可得到下述公式(十),根据该公式(十)即可计算出障碍物的左侧边缘在图4a所示例三维坐标系中x轴上的坐标:

本领域技术人员可以理解的是,将上述公式(十)中的dl替换为dr,即可以计算出障碍物的右侧边缘在图4a所示例三维坐标系中x轴上的坐标,具体的公式在此不再详示。

(6)确定障碍物在图4a所示例的三维坐标系的y轴上的坐标:

根据上述建立图3a所示例的三维坐标系与建立图4a所示例的三维坐标系的相关描述可知,同一障碍物在图3a所示例的三维坐标系中,与在图4a所示例的三维坐标系中y轴上的坐标相同,基于此,确定障碍物在图4a所示例的三维坐标系中y轴上的坐标的具体过程,可以参见上述(3)中的具体描述,在此不再详述。

进一步,根据障碍物在三维坐标系中的坐标,与上述步骤202中描述的妨碍车辆行驶区域在三维坐标系中的坐标,即可确定障碍物是否位于妨碍车辆行驶区域中。具体的,根据图3a与图4a所示例的三维坐标系可以得知,确定障碍物是否位于妨碍车辆行驶区域中,可以首先判断障碍物在z轴上的坐标是否小于妨碍车辆行驶区域在z轴上的最大坐标(对于图3a所示例的三维坐标系而言,该最大坐标为zobs,对于图4a所示例的三维坐标系而言,该最大坐标为),若小于,则继续判断障碍物在x轴上的坐标与妨碍车辆行驶区域在x轴上的坐标是否有重合,例如,可以判断(xl,xr)这一范围与(xa,xb)这一范围是否有交集,其中,对于图3a所示三维坐标系而言,对于图4a所示三维坐标系而言,若有交集,则可以确定障碍物位于妨碍车辆行驶区域中。

为了使本领域技术人员可以更加清楚地理解上述描述,示出如下举例:

对应图3a所示三维坐标系而言:

如图6所示,为图3a所示三维坐标系的xz平面的一种示例,本领域技术人员可以理解的是,在xz平面上,障碍物仅表示为一条横线段,例如图6中所示例的横线段1、2、3、4、5,图6中的矩形虚线框表示检测区域,平行四边形虚线框表示妨碍车辆行驶区域。如图6所示,横线段3、4表示的障碍物整体落入妨碍车辆行驶区域中,横线段5表示的障碍物部分落入妨碍车辆行驶区域中。

对应图4a所示例的三维坐标系而言:

如图7所示,为图4a所示三维坐标系的xz平面的一种示例,与上述描述相类似,图7中示例的横线段1、2、3、4、5(该5个障碍物与上述5个障碍物相同),图7中较大的矩形虚线框表示检测区域,较小的矩形虚线框表示妨碍车辆行驶区域。如图7所示,横线段3、4表示的障碍物整体落入妨碍车辆行驶区域中,横线段5表示的障碍物部分落入妨碍车辆行驶区域中。

此外,在本申请实施例中,还可以基于障碍物在三维坐标系的y轴上的坐标,确定该障碍物是否位于道路路面上,以及该障碍物的高度,本领域技术人员可以理解的是,若障碍物位于车辆上方,且在y轴方向上,与车辆之间的距离满足预设条件,例如大于预设的距离阈值,则该障碍物并不会妨碍车辆行驶,又例如,障碍物的高度较低,例如小于预设的高度阈值,则该障碍物也不会妨碍车辆行驶,基于此,在本申请实施例中,则可以首先基于障碍物在三维坐标系的y轴上的坐标滤除不会妨碍车辆行驶的障碍物,继而再基于z轴与x轴上的坐标确定障碍物是否整体或部分落入妨碍车辆行驶区域中。

步骤204:在至少一个障碍物中确定距离车辆最近的目标障碍物。

在本申请实施例中,可以在步骤203所确定的至少一个障碍物中,确定在z轴上坐标最小的障碍物,将该障碍物确定为距离车辆最近的障碍物,为了描述方便,将该最近的障碍物称为目标障碍物,例如,在图6中,横线段5表示的障碍物为确定的目标障碍物,又例如,在图7中,横线段5表示的障碍物为确定的目标障碍物,由此可见,针对相同的障碍物,采用图3a所示例的方法建立三维坐标系,与采用图4a所示例的方法建立三维坐标系,最终实现的效果相同。

步骤205:基于行驶速度与转向角预测出车辆行驶至目标障碍物处的行驶时长,若行驶时长小于预设阈值,则进行障碍物预警。

在本申请实施例中,针对图3a所示例的三维坐标系,可以通过如下公式(十一)预测出车辆行驶至目标障碍物处的行驶时长:

上述公式(十一)中,t为车辆行驶至目标障碍物处的行驶时长,z为目标障碍物在z轴上的坐标,v为车辆当前的行驶速度,v*cosα则表示该行驶速度在z轴方向上的分速度。

在本申请实施例中,针对图4a所示例的三维坐标系,如图5所示,假设车辆与a点发生碰撞,并假设碰撞点为e,根据数学概念可知,

从而,可以通过如下公式(十二)预测出车辆行驶至目标障碍物处的行驶时长:

通过上述描述可知,ab的值可以表示障碍物在图3a所示例三维坐标系中z轴上的坐标,由此可见,针对同一障碍物,采用公式(十一)与公式(十二)所预测出的行驶时长相同。

若预测出的行驶时长小于预设阈值,例如5s,则可以认为车辆与目标障碍物具有碰撞风险,此时,则可以进行障碍物预警。

由上述实施例可见,通过获取车辆当前的行驶速度与用于表征车辆的车头朝向与车轮行进方向之间夹角的转向角,基于该转向角在道路上确定妨碍车辆行驶区域,该妨碍车辆行驶区域位于车轮行进方向上,基于道路的视差图像确定整体或部分位于该妨碍车辆行驶区域中的至少一个障碍物,在该至少一个障碍物中确定距离车辆最近的目标障碍物,基于行驶速度与转向角预测出车辆行驶至目标障碍物处的行驶时长,若该行驶时长小于预设阈值,则进行障碍物预警。

由于在车辆的方向盘刚开始转动时,车轮行进方向即发生变化,但车头朝向还未发生变化,从而双目相机的镜头朝向也未发生变化,拍摄得到的图像视角也就未发生变化,从而,在本申请中,基于转向角在道路上确定妨碍车辆行驶区域,使得所确定的妨碍车辆行驶区域位于车轮行进方向的前方,从而后续基于道路的视差图像确定出的整体或部分位于该妨碍车辆行驶区域中的至少一个障碍物,则位于车轮行进方向上,也就是真正可能会妨碍车辆行驶的障碍物。后续,若基于该至少一个障碍物所确定出的目标障碍物进行障碍物预警,则并非是误预警,从而实现了及时提醒驾驶员行驶前方存在碰撞风险,以及时提醒驾驶员采取避让措施,避免车辆与障碍物发生碰撞。

综上所述,本申请提供的道路障碍物预警方法可以实现在车辆拐弯时,准确有效地实现障碍物预警,有效避免车辆与障碍物发生碰撞。

与前述道路障碍物预警方法的实施例相对应,本申请还提供了道路障碍物预警装置的实施例。

请参见图8,为本申请一示例性实施例提供的道路障碍物预警装置的实施例框图,该装置可以包括:参数获取模块81、区域确定模块82、障碍物确定模块83、目标确定模块84,以及预警模块85。

其中,参数获取模块81,用于获取车辆当前的行驶速度与转向角,其中,所述转向角用于表征所述车辆的车头朝向与车轮行进方向之间的夹角;

区域确定模块82,用于基于所述转向角在道路上确定妨碍车辆行驶区域,所述妨碍车辆行驶区域位于所述车轮行进方向上;

障碍物确定模块83,用于基于道路的视差图像确定整体或部分位于所述妨碍车辆行驶区域中的至少一个障碍物;

目标确定模块84,用于在所述至少一个障碍物中确定距离所述车辆最近的目标障碍物;

预警模块85,用于基于所述行驶速度与所述转向角预测出所述车辆行驶至所述目标障碍物处的行驶时长,若所述行驶时长小于预设阈值,则进行障碍物预警。

在一实施例中,所述区域确定模块82可以包括(图8中未示出):

坐标系建立子模块,用于按照预设规则建立与道路所在物理空间对应的三维坐标系;

坐标点确定子模块,用于基于所述转向角在所述三维坐标系中确定指定坐标点;

连接子模块,用于连接所述指定坐标点,将连接所述指定坐标点的连线所围成的区域确定为妨碍车辆行驶区域。

在一实施例中,所述坐标系建立子模块,具体可以用于:

以所述车辆的车头中心点为坐标原点,以平行于地面指向车头正前方为z轴正方向,以垂直于地面指向地面上方为y轴正方向,以平行于地面指向车头右侧方向为x轴正方向建立三维坐标系。

在一实施例中,所述坐标系建立子模块,具体可以用于:

以所述车辆的车头中心点为坐标原点,以平行于地面指向车轮行进方向为z轴正方向,以垂直于地面指向地面上方为y轴正方向,以平行于地面指向右侧车轮方向为x轴正方向建立三维坐标系。

在一实施例中,确定出的所述指定坐标点在所述三维坐标系中的坐标分别为:

所述xl为预设的左侧安全距离阈值,所述xr为预设的右侧安全距离阈值,所述wcar为所述车辆的宽度,所述zobs为预设的最远检测距离阈值,所述h为车头中心点至地面的高度,所述zx通过第一预设公式确定;

所述第一预设公式为:zx=zobs*tanα,其中,所述α为转向角。

在一实施例中,确定出的所述指定坐标点在所述三维坐标系中的坐标分别为:

所述xl为预设的左侧安全距离阈值,所述xr为预设的右侧安全距离阈值,所述zobs为预设的最远检测距离阈值,所述h为车头中心点至地面的高度,所述wd通过第二预设公式确定;

所述第二预设公式为:其中,所述wcar为所述车辆的宽度,所述α为转向角。

在一实施例中,所述障碍物确定模块83可以包括(图8中未示出):

视差图生成子模块,用于基于双目摄像机当前拍摄到的第一图像与第二图像生成所述道路的视差图像、u视差图以及v视差图;

第一确定子模块,用于基于所述u视差图与v视差图在所述道路的视差图像中确定用于表示障碍物的矩形区域;

计算子模块,用于根据所述矩形区域中障碍物视差点的视差值,计算出所述障碍物在所述三维坐标系中的坐标;

第二确定子模块,用于基于所述障碍物在所述三维坐标系中的坐标与所述指定坐标点,确定整体或部分位于所述妨碍车辆行驶区域中的至少一个障碍物。

上述装置中各个单元的功能和作用的实现过程具体详见上述方法中对应步骤的实现过程,在此不再赘述。

本申请道路障碍物预警装置的实施例可以应用在道路障碍物预警终端上。装置实施例可以通过软件实现,也可以通过硬件或者软硬件结合的方式实现。以软件实现为例,作为一个逻辑意义上的装置,是通过其所在道路障碍物预警终端的处理器将非易失性存储器中对应的计算机程序指令读取到内存中运行形成的。从硬件层面而言,如图9所示,为本申请道路障碍物预警装置所在道路障碍物预警终端的一种硬件结构图,其中,处理器901是该道路障碍物预警终端900的控制中心,利用各种接口和线路连接整个该道路障碍物预警装置的各个部分,通过运行或执行存储在存储器902内的软件程序和/或模块,以及调用存储在存储器902内的数据,执行道路障碍物预警装置900的各种功能和处理数据,从而对该道路障碍物预警装置进行整体监控。

可选的,处理器901可包括(图9中未示出)一个或多个处理核心;可选的,处理器901可集成应用处理器和调制解调处理器,其中,应用处理器主要处理操作系统、用户界面和应用程序等,调制解调处理器主要处理无线通信。可以理解的是,上述调制解调处理器也可以不集成到处理器901中。

存储器902可用于存储软件程序以及模块,处理器901通过运行存储在存储器902的软件程序以及模块,从而执行各种功能应用以及数据处理。存储器902主要包括(图9中未示出)存储程序区和存储数据区,其中,存储程序区可存储操作系统、至少一个功能所需的应用程序等;存储数据区可存储根据道路障碍物预警装置900的使用所创建的数据(比如采集到的图像、计算得到的视差图像或者处理得到的灰度图像)等。

此外,存储器902可以包括(图9中未示出)高速随机存取存储器,还可以包括(图9中未示出)非易失性存储器,例如至少一个磁盘存储器件、闪存器件、或其他易失性固态存储器件。相应地,存储器902还可以包括(图9中未示出)存储器控制器,以提供处理器901对存储器902的访问。

在一些实施例中,装置900还可选包括有:外围设备接口903和至少一个外围设备。处理器901、存储器902和外围设备接口903之间可以通信总线或信号线(图9中未示出)相连。各个外围设备可以通信总线或信号线与外围设备接口903相连。具体地,外围设备可以包括:射频组件904、触摸显示屏905、摄像头组件906、音频组件907、定位组件908和电源组件909中的至少一种。

其中,摄像头组件906用于采集道路图像。可选地,摄像头组件906可以包括至少两个摄像头。在一些实施例中,至少两个摄像头可以分别为双目摄像头中的左右摄像头。

在一些实施例中,摄像头组件906还可以包括闪光灯。闪光灯可以是单色温闪光灯,也可以是双色温闪光灯。双色温闪光灯是指暖光闪光灯和冷光闪光灯的组合,可以用于不同色温下的光线补偿。

除了图9所示例的各个硬件之外,实施例中装置所在的道路障碍物预警终端通常根据该道路障碍物预警终端的实际功能,还可以包括其他硬件,对此不再赘述。

本领域技术人员可以理解的是,图9所示例的道路障碍物预警终端可以应用在汽车上,也可以应用在电脑、智能手机等其他设备上,本申请对此并不作限制。

本申请还提供一种计算机可读存储介质,所述计算机可读存储介质内存储有计算机程序,所述计算机程序被处理器执行时实现本申请实施例提供的任一道路障碍物预警方法的步骤。

对于装置实施例而言,由于其基本对应于方法实施例,所以相关之处参见方法实施例的部分说明即可。以上所描述的装置实施例仅仅是示意性的,其中所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本申请方案的目的。本领域普通技术人员在不付出创造性劳动的情况下,即可以理解并实施。

以上所述仅为本申请的较佳实施例而已,并不用以限制本申请,凡在本申请的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本申请保护的范围之内。

当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1