本发明涉及倒车辅助系统技术领域,尤其涉及一种汽车轨迹线标定方法及系统。
背景技术:
目前,由于从can总线获取的汽车转向角并不是实际的转向角度,而是把角度平分成很多个级别,要获取精准轨迹线,那么必须知道每个转向角级别对应的实际角度。市场上已有的产品中,有的是直接估计最大转向角度,或者在前轮的最大转向角时形成的三角关系来计算最大转向角;也有一些使用简单方法量出转弯时的角度,然而前轮的左右最大角度是不同的,而且实际车中还存在机械误差,因此这些轨迹线必须根据实际车辆进行动态标定,才能够得到实际汽车的转向角度。
技术实现要素:
本发明提供一种汽车轨迹线标定方法及系统,旨在提高汽车轨迹线标定的精准度。
为了实现上述目的,本发明提出一种汽车轨迹线标定方法,包括:
在汽车后方摄像头可拍摄范围的地面铺设格子平面标识物;
汽车在不同方向移动过程中,通过对比后方摄像头拍摄的相邻两帧图像的格子点坐标,确定汽车转向的圆心点,进而分别标定汽车在不同移动方向的最大转向角度;
根据标定的汽车在不同移动方向的最大转向角度和转向角级别,获得汽车实际在不同移动方向的最大转向角度;
根据汽车实际在不同移动方向的最大转向角度获得汽车轨迹线。
优选地,所述的汽车在不同移动方向的最大转向角度,包括:汽车前进时向左的最大转向角度、汽车前进时向右的最大转向角度、汽车后退时向左的最大转向角度和汽车后退时向右的最大转向角度。
优选地,所述的在汽车后方摄像头可拍摄范围的地面铺设格子平面标识物步骤与汽车在不同方向移动过程中,通过对比后方摄像头拍摄的相邻两帧图像的格子点坐标,确定汽车转向的圆心点,进而分别标定汽车在不同移动方向的最大转向角度步骤之间,还包括:
通过后方摄像头拍摄格子平面标识物的图像,并将平面标识物的图像投影在显示界面的地面上。
优选地,所述的通过对比后方摄像头拍摄的相邻两帧图像的格子点坐标,确定汽车转向的圆心点,具体如下:
在图像中构建坐标系,确定前一帧图像中格子点坐标,并确定前一帧图像中汽车两后轮在坐标系中的坐标,获得后轮中心轴线方程;
在同一坐标系下,确定相邻后一帧图像中格子点坐标;
根据前一帧图像中格子点坐标和相邻后一帧图像中格子点坐标,确定坐标前后变换矩阵;
根据变换矩阵和前一帧图像中汽车后轮中心轴线方程,确定相邻后一帧图像中汽车后轮中心轴线方程,进而获得相邻两帧图像中汽车后轮中心轴线方程的交点,即获得汽车转向的圆心点。
优选地,所述的汽车在不同方向移动过程中,通过对比后方摄像头拍摄的相邻两帧图像的格子点坐标,确定汽车转向的圆心点,进而分别标定汽车在不同移动方向的最大转向角度步骤与根据标定的汽车在不同移动方向的最大转向角度和转向角级别,获得汽车实际在不同移动方向的最大转向角度步骤之间,还包括:
进行多次对比相邻两帧图像的格子点坐标,获得各移动方向的多个最大转向角度值,选取其中的中间值作为对应移动方向的最终标定最大转向角度。
优选地,所述的根据标定的汽车在不同移动方向的最大转向角度和转向角级别,获得汽车实际在不同移动方向的最大转向角度,具体为:
根据汽车内can总线获取的转向角级别与转向角级别范围极值的比例关系,结合标定的汽车在不同移动方向的最大转向角度,获得汽车实际在不同移动方向的最大转向角度。
本发明还提出一种汽车轨迹线标定系统,包括汽车轨迹线生成单元、摄像头,还包括:铺设在汽车后方摄像头可拍摄范围地面的格子平面标识物、汽车最大转向角度标定单元和汽车实际最大转向角度获取单元;
所述的汽车最大转向角度标定单元:用于汽车在不同方向移动过程中,通过对比后方摄像头拍摄的相邻两帧图像的格子点坐标,确定汽车转向的圆心点,进而分别标定汽车在不同移动方向的最大转向角度,并发送至汽车实际最大转向角度获取单元;
所述的汽车实际最大转向角度获取单元:用于根据标定的汽车在不同移动方向的最大转向角度和转向角级别,获得汽车实际在不同移动方向的最大转向角度,并发送至汽车轨迹线生成单元供其生成和显示轨迹线。
优选地,所述的汽车最大转向角度标定单元,包括:
图像坐标构建模块:用于在每帧图像中构建相同的坐标系,并将构建完坐标系的图像发送至第一图像处理模块或第二图像处理模块;
第一图像处理模块:用于确定前一帧图像中格子点坐标并发送至变换矩阵确定模块中;用于确定前一帧图像中汽车两后轮在坐标系中的坐标,获得后轮中心轴线方程并发送至转向圆心点生成模块;
第二图像处理模块:用于确定相邻后一帧图像中格子点坐标并发送至变换矩阵确定模块中;
变换矩阵确定模块:用于根据前一帧图像中格子点坐标和相邻后一帧图像中格子点坐标,确定格子点坐标前后的变换矩阵,并发送至转向圆心点生成模块;
圆心点生成模块:用于根据变换矩阵和前一帧图像中汽车后轮中心轴线方程,确定相邻后一帧图像中汽车后轮中心轴线方程,进而获得相邻两帧图像中汽车后轮中心轴线方程的交点,即获得汽车转向的圆心点,并发送至汽车最大转向角度标定模块;
汽车最大转向角度标定模块:用于根据汽车转向的圆心点的位置,确定汽车在不同移动方向的最大转向角度。
本发明提供的一种汽车轨迹线标定方法及系统,首先标定出前进时向左最大角度、向右最大角度以及后退时向左最大角度、向右最大角度,再根据各个最大角度和can总线的转向角级别获取实际的转向角度,最后根据实际的转向角得到精准的轨迹线;通过本发明能够简单快捷的标定的计算精准轨迹需要的最大角度。通过摄像头图像上的精准轨迹线,可以帮助汽车使用者准确地判断出汽车行进轨迹,减少事故的发生。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图示出的结构获得其他的附图。
图1为本发明一种实施例中汽车轨迹线标定方法流程图;
图2为本发明一种实施例中棋盘布示意图;
图3为本发明一种实施例中棋盘布与汽车位置关系示意图;
图4为本发明一种实施例中步骤s50流程图;
图5为本发明一种实施例中步骤s20具体流程图;
图6为本发明一种实施例中图像坐标系示意图;
图7为本发明一种实施例中步骤s60流程图;
图8为本发明一种实施例中步骤s301流程图;
图9为本发明一种实施例中汽车轨迹线标定系统结构框图;
图10为本发明一种实施例中汽车最大转向角度标定单元结构框图;
本发明目的的实现、功能特点及优点将结合实施例,参照附图做进一步说明。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
需要说明,若本发明实施例中有涉及方向性指示(诸如上、下、左、右、前、后……),则该方向性指示仅用于解释在某一特定姿态(如附图所示)下各部件之间的相对位置关系、运动情况等,如果该特定姿态发生改变时,则该方向性指示也相应地随之改变。
另外,若本发明实施例中有涉及“第一”、“第二”等的描述,则该“第一”、“第二”等的描述仅用于描述目的,而不能理解为指示或暗示其相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。另外,各个实施例之间的技术方案可以相互结合,但是必须是以本领域普通技术人员能够实现为基础,当技术方案的结合出现相互矛盾或无法实现时应当认为这种技术方案的结合不存在,也不在本发明要求的保护范围之内。
由于从can总线获取的汽车转向角并不是实际的转向角度,而是把角度平分成很多个级别,因此,本发明假设转向角级别范围为[-a,a],当转向角级别处于最大时,前进和后退的轨迹也会存在区别;因此,本发明需要获取4个最大角度,即前进时向左最大角度afl向右的最大角度afr,以及后退时向左的最大角度abl、向右的最大角度abr;
本发明提出一种汽车轨迹线标定方法;
本发明一种优选实施例中,如图1所示,包括:
s10、在汽车后方摄像头可拍摄范围的地面铺设格子平面标识物;
本发明实施例中,所述的格子平面标识物选择一种棋盘布,可以检测出角点即可,假是棋盘布的格子数为m×n;如图2所示,所选择是7x5的棋盘布;将棋盘布平铺在车后方摄像头可以拍摄到的位置,如图3所示;假设车宽为w,后轮轴到后摄像头的距离为d;
s20、汽车在不同方向移动过程中,通过对比后方摄像头拍摄的相邻两帧图像的格子点坐标,确定汽车转向的圆心点,进而分别标定汽车在不同移动方向的最大转向角度;
本发明一种优选实施例中,汽车缓慢的移动,在此过程中通过后方摄像头拍摄每帧棋盘布的图像,相邻帧的棋盘格可以估算出一个最大角度,由于汽车转向时,圆心是在后轮轴的中心轴线上,相邻帧中,以前一帧作为参考来计算最大转向角αi;
所述的汽车在不同移动方向的最大转向角度包括:汽车前进时向左的最大转向角度、汽车前进时向右的最大转向角度、汽车后退时向左的最大转向角度和汽车后退时向右的最大转向角度;
s30、根据标定的汽车在不同移动方向的最大转向角度和转向角级别,获得汽车实际在不同移动方向的最大转向角度;
s40、根据汽车实际在不同移动方向的最大转向角度获得汽车轨迹线。
本发明实施例中,将汽车实际在不同移动方向的最大转向角度输入至汽车内部的影像系统,显示精准的汽车轨迹线;
本发明一种优选实施例中,如图4所示,在步骤s10与步骤s20之间,还包括:
s50、通过后方摄像头拍摄格子平面标识物的图像,并将平面标识物的图像投影在显示界面的地面上。
本发明实施例中,汽车缓慢行进过程中,将每帧后摄像头图像都投影在显示界面地面上,假设投影图像宽为w,使用投影图像检测出棋盘格相对车的位置;
本发明一种优选实施例中,如图5所示,步骤s20中所述的通过对比后方摄像头拍摄的相邻两帧图像的格子点坐标,确定汽车转向的圆心点,具体步骤如下:
s201、在图像中构建坐标系,确定前一帧图像中格子点坐标,并确定前一帧图像中汽车两后轮在坐标系中的坐标,获得后轮中心轴线方程;
本发明实施例中,如图6所示,在图像中构建坐标系,以汽车尾部摄像头所在平面作为坐标系的横坐标,过后轮中心点垂直于车尾所在平面做坐标系的纵坐标,前一帧检测出的棋盘格的点坐标为
s202、在同一坐标系下,确定相邻后一帧图像中格子点坐标;
本发明实施例中,后一帧检测出的棋盘格点坐标为
s203、根据前一帧图像中格子点坐标和相邻后一帧图像中格子点坐标,确定坐标前后变换矩阵;
本发明实施例中,通过前一帧检测出的棋盘格的点坐标为
s204、根据变换矩阵和前一帧图像中汽车后轮中心轴线方程,确定相邻后一帧图像中汽车后轮中心轴线方程,进而获得相邻两帧图像中汽车后轮中心轴线方程的交点,即获得汽车转向的圆心点。
本发明实施例中,p10=t·p00,p11=t·p01;使用两点公式计算出经过点p10和点p11的直线方程y1=k1·x+b1;直线y=k0·x+b0和直线y1=k1·x+b1的交点就是汽车转向的圆心点o1(x0,y0);该相邻帧估算出来的最大转向角αi=arctan(b/(w-y0)),b是后轮轴中心到o1的距离。
本发明一种优选实施例中,如图7所示,在步骤s20与步骤s30之间,还包括:
s60、进行多次对比相邻两帧图像的格子点坐标,获得各移动方向的多个最大转向角度值,选取其中的中间值作为对应移动方向的最终标定最大转向角度。
本发明实施例中,经过i次相邻帧的计算得到多个最大转向角集合a={α0,α1,...,αi};对a进行排序,假设中值为αm,则标定出来前进时向左最大角度afl、向右的最大角度afr、后退时向左的最大角度abl、向右的最大角度abr;
本发明一种优选实施例中,如图8所示,所述的步骤s30,具体为:
s301、根据汽车内can总线获取的转向角级别与转向角级别范围极值的比例关系,结合标定的汽车在不同移动方向的最大转向角度,获得汽车实际在不同移动方向的最大转向角度。
本发明实施例中,当前从can总线获取的转向角级别为a,如果汽车向左转向(a<0),若汽车是前进的,则此时的实际转向角度为
本发明还提出一种汽车轨迹线标定系统;
本发明一种优选实施例中,如图9所示,该系统包括汽车轨迹线生成单元、摄像头,还包括:铺设在汽车后方摄像头可拍摄范围地面的格子平面标识物、汽车最大转向角度标定单元和汽车实际最大转向角度获取单元;
汽车最大转向角度标定单元:用于汽车在不同方向移动过程中,通过对比后方摄像头拍摄的相邻两帧图像的格子点坐标,确定汽车转向的圆心点,进而分别标定汽车在不同移动方向的最大转向角度,并发送至汽车实际最大转向角度获取单元;
本发明一种优选实施例中,汽车缓慢的移动,在此过程中通过后方摄像头拍摄每帧棋盘布的图像,相邻帧的棋盘格可以估算出一个最大角度,由于汽车转向时,圆心是在后轮轴的中心轴线上,相邻帧中,以前一帧作为参考来计算最大转向角αi;
汽车实际最大转向角度获取单元:用于根据标定的汽车在不同移动方向的最大转向角度和转向角级别,获得汽车实际在不同移动方向的最大转向角度,并发送至汽车轨迹线生成单元供其生成和显示轨迹线。
本发明一种优选实施例中,根据汽车内can总线获取的转向角级别与转向角级别范围极值的比例关系,结合标定的汽车在不同移动方向的最大转向角度,获得汽车实际在不同移动方向的最大转向角度;具体为:当前从can总线获取的转向角级别为a,如果汽车向左转向(a<0),若汽车是前进的,则此时的实际转向角度为
本发明一种优选实施例中,如图10所示,所述的汽车最大转向角度标定单元,包括:
图像坐标构建模块:用于在每帧图像中构建相同的坐标系,并将构建完坐标系的图像发送至第一图像处理模块或第二图像处理模块;
本发明实施例中,在图像中构建坐标系,以汽车尾部摄像头所在平面作为坐标系的横坐标,过后轮中心点垂直于车尾所在平面做坐标系的纵坐标;
第一图像处理模块:用于确定前一帧图像中格子点坐标并发送至变换矩阵确定模块中;用于确定前一帧图像中汽车两后轮在坐标系中的坐标,获得后轮中心轴线方程并发送至转向圆心点生成模块;
本发明实施例中,前一帧检测出的棋盘格的点坐标为
第二图像处理模块:用于确定相邻后一帧图像中格子点坐标并发送至变换矩阵确定模块中;
本发明实施例中,后一帧检测出的棋盘格点坐标为
变换矩阵确定模块:用于根据前一帧图像中格子点坐标和相邻后一帧图像中格子点坐标,确定格子点坐标前后的变换矩阵,并发送至转向圆心点生成模块;
本发明实施例中,通过前一帧检测出的棋盘格的点坐标为
圆心点生成模块:用于根据变换矩阵和前一帧图像中汽车后轮中心轴线方程,确定相邻后一帧图像中汽车后轮中心轴线方程,进而获得相邻两帧图像中汽车后轮中心轴线方程的交点,即获得汽车转向的圆心点;
本发明实施例中,p10=t·p00,p11=t·p01;使用两点公式计算出经过点p10和点p11的直线方程y1=k1·x+b1;直线y=k0·x+b0和直线y1=k1·x+b1的交点就是汽车转向的圆心点o1(x0,y0);
汽车最大转向角度标定模块:用于根据汽车转向的圆心点的位置,确定汽车在不同移动方向的最大转向角度。
本发明实施例中,该相邻帧估算出来的最大转向角αi=arctan(b/(w-y0));
以上所述仅为本发明的优选实施例,并非因此限制本发明的专利范围,凡是在本发明的发明构思下,利用本发明说明书及附图内容所作的等效结构变换,或直接/间接运用在其他相关的技术领域均包括在本发明的专利保护范围内。