CN108045436B - 一种汽车轨迹线标定方法及系统 - Google Patents
一种汽车轨迹线标定方法及系统 Download PDFInfo
- Publication number
- CN108045436B CN108045436B CN201711273609.6A CN201711273609A CN108045436B CN 108045436 B CN108045436 B CN 108045436B CN 201711273609 A CN201711273609 A CN 201711273609A CN 108045436 B CN108045436 B CN 108045436B
- Authority
- CN
- China
- Prior art keywords
- automobile
- point
- steering angle
- image
- maximum steering
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/021—Determination of steering angle
- B62D15/024—Other means for determination of steering angle without directly measuring it, e.g. deriving from wheel speeds on different sides of the car
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Image Processing (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明公开一种汽车轨迹线标定方法及系统,属于倒车辅助系统技术领域,该方法在汽车后方摄像头可拍摄范围的地面铺设格子平面标识物;汽车在不同方向移动过程中,通过对比后方摄像头拍摄的相邻两帧图像的格子点坐标,确定汽车转向的圆心点,进而分别标定汽车在不同移动方向的最大转向角度;根据标定的汽车在不同移动方向的最大转向角度和转向角级别,获得汽车实际在不同移动方向的最大转向角度;根据汽车实际在不同移动方向的最大转向角度获得汽车轨迹线;通过本发明能够简单快捷的标定的计算精准轨迹需要的最大角度,通过摄像头图像上的精准轨迹线,可以帮助汽车使用者准确地判断出汽车行进轨迹,减少事故的发生。
Description
技术领域
本发明涉及倒车辅助系统技术领域,尤其涉及一种汽车轨迹线标定方法及系统。
背景技术
目前,由于从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所示,在图像中构建坐标系,以汽车尾部摄像头所在平面作为坐标系的横坐标,过后轮中心点垂直于车尾所在平面做坐标系的纵坐标,前一帧检测出的棋盘格的点坐标为P0 [M×N](x,y),取后轮中心轴上其中两点为P00(0,-D)和P01(w,-D),令后轮中心轴线斜率k0=0,偏移量为b0=-D,则后轮中心轴线方程为y=k0·x+b0;
S202、在同一坐标系下,确定相邻后一帧图像中格子点坐标;
本发明实施例中,后一帧检测出的棋盘格点坐标为P1 [M×N](x,y),这是经过汽车转向后得到的点,则前一帧的P00和P01对应在后一帧的P10和P11也可以由汽车转向得到;
S203、根据前一帧图像中格子点坐标和相邻后一帧图像中格子点坐标,确定坐标前后变换矩阵;
本发明实施例中,通过前一帧检测出的棋盘格的点坐标为P0 [M×N](x,y)和后一帧检测出的棋盘格点坐标为P1 [M×N](x,y),计算出两个棋盘格的变换矩阵T;
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所示,所述的汽车最大转向角度标定单元,包括:
图像坐标构建模块:用于在每帧图像中构建相同的坐标系,并将构建完坐标系的图像发送至第一图像处理模块或第二图像处理模块;
本发明实施例中,在图像中构建坐标系,以汽车尾部摄像头所在平面作为坐标系的横坐标,过后轮中心点垂直于车尾所在平面做坐标系的纵坐标;
第一图像处理模块:用于确定前一帧图像中格子点坐标并发送至变换矩阵确定模块中;用于确定前一帧图像中汽车两后轮在坐标系中的坐标,获得后轮中心轴线方程并发送至转向圆心点生成模块;
本发明实施例中,前一帧检测出的棋盘格的点坐标为P0 [M×N](x,y),取后轮中心轴上其中两点为P00(0,-D)和P01(w,-D),令后轮中心轴线斜率k0=0,偏移量为b0=-D,则后轮中心轴线方程为y=k0·x+b0;
第二图像处理模块:用于确定相邻后一帧图像中格子点坐标并发送至变换矩阵确定模块中;
本发明实施例中,后一帧检测出的棋盘格点坐标为P1 [M×N](x,y),这是经过汽车转向后得到的点,则前一帧的P00和P01对应在后一帧的P10和P11也可以由汽车转向得到;
变换矩阵确定模块:用于根据前一帧图像中格子点坐标和相邻后一帧图像中格子点坐标,确定格子点坐标前后的变换矩阵,并发送至转向圆心点生成模块;
本发明实施例中,通过前一帧检测出的棋盘格的点坐标为P0 [M×N](x,y)和后一帧检测出的棋盘格点坐标为P1 [M×N](x,y),计算出两个棋盘格的变换矩阵T;
圆心点生成模块:用于根据变换矩阵和前一帧图像中汽车后轮中心轴线方程,确定相邻后一帧图像中汽车后轮中心轴线方程,进而获得相邻两帧图像中汽车后轮中心轴线方程的交点,即获得汽车转向的圆心点;
本发明实施例中,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));
以上所述仅为本发明的优选实施例,并非因此限制本发明的专利范围,凡是在本发明的发明构思下,利用本发明说明书及附图内容所作的等效结构变换,或直接/间接运用在其他相关的技术领域均包括在本发明的专利保护范围内。
Claims (7)
1.一种汽车轨迹线标定方法,包括:在汽车后方摄像头可拍摄范围的地面铺设格子平面标识物;根据汽车实际在不同移动方向的最大转向角度获得汽车轨迹线;
其特征在于,还包括:
汽车在不同方向移动过程中,通过对比后方摄像头拍摄的相邻两帧图像的格子点坐标,确定汽车转向的圆心点,进而分别标定汽车在不同移动方向的最大转向角度;
根据标定的汽车在不同移动方向的最大转向角度和转向角级别,获得汽车实际在不同移动方向的最大转向角度;
所述的通过对比后方摄像头拍摄的相邻两帧图像的格子点坐标,确定汽车转向的圆心点,具体步骤如下:
在图像中构建坐标系,确定前一帧图像中格子点坐标,并确定前一帧图像中汽车两后轮在坐标系中的坐标,获得后轮中心轴线方程;
在图像中构建坐标系,以汽车尾部摄像头所在平面作为坐标系的横坐标,过后轮中心点垂直于车尾所在平面做坐标系的纵坐标,前一帧检测出的棋盘格的点坐标为P0 [M×N](x,y),取后轮中心轴上其中两点为P00(0,-D)和P01(w,-D),令后轮中心轴线斜率k0=0,偏移量为b0=-D,则后轮中心轴线方程为y=k0·x+b0;
在同一坐标系下,确定相邻后一帧图像中格子点坐标;
后一帧检测出的棋盘格点坐标为P1 [M×N](x,y),这是经过汽车转向后得到的点,则前一帧的P00和P01对应在后一帧的P10和P11也可以由汽车转向得到;
根据前一帧图像中格子点坐标和相邻后一帧图像中格子点坐标,确定坐标前后变换矩阵;
通过前一帧检测出的棋盘格的点坐标为P0 [M×N](x,y)和后一帧检测出的棋盘格点坐标为P1 [M×N](x,y),计算出两个棋盘可的变换矩阵T;
根据变换矩阵和前一帧图像中汽车后轮中心轴线方程,确定相邻后一帧图像中汽车后轮中心轴线方程,进而获得相邻两帧图像中汽车后轮中心轴线方程的交点,即获得汽车转向的圆心点;
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的距离。
2.根据权利要求1所述的汽车轨迹线标定方法,其特征在于,所述的汽车在不同移动方向的最大转向角度,包括:汽车前进时向左的最大转向角度、汽车前进时向右的最大转向角度、汽车后退时向左的最大转向角度和汽车后退时向右的最大转向角度。
3.根据权利要求1所述的汽车轨迹线标定方法,其特征在于,所述的在汽车后方摄像头可拍摄范围的地面铺设格子平面标识物步骤与汽车在不同方向移动过程中,通过对比后方摄像头拍摄的相邻两帧图像的格子点坐标,确定汽车转向的圆心点,进而分别标定汽车在不同移动方向的最大转向角度步骤之间,还包括:
通过后方摄像头拍摄格子平面标识物的图像,并将平面标识物的图像投影在显示界面上。
4.根据权利要求1所述的汽车轨迹线标定方法,其特征在于,所述的汽车在不同方向移动过程中,通过对比后方摄像头拍摄的相邻两帧图像的格子点坐标,确定汽车转向的圆心点,进而分别标定汽车在不同移动方向的最大转向角度步骤与根据标定的汽车在不同移动方向的最大转向角度和转向角级别,获得汽车实际在不同移动方向的最大转向角度步骤之间,还包括:
进行多次对比相邻两帧图像的格子点坐标,获得各移动方向的多个最大转向角度值,选取其中的中间值作为对应移动方向的最终标定最大转向角度。
5.根据权利要求1所述的汽车轨迹线标定方法,其特征在于,所述的根据标定的汽车在不同移动方向的最大转向角度和转向角级别,获得汽车实际在不同移动方向的最大转向角度,具体为:
根据汽车内CAN总线获取的转向角级别与转向角级别范围极值的比例关系,结合标定的汽车在不同移动方向的最大转向角度,获得汽车实际在不同移动方向的最大转向角度。
6.一种汽车轨迹线标定系统,包括汽车轨迹线生成单元、摄像头、铺设在汽车后方摄像头可拍摄范围地面的格子平面标识物,其特征在于,还包括:汽车最大转向角度标定单元和汽车实际最大转向角度获取单元;
所述的汽车最大转向角度标定单元:用于汽车在不同方向移动过程中,通过对比后方摄像头拍摄的相邻两帧图像的格子点坐标,确定汽车转向的圆心点,进而分别标定汽车在不同移动方向的最大转向角度,并发送至汽车实际最大转向角度获取单元;
所述的汽车实际最大转向角度获取单元:用于根据标定的汽车在不同移动方向的最大转向角度和转向角级别,获得汽车实际在不同移动方向的最大转向角度,并发送至汽车轨迹线生成单元供其生成和显示轨迹线;
所述的通过对比后方摄像头拍摄的相邻两帧图像的格子点坐标,确定汽车转向的圆心点,具体步骤如下:
在图像中构建坐标系,确定前一帧图像中格子点坐标,并确定前一帧图像中汽车两后轮在坐标系中的坐标,获得后轮中心轴线方程;
在图像中构建坐标系,以汽车尾部摄像头所在平面作为坐标系的横坐标,过后轮中心点垂直于车尾所在平面做坐标系的纵坐标,前一帧检测出的棋盘格的点坐标为P0 [M×N](x,y),取后轮中心轴上其中两点为P00(0,-D)和P01(w,-D),令后轮中心轴线斜率k0=0,偏移量为b0=-D,则后轮中心轴线方程为y=k0·x+b0;
在同一坐标系下,确定相邻后一帧图像中格子点坐标;
后一帧检测出的棋盘格点坐标为P1 [M×N](x,y),这是经过汽车转向后得到的点,则前一帧的P00和P01对应在后一帧的P10和P11也可以由汽车转向得到;
根据前一帧图像中格子点坐标和相邻后一帧图像中格子点坐标,确定坐标前后变换矩阵;
通过前一帧检测出的棋盘格的点坐标为P0 [M×N](x,y)和后一帧检测出的棋盘格点坐标为P1 [M×N](x,y),计算出两个棋盘可的变换矩阵T;
根据变换矩阵和前一帧图像中汽车后轮中心轴线方程,确定相邻后一帧图像中汽车后轮中心轴线方程,进而获得相邻两帧图像中汽车后轮中心轴线方程的交点,即获得汽车转向的圆心点;
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.根据权利要求6所述的汽车轨迹线标定系统,其特征在于,所述的汽车最大转向角度标定单元,包括:
图像坐标构建模块:用于在每帧图像中构建相同的坐标系,并将构建完坐标系的图像发送至第一图像处理模块或第二图像处理模块;
第一图像处理模块:用于确定前一帧图像中格子点坐标并发送至变换矩阵确定模块中;用于确定前一帧图像中汽车两后轮在坐标系中的坐标,获得后轮中心轴线方程并发送至转向圆心点生成模块;
第二图像处理模块:用于确定相邻后一帧图像中格子点坐标并发送至变换矩阵确定模块中;
变换矩阵确定模块:用于根据前一帧图像中格子点坐标和相邻后一帧图像中格子点坐标,确定格子点坐标前后的变换矩阵,并发送至转向圆心点生成模块;
圆心点生成模块:用于根据变换矩阵和前一帧图像中汽车后轮中心轴线方程,确定相邻后一帧图像中汽车后轮中心轴线方程,进而获得相邻两帧图像中汽车后轮中心轴线方程的交点,即获得汽车转向的圆心点,并发送至汽车最大转向角度标定模块;
汽车最大转向角度标定模块:用于根据汽车转向的圆心点的位置,确定汽车在不同移动方向的最大转向角度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711273609.6A CN108045436B (zh) | 2017-12-06 | 2017-12-06 | 一种汽车轨迹线标定方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711273609.6A CN108045436B (zh) | 2017-12-06 | 2017-12-06 | 一种汽车轨迹线标定方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108045436A CN108045436A (zh) | 2018-05-18 |
CN108045436B true CN108045436B (zh) | 2020-03-03 |
Family
ID=62121953
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711273609.6A Active CN108045436B (zh) | 2017-12-06 | 2017-12-06 | 一种汽车轨迹线标定方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108045436B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108820043B (zh) * | 2018-06-12 | 2021-06-01 | 上海工程技术大学 | 一种基于双侧轮速的汽车转向自动提醒方法及装置 |
CN109263575A (zh) * | 2018-11-19 | 2019-01-25 | 北京远特科技股份有限公司 | 倒车导流线标定方法、倒车导流线标定装置及电子设备 |
DE102020105434A1 (de) * | 2020-03-02 | 2021-09-02 | Valeo Schalter Und Sensoren Gmbh | Verfahren zum betreiben eines fahrzeugs, parkassistenzsystem und fahrzeug |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012145818A1 (en) * | 2011-04-25 | 2012-11-01 | Magna International Inc. | Method and system for dynamically calibrating vehicular cameras |
CN103786662A (zh) * | 2012-10-31 | 2014-05-14 | 上海博泰悦臻电子设备制造有限公司 | 倒车辅助线的生成方法及装置 |
CN103847639A (zh) * | 2012-12-03 | 2014-06-11 | 上海汽车集团股份有限公司 | 车载摄像头动态车辅线标定方法 |
CN105128760A (zh) * | 2015-08-27 | 2015-12-09 | 惠州华阳通用电子有限公司 | 倒车轨迹描绘方法及装置 |
CN107054465A (zh) * | 2016-12-29 | 2017-08-18 | 惠州华阳通用电子有限公司 | 一种倒车轨迹生成方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10086870B2 (en) * | 2015-08-18 | 2018-10-02 | Magna Electronics Inc. | Trailer parking assist system for vehicle |
-
2017
- 2017-12-06 CN CN201711273609.6A patent/CN108045436B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012145818A1 (en) * | 2011-04-25 | 2012-11-01 | Magna International Inc. | Method and system for dynamically calibrating vehicular cameras |
CN103786662A (zh) * | 2012-10-31 | 2014-05-14 | 上海博泰悦臻电子设备制造有限公司 | 倒车辅助线的生成方法及装置 |
CN103847639A (zh) * | 2012-12-03 | 2014-06-11 | 上海汽车集团股份有限公司 | 车载摄像头动态车辅线标定方法 |
CN105128760A (zh) * | 2015-08-27 | 2015-12-09 | 惠州华阳通用电子有限公司 | 倒车轨迹描绘方法及装置 |
CN107054465A (zh) * | 2016-12-29 | 2017-08-18 | 惠州华阳通用电子有限公司 | 一种倒车轨迹生成方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108045436A (zh) | 2018-05-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP7444605B2 (ja) | 牽引ヒッチの位置を計算する方法 | |
CN110060202B (zh) | 一种单目slam算法的初始化方法及系统 | |
CN108045436B (zh) | 一种汽车轨迹线标定方法及系统 | |
EP3300992A1 (en) | A system and method for autonomous perpendicular parking of a vehicle | |
CN108629811B (zh) | 一种汽车环视全景的自动标定方法及系统 | |
JP6658464B2 (ja) | 中立点検出装置、及び操舵制御システム | |
WO2010137364A1 (ja) | 校正目標検出装置と、校正目標を検出する校正目標検出方法と、校正目標検出装置のためのプログラム | |
US20110074604A1 (en) | Automatic parallel parking device | |
CN105313777B (zh) | 车辆驻车系统 | |
CN106560725A (zh) | 用于确定目标车辆的偏航速率的自动化车辆雷达系统 | |
CN104034305B (zh) | 一种单目视觉实时定位的方法 | |
KR102464581B1 (ko) | 스테레오 점군 처리장치 및 그 방법 | |
JP2008523417A (ja) | 車両速度を求める方法及び装置 | |
CN109118537B (zh) | 一种画面匹配方法、装置、设备和存储介质 | |
WO2015015939A1 (ja) | 車両位置姿勢角推定装置及び車両位置姿勢角推定方法 | |
CN110956585B (zh) | 全景图像拼接方法、装置以及计算机可读存储介质 | |
EP3942522A1 (en) | Image processing system and method | |
JP6171849B2 (ja) | 移動体位置姿勢角推定装置及び移動体位置姿勢角推定方法 | |
CN109421589B (zh) | 三角架自走车及其移动距离的计算方法 | |
JP6044084B2 (ja) | 移動物体位置姿勢推定装置及び方法 | |
CN110189379B (zh) | 一种相机外部参数的标定方法及系统 | |
JP2011209070A (ja) | 画像処理装置 | |
CN103685936A (zh) | 宽视场摄像机图像的校准和扭曲恢复 | |
CN107886472B (zh) | 全景泊车系统的图像拼接校准方法和图像拼接校准装置 | |
JP2018036225A (ja) | 状態推定装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |