CN104608768B - 一种前方目标车辆进入弯道和进行换道的辨别装置及方法 - Google Patents

一种前方目标车辆进入弯道和进行换道的辨别装置及方法 Download PDF

Info

Publication number
CN104608768B
CN104608768B CN201510079943.2A CN201510079943A CN104608768B CN 104608768 B CN104608768 B CN 104608768B CN 201510079943 A CN201510079943 A CN 201510079943A CN 104608768 B CN104608768 B CN 104608768B
Authority
CN
China
Prior art keywords
car
objects ahead
ahead vehicle
vehicle
msub
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.)
Expired - Fee Related
Application number
CN201510079943.2A
Other languages
English (en)
Other versions
CN104608768A (zh
Inventor
王畅
付锐
郭应时
袁伟
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Changan University
Original Assignee
Changan University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Changan University filed Critical Changan University
Priority to CN201510079943.2A priority Critical patent/CN104608768B/zh
Publication of CN104608768A publication Critical patent/CN104608768A/zh
Application granted granted Critical
Publication of CN104608768B publication Critical patent/CN104608768B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/095Predicting travel path or likelihood of collision
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/10Longitudinal speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404Characteristics
    • B60W2554/4041Position
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00Input parameters relating to objects
    • B60W2554/80Spatial relation or speed relative to objects
    • B60W2554/801Lateral distance

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

本发明属于汽车主动安全技术领域,特别涉及一种前方目标车辆进入弯道和进行换道的辨别装置及方法,该辨别装置,包括:设置在本车前端中央的毫米波雷达、用于采集本车车速的车速传感器,所述毫米波雷达用于采集前方目标车辆与本车的相位角、以及前方目标车辆与本车的相对距离,所述前方目标车辆与本车的相位角指:两车连线方向与本车前进方向的夹角,所述两车连线方向指前方车里后端中央与本车前端中央连线的方向;该辨别装置还包括:用于根据本车车速、前方目标车辆与本车的相位角、以及前方目标车辆与本车的相对距离判断前方车辆是进入弯道还是进行换道的数据处理单元。

Description

一种前方目标车辆进入弯道和进行换道的辨别装置及方法
技术领域
本发明属于汽车主动安全技术领域,特别涉及一种前方目标车辆进入弯道和进行换道的辨别装置及方法。
背景技术
车辆主动安全系统能够大大降低驾驶员的劳动强度,并提高车辆行驶的安全性。雷达传感器(毫米波雷达)在车辆主动安全领域内被大量采用,通过分析车辆间的相对运动状态,可以对车辆运行安全性进行判断,当存在事故风险时可以对驾驶员进行报警。
通常而言,雷达所输出的数据是两车间的相对距离、相对角度和相对速度。在正常情况下,对上述3个参数进行分析判断即可准确了解前方其他车辆的运动状态。
从雷达返回的数据而言,前方车辆的运动状态存在两类相似的情况:第一种为前方车辆发生车道变换(简称换道),第二种情况为前方车辆由直道进入弯道而自车还处于直道的情况。从雷达数据而言,这两种情况下雷达的数据特性较为相似,都是前方车辆相对于自车发生一定的横向运动。从目前主动安全系统的工作算法而言,暂时还没有考虑这两种情况,这也造成了一定的安全隐患,例如自适应巡航控制系统在遇到这种情况时系统可能会发生跟车错误。
发明内容
本发明的目的在于提出一种前方目标车辆进入弯道和进行换道的辨别装置及方法。
为实现上述技术目的,本发明采用如下技术方案予以实现。
技术方案一:
一种前方目标车辆进入弯道和进行换道的辨别装置包括:设置在本车前端中央的毫米波雷达、用于采集本车车速的车速传感器,所述毫米波雷达用于采集前方目标车辆与本车的相位角、以及前方目标车辆与本车的相对距离,所述前方目标车辆与本车的相位角指:两车连线方向与本车前进方向的夹角,所述两车连线方向指前方车里后端中央与本车前端中央连线的方向;
所述前方目标车辆进入弯道和进行换道的辨别装置还包括:用于根据本车车速、前方目标车辆与本车的相位角、以及前方目标车辆与本车的相对距离判断前方车辆是进入弯道还是进行换道的数据处理单元。
本技术方案的特点和进一步改进在于:
所述前方目标车辆进入弯道和进行换道的辨别装置还包括设置在本车内的CAN总线,所述数据处理单元通过CAN总线分别电连接毫米波雷达和车速传感器。
所述毫米波雷达为ESR毫米波雷达,所述车速传感器为OEM车速传感器。
所述毫米波雷达的采样频率为10Hz,所述车速传感器的采样频率为10Hz。
所述数据处理单元为单片机或ARM处理器。
技术方案二:
一种前方目标车辆进入弯道和进行换道的辨别方法,基于上述一种前方目标车辆进入弯道和进行换道的辨别装置,包括以下步骤:
步骤1,车速传感器实时采集本车车速,同时毫米波雷达实时采集前方目标车辆与本车的相位角、以及前方目标车辆与本车的相对距离;车速传感器实时将采集的本车车速发送至数据处理单元,毫米波雷达将采集的前方目标车辆与本车的相位角、以及前方目标车辆与本车的相对距离发送至数据处理单元;
步骤2,所述数据处理单元根据从设定时刻开始获取N个连续的采样时刻的车辆运行数据,得出所述从设定时刻开始N个连续的采样时刻前方目标车辆在预设二维直角坐标系的位置坐标;所述车辆运行数据包括本车车速、前方目标车辆与本车的相位角、以及前方目标车辆与本车的相对距离,所述预设二维直角坐标系的原点为设定时刻本车毫米波雷达所在位置,所述预设二维直角坐标系的y轴正向为本车前进方向;
步骤3,针对从设定时刻开始N个连续的采样时刻前方目标车辆在预设二维直角坐标系的位置坐标,分别进行圆弧曲线拟合、缓和曲线拟合和多项式曲线拟合;得出所述三种曲线拟合的确定系数;
步骤4,当所述多项式曲线拟合的确定系数大于所述圆弧曲线拟合的确定系数且大于所述缓和曲线拟合的确定系数时,判断前方目标车辆正在进行换道;否则,判断前方车辆正在进入弯道。
本技术方案的特点和进一步改进在于:
在步骤2中,所述设定时刻根据以下过程进行确定:数据处理单元判断本车运行起始时刻前方目标车辆与本车的相位角是否超过设定角度阈值,如果是,则本车运行起始时刻为设定时刻,如果否,则数据处理单元在每个采样时刻判断前方目标车辆与本车的相位角是否超过设定角度阈值,将前方目标车辆与本车的相位角超过设定角度阈值的任一采样时刻作为设定时刻。
在步骤2中,得出所述从设定时刻开始N个连续的采样时刻前方目标车辆在预设二维直角坐标系的位置坐标的过程为:
得出从设定时刻开始第1个采样时刻前方目标车辆在预设二维直角坐标系的位置坐标(xp1,yp1);xp1=r1*sinθ1,yp1=r1*cosθ1,其中,r1表示从设定时刻开始第1个采样时刻前方目标车辆与本车的相对距离,θ1表示从设定时刻开始第1个采样时刻前方目标车辆与本车的相位角;
得出从设定时刻开始第1个采样时刻本车在预设二维直角坐标系的位置坐标(xh1,yh1),xh1=0,yh1=0;
令n=2,3,…,N,得出从设定时刻开始第n个采样时刻前方目标车辆在预设二维直角坐标系的位置坐标(xpn,ypn);xpn=rn*sinθn,ypn=yhn+rn*cosθn,其中,rn表示从设定时刻开始第n个采样时刻前方目标车辆与本车的相对距离,θn表示从设定时刻开始第n个采样时刻前方目标车辆与本车的相位角,yhn=yh(n-1)+vn*Δt,yh(n-1)表示从设定时刻开始第n-1个采样时刻前方目标车辆在预设二维直角坐标系的纵坐标,vn表示从设定时刻开始第n个采样时刻本车的速度,Δt表示每两个相邻的采样时刻之间的时间间隔。
在步骤1中,当前方目标车辆位于本车右前方时,前方目标车辆与本车的相位角为正值,当前方目标车辆位于本车左前方时,前方目标车辆与本车的相位角为负值。
在步骤3中,圆弧曲线拟合的表达式为:
(x1-a)2+(y1-b)2=R2
其中,x1表示圆弧曲线的横坐标,y1表示圆弧曲线的纵坐标,a表示圆弧曲线的圆心横坐标,b表示圆弧曲线的圆心纵坐标;R表示圆弧曲线的半径;
缓和曲线拟合的表达式为:
其中,x2表示圆弧曲线的横坐标,y2表示圆弧曲线的纵坐标;l表示缓和曲线长度,l0表示缓和曲线全长,R'表示缓和曲线的曲率半径;
多项式曲线拟合的表达式为:
其中,x3表示多项式曲线的横坐标,y3表示多项式曲线的纵坐标;a1、a2、a3、a4、a5、a6分别表示多项式曲线的6个多项式系数。
本发明的有益效果为:本发明提供一种前方车辆进入弯道和进行换道的辨别装置及其辨识方法,可以用于辨识出前方车辆到底是发生了哪种行为,从而为车辆主动安全系统提供支持。
附图说明
图1为本发明的一种前方目标车辆进入弯道和进行换道的辨别装置的结构示意图;
图2为本发明的工作流程示意图;
图3为本发明中前方目标车辆进入弯道时的坐标示意图;
图4为本发明中前方目标车辆进行换道时的坐标示意图。
具体实施方式
下面结合附图对本发明作进一步说明:
参照图1,为本发明的一种前方目标车辆进入弯道和进行换道的辨别装置的结构示意图。该前方目标车辆进入弯道和进行换道的辨别装置包括毫米波雷达,该毫米波雷达设置在本车前端中央(前保险杠正中央),用于采集前方目标车辆与本车的相位角、以及前方目标车辆与本车的相对距离,所述前方目标车辆与本车的相位角指:两车连线方向与本车前进方向的夹角,所述两车连线方向指前方车里后端中央与本车前端中央连线的方向。本发明实施例中,毫米波雷达为ESR毫米波雷达为ESR毫米波雷达,其距离测量精度为0.5m,角度精度为0.5°,采样频率为10Hz。
上述前方目标车辆进入弯道和进行换道的辨别装置还包括车速传感器,该车速传感器安装在车轮轴上,用于采集本车车速。本发明实施例中,车速传感器为OEM车速传感器,其采样精度为0.01km/h,采样频率为10Hz。
本发明实施例中,还设置有数据处理单元,用于根据本车车速、前方目标车辆与本车的相位角、以及前方目标车辆与本车的相对距离判断前方车辆是进入弯道还是进行换道。数据处理单元的输入端分别电连接毫米波雷达的输出端以及车速传感器的输出端,数据处理单元可以采用多种硬件平台实现,例如数据处理单元为单片机或ARM处理器。
在数据处理单元中,判断前方车辆是进入弯道还是进行换道可以采用多种实现方式,下面举例说明其中的一种实现方式。数据处理单元用于获取N个连续的采样时刻的车辆运行数据,N为大于1的自然数,所述车辆运行数据包括本车车速、前方目标车辆与本车的相位角、以及前方目标车辆与本车的相对距离;所述数据处理单元用于根据N个连续的采样时刻的车辆运行数据,得出N个连续采样时刻前方目标车辆在二维直角坐标系的坐标;所述数据处理单元用于针对N个连续采样时刻前方目标车辆在二维直角坐标系的坐标,进行圆弧曲线拟合、缓和曲线拟合和多项式曲线拟合;所述数据处理单元用于得出三种曲线拟合的确定系数,用于在多项式曲线拟合的确定系数大于圆弧曲线拟合的确定系数且大于缓和曲线拟合的确定系数时,判断前方目标车辆正在进行换道;所述数据处理单元用于在圆弧曲线拟合的确定系数大于等于多项式曲线拟合的确定系数或缓和曲线拟合的确定系数大于等于多项式曲线拟合的确定系数时,判断前方车辆正在进入弯道。
为了使数据处理单元能够顺利接收到毫米波雷达和车速传感器的输出信号,在本发明中还设置有CAN总线1,该CAN总线为车载CAN总线,数据处理单元通过CAN总线分别电连接毫米波雷达和车速传感器。如果毫米波雷达的输出信号为RS485信号,则需要在毫米波雷达和CAN总线1之间设置485转CAN转换器,实现两种不同的总线数据之间的格式转换。本发明实施例中,485转CAN转换器的转换频率为10赫兹。
参照图2,为本发明的工作流程示意图;为了对本发明的一种前方目标车辆进入弯道和进行换道的辨别装置作出更清楚的说明,下面简要说明本发明的一种前方目标车辆进入弯道和进行换道的辨别装置的工作流程。
当本车沿所在车道直行时,车速传感器实时采集本车车速,同时毫米波雷达实时采集前方目标车辆与本车的相位角、以及前方目标车辆与本车的相对距离;车速传感器实时将采集的本车车速发送至数据处理单元,毫米波雷达将采集的前方目标车辆与本车的相位角、以及前方目标车辆与本车的相对距离发送至数据处理单元。本发明实施例中,当前方目标车辆位于本车右前方时,前方目标车辆与本车的相位角为正值,当前方目标车辆位于本车左前方时,前方目标车辆与本车的相位角为负值。
数据处理单元根据从设定时刻开始获取N个连续的采样时刻的车辆运行数据,得出所述从设定时刻开始N个连续的采样时刻前方目标车辆在预设二维直角坐标系的位置坐标,N为大于1的自然数。车辆运行数据包括本车车速、前方目标车辆与本车的相位角、以及前方目标车辆与本车的相对距离,预设二维直角坐标系的原点为设定时刻本车毫米波雷达所在位置,预设二维直角坐标系的y轴正向为本车前进方向。
具体地说,毫米波雷达和车速传感器的采样频率一致,上述说明中采样时刻指的是毫米波雷达和车速传感器采样时刻。而设定时刻根据以下过程进行确定:数据处理单元判断本车运行起始时刻前方目标车辆与本车的相位角是否超过设定角度阈值(例如15度),如果是,则说明前方目标车辆在本车运行起始时刻正在进行换道或者正在进入弯道,此时将本车运行起始时刻为设定时刻;如果否,则说明前方目标车辆在本车运行起始时刻正在沿本车所在车道直行,此时数据处理单元在每个采样时刻判断前方目标车辆与本车的相位角是否超过设定角度阈值,将前方目标车辆与本车的相位角超过设定角度阈值的任一采样时刻作为设定时刻,例如,将前方目标车辆与本车的相位角超过设定角度阈值的第一采样时刻作为设定时刻。
本发明实施例中,预设二维直角坐标系的x轴正向可以设置为本车前进方向向左旋转90度的方向或者本车前进方向向右旋转90度的方向。下面以x轴正向为本车前进方向向右旋转90度的方向为例进行说明。
参照图3,为本发明中前方目标车辆进入弯道时的第一坐标示意图;参照图4,为本发明中前方目标车辆进行换道时的第二坐标示意图;本发明实施例中,得出所述从设定时刻开始N个连续的采样时刻前方目标车辆在预设二维直角坐标系的位置坐标的过程为:
得出从设定时刻开始第1个采样时刻前方目标车辆在预设二维直角坐标系的位置坐标(xp1,yp1),xp1表示横坐标,yp1表示纵坐标;xp1=r1*sinθ1,yp1=r1*cosθ1,其中,r1表示从设定时刻开始第1个采样时刻(也就是设定时刻)前方目标车辆与本车的相对距离,θ1表示从设定时刻开始第1个采样时刻前方目标车辆与本车的相位角。在得出从设定时刻开始第1个采样时刻前方目标车辆在预设二维直角坐标系的位置坐标的同时,得出从设定时刻开始第1个采样时刻本车在预设二维直角坐标系的位置坐标(xh1,yh1),其中,xh1表示横坐标,yh1表示纵坐标,由于从设定时刻开始第1个采样时刻就是设定时刻,显然有xh1=0,yh1=0。
令n=2,3,…,N,得出从设定时刻开始第n个采样时刻前方目标车辆在预设二维直角坐标系的位置坐标(xpn,ypn),xpn表示横坐标,ypn表示纵坐标;xpn=rn*sinθn,ypn=yhn+rn*cosθn,其中,rn表示从设定时刻开始第n个采样时刻前方目标车辆与本车的相对距离,θn表示从设定时刻开始第n个采样时刻前方目标车辆与本车的相位角,yhn=yh(n-1)+vn*Δt,yh(n-1)表示从设定时刻开始第n-1个采样时刻前方目标车辆在预设二维直角坐标系的纵坐标,vn表示从设定时刻开始第n个采样时刻本车的速度,Δt表示每两个相邻的采样时刻之间的时间间隔。
本发明实施例中,毫米波雷达和车速传感器的采样频率均为10Hz,即每0.1秒采集一次数据,则每两个相邻的采样时刻之间的时间间隔Δt为0.1s。N的值设为20,这样,数据处理单元可以根据2s时间窗口内的20组坐标数据判断前方目标车辆的行为,能够满足实时性的要求。
在得出所述从设定时刻开始N个连续的采样时刻前方目标车辆在预设二维直角坐标系的位置坐标之后,针对从设定时刻开始N个连续的采样时刻前方目标车辆在预设二维直角坐标系的位置坐标,分别进行圆弧曲线拟合、缓和曲线拟合和多项式曲线拟合;得出所述三种曲线拟合的确定系数。
本发明实施例中,圆弧曲线拟合的表达式为:
(x1-a)2+(y1-b)2=R2
其中,x1表示圆弧曲线的横坐标,y1表示圆弧曲线的纵坐标,a表示圆弧曲线的圆心横坐标(前车行驶轨迹的圆心横坐标),b表示圆弧曲线的圆心纵坐标(前车行驶轨迹的圆心纵坐标);R表示圆弧曲线的半径(前车行驶轨迹的半径)。
缓和曲线拟合的表达式为:
其中,x2表示圆弧曲线的横坐标,y2表示圆弧曲线的纵坐标;l表示缓和曲线长度,l0表示缓和曲线全长,R'表示缓和曲线的曲率半径。
多项式曲线拟合的表达式为:
其中,x3表示多项式曲线的横坐标,y3表示多项式曲线的纵坐标;a1、a2、a3、a4、a5、a6分别表示多项式曲线的6个多项式系数。由于多项式次数过大会造成计算量过大,曲线复杂,并且降低数据处理单元的运算效率,而多项式次数太小又不能充分拟合,本发明中,将多项式方程的最大次数定为5。
本发明实施例中,将圆弧曲线拟合的确定系数表示为将缓和曲线拟合的确定系数表示为将多项式曲线拟合的确定系数表示为通过确定系数的大小可以判断曲线的拟合优度(确定系数的取值范围为[0,1],确定系数的值越接近1,说明曲线的拟合优度越高)。由于前方车辆在进入弯道时的行驶轨迹类似于圆弧曲线和缓和曲线,而前方车辆进行换道时的轨迹曲线类似于多项式曲线,所以当多项式曲线拟合的确定系数大于圆弧曲线拟合的确定系数且大于缓和曲线拟合的确定系数时,判断前方目标车辆正在进行换道;否则,如果圆弧曲线拟合的确定系数大于等于多项式曲线拟合的确定系数或缓和曲线拟合的确定系数大于等于多项式曲线拟合的确定系数时,判断前方车辆正在进入弯道。
综上所述,本发明的基本原理是通过使用车载毫米波雷达检测前方车辆相对于本车的相位角和相对距离,同时利用车速传感器检测本车速度,并将其发送给数据处理单元。假设本车沿直线行驶,从某一时刻开始,以本车位置为原点,建立二维直角坐标系,通过雷达数据计算前方车辆的坐标,随着时间推移,坐标原点不变,通过本车车速和雷达数据可以得到一系列前方车辆的位置坐标点,对前方车辆的位置坐标点用圆弧曲线、缓和曲线或多项式曲线进行拟合,通过确定系数的大小区分前方车辆进入弯道和换道,若圆弧曲线或缓和曲线方程的确定系数大于多项式方程的确定系数,则前方车辆被判定为进入弯道,若多项式方程的确定系数同时大于圆弧曲线和缓和曲线方程的确定系数,则判定为换道。
显然,本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样,倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内,则本发明也意图包含这些改动和变型在内。

Claims (5)

1.一种前方目标车辆进入弯道和进行换道的辨别方法,应用于前方目标车辆进入弯道和进行换道的辨别装置,所述辨别装置包括:设置在本车前端中央的毫米波雷达、用于采集本车车速的车速传感器以及数据处理单元;所述毫米波雷达用于采集前方目标车辆与本车的相位角以及前方目标车辆与本车的相对距离,其中,所述前方目标车辆与本车的相位角指:两车连线方向与本车前进方向的夹角,所述两车连线方向指前方车里后端中央与本车前端中央连线的方向;所述数据处理单元用于根据本车车速、前方目标车辆与本车的相位角、以及前方目标车辆与本车的相对距离判断前方车辆是进入弯道还是进行换道;
其特征在于,所述辨别方法包括以下步骤:
步骤1,所述车速传感器实时采集本车车速,同时所述毫米波雷达实时采集前方目标车辆与本车的相位角、以及前方目标车辆与本车的相对距离;所述车速传感器实时将采集的本车车速发送至所述数据处理单元,所述毫米波雷达将采集的前方目标车辆与本车的相位角、以及前方目标车辆与本车的相对距离发送至所述数据处理单元;
步骤2,所述数据处理单元根据从设定时刻开始获取N个连续的采样时刻的车辆运行数据,得出所述从设定时刻开始N个连续的采样时刻前方目标车辆在预设二维直角坐标系的位置坐标;所述车辆运行数据包括本车车速、前方目标车辆与本车的相位角、以及前方目标车辆与本车的相对距离,所述预设二维直角坐标系的原点为设定时刻本车毫米波雷达所在位置,所述预设二维直角坐标系的y轴正向为本车前进方向;
步骤3,针对从设定时刻开始N个连续的采样时刻前方目标车辆在预设二维直角坐标系的位置坐标,分别进行圆弧曲线拟合、缓和曲线拟合和多项式曲线拟合;得出所述三种曲线拟合的确定系数;
步骤4,当所述多项式曲线拟合的确定系数大于所述圆弧曲线拟合的确定系数且大于所述缓和曲线拟合的确定系数时,判断前方目标车辆正在进行换道;否则,判断前方车辆正在进入弯道。
2.如权利要求1所述的一种前方目标车辆进入弯道和进行换道的辨别方法,其特征在于,在步骤2中,所述设定时刻根据以下过程进行确定:数据处理单元判断本车运行起始时刻前方目标车辆与本车的相位角是否超过设定角度阈值,如果是,则本车运行起始时刻为设定时刻,如果否,则数据处理单元在每个采样时刻判断前方目标车辆与本车的相位角是否超过设定角度阈值,将前方目标车辆与本车的相位角超过设定角度阈值的任一采样时刻作为设定时刻。
3.如权利要求1所述的一种前方目标车辆进入弯道和进行换道的辨别方法,其特征在于,在步骤2中,得出所述从设定时刻开始N个连续的采样时刻前方目标车辆在预设二维直角坐标系的位置坐标的过程为:
得出从设定时刻开始第1个采样时刻前方目标车辆在预设二维直角坐标系的位置坐标(xp1,yp1);xp1=r1*sinθ1,yp1=r1*cosθ1,其中,r1表示从设定时刻开始第1个采样时刻前方目标车辆与本车的相对距离,θ1表示从设定时刻开始第1个采样时刻前方目标车辆与本车的相位角;
得出从设定时刻开始第1个采样时刻本车在预设二维直角坐标系的位置坐标(xh1,yh1),xh1=0,yh1=0;
令n=2,3,...,N,得出从设定时刻开始第n个采样时刻前方目标车辆在预设二维直角坐标系的位置坐标(xpn,ypn);xpn=rn*sinθn,ypn=yhn+rn*cosθn,其中,rn表示从设定时刻开始第n个采样时刻前方目标车辆与本车的相对距离,θn表示从设定时刻开始第n个采样时刻前方目标车辆与本车的相位角,yhn=yh(n-1)+vn*Δt,yh(n-1)表示从设定时刻开始第n-1个采样时刻前方目标车辆在预设二维直角坐标系的纵坐标,vn表示从设定时刻开始第n个采样时刻本车的速度,Δt表示每两个相邻的采样时刻之间的时间间隔。
4.如权利要求1或3所述的一种前方目标车辆进入弯道和进行换道的辨别方法,其特征在于,在步骤1中,当前方目标车辆位于本车右前方时,前方目标车辆与本车的相位角为正值,当前方目标车辆位于本车左前方时,前方目标车辆与本车的相位角为负值。
5.如权利要求1所述的一种前方目标车辆进入弯道和进行换道的辨别方法,其特征在于,在步骤3中,圆弧曲线拟合的表达式为:
(x1-a)2+(y1-b)2=R2
其中,x1表示圆弧曲线的横坐标,y1表示圆弧曲线的纵坐标,a表示圆弧曲线的圆心横坐标,b表示圆弧曲线的圆心纵坐标;R表示圆弧曲线的半径;
缓和曲线拟合的表达式为:
<mrow> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>=</mo> <mi>l</mi> <mo>-</mo> <mfrac> <msup> <mi>l</mi> <mn>5</mn> </msup> <mrow> <mn>40</mn> <msup> <mi>R</mi> <mrow> <mo>&amp;prime;</mo> <mn>2</mn> </mrow> </msup> <msubsup> <mi>l</mi> <mn>0</mn> <mn>2</mn> </msubsup> </mrow> </mfrac> </mrow>
<mrow> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>=</mo> <mfrac> <msup> <mi>l</mi> <mn>3</mn> </msup> <mrow> <mn>6</mn> <msub> <mi>Rl</mi> <mn>0</mn> </msub> </mrow> </mfrac> </mrow>
其中,x2表示圆弧曲线的横坐标,y2表示圆弧曲线的纵坐标;l表示缓和曲线长度,l0表示缓和曲线全长,R′表示缓和曲线的曲率半径;
多项式曲线拟合的表达式为:
<mrow> <msub> <mi>y</mi> <mn>3</mn> </msub> <mo>=</mo> <msub> <mi>a</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>a</mi> <mn>2</mn> </msub> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>+</mo> <msub> <mi>a</mi> <mn>3</mn> </msub> <msubsup> <mi>x</mi> <mn>3</mn> <mn>2</mn> </msubsup> <mo>+</mo> <msub> <mi>a</mi> <mn>4</mn> </msub> <msubsup> <mi>x</mi> <mn>3</mn> <mn>3</mn> </msubsup> <mo>+</mo> <msub> <mi>a</mi> <mn>5</mn> </msub> <msubsup> <mi>x</mi> <mn>3</mn> <mn>4</mn> </msubsup> <mo>+</mo> <msub> <mi>a</mi> <mn>6</mn> </msub> <msubsup> <mi>x</mi> <mn>3</mn> <mn>5</mn> </msubsup> </mrow>
其中,x3表示多项式曲线的横坐标,y3表示多项式曲线的纵坐标;a1、a2、a3、a4、a5、a6分别表示多项式曲线的6个多项式系数。
CN201510079943.2A 2015-02-13 2015-02-13 一种前方目标车辆进入弯道和进行换道的辨别装置及方法 Expired - Fee Related CN104608768B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510079943.2A CN104608768B (zh) 2015-02-13 2015-02-13 一种前方目标车辆进入弯道和进行换道的辨别装置及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510079943.2A CN104608768B (zh) 2015-02-13 2015-02-13 一种前方目标车辆进入弯道和进行换道的辨别装置及方法

Publications (2)

Publication Number Publication Date
CN104608768A CN104608768A (zh) 2015-05-13
CN104608768B true CN104608768B (zh) 2017-11-03

Family

ID=53143486

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510079943.2A Expired - Fee Related CN104608768B (zh) 2015-02-13 2015-02-13 一种前方目标车辆进入弯道和进行换道的辨别装置及方法

Country Status (1)

Country Link
CN (1) CN104608768B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108909721B (zh) * 2018-04-28 2021-04-23 南通职业大学 一种基于毫米波雷达的车辆偏航角计算方法
CN108919802B (zh) * 2018-07-04 2021-05-14 百度在线网络技术(北京)有限公司 无人驾驶的车辆行驶方法和装置
US11970207B2 (en) * 2018-09-20 2024-04-30 Mitsubishi Electric Corporation Vehicle control apparatus and vehicle control method
CN111497852B (zh) * 2020-04-30 2021-05-11 安徽江淮汽车集团股份有限公司 弯道场景的障碍物位置判定方法、装置、设备及存储介质
CN111707258B (zh) * 2020-06-15 2022-05-31 中国第一汽车股份有限公司 一种外部车辆监测方法、装置、设备及存储介质

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103496366A (zh) * 2013-09-09 2014-01-08 北京航空航天大学 一种基于车车协同的主动换道避撞控制方法与装置
CN104192144A (zh) * 2014-07-25 2014-12-10 杭州电子科技大学 一种汽车主动防撞弯道虚警消除方法
CN104290753A (zh) * 2014-09-29 2015-01-21 长安大学 一种前方车辆运动状态追踪预测装置及其预测方法
CN104527638A (zh) * 2014-12-03 2015-04-22 杭州奥腾电子有限公司 汽车主动防撞弯道虚警消除方法及虚警消除装置
CN204452442U (zh) * 2015-02-13 2015-07-08 长安大学 一种前方目标车辆进入弯道和进行换道的辨别装置

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102005024382A1 (de) * 2005-05-27 2006-12-07 Robert Bosch Gmbh Spurhalteassistent für Kraftfahrzeuge
US8190330B2 (en) * 2009-03-06 2012-05-29 GM Global Technology Operations LLC Model based predictive control for automated lane centering/changing control systems

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103496366A (zh) * 2013-09-09 2014-01-08 北京航空航天大学 一种基于车车协同的主动换道避撞控制方法与装置
CN104192144A (zh) * 2014-07-25 2014-12-10 杭州电子科技大学 一种汽车主动防撞弯道虚警消除方法
CN104290753A (zh) * 2014-09-29 2015-01-21 长安大学 一种前方车辆运动状态追踪预测装置及其预测方法
CN104527638A (zh) * 2014-12-03 2015-04-22 杭州奥腾电子有限公司 汽车主动防撞弯道虚警消除方法及虚警消除装置
CN204452442U (zh) * 2015-02-13 2015-07-08 长安大学 一种前方目标车辆进入弯道和进行换道的辨别装置

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
ACC系统用目标换道预测方法;徐远新等;《中国安全科学学报》;20141015;101-106页 *
应用于换道预警系统的潜在危险目标辨识算法;王畅等;《长安大学学报(自然科学版)》;20150115;98-105页 *

Also Published As

Publication number Publication date
CN104608768A (zh) 2015-05-13

Similar Documents

Publication Publication Date Title
CN104608768B (zh) 一种前方目标车辆进入弯道和进行换道的辨别装置及方法
CN107346612B (zh) 一种基于车联网的车辆防碰撞方法和系统
CN104290753B (zh) 一种前方车辆运动状态追踪预测装置及其预测方法
EP3415945B1 (en) Method of determining the yaw rate of a target vehicle
US9903945B2 (en) Vehicle motion estimation enhancement with radar data
CN108032859B (zh) 自动变道控制方法、装置和汽车
US10168425B2 (en) Centralized vehicle radar methods and systems
CN110816540B (zh) 交通拥堵的确定方法、装置、系统及车辆
CN202163431U (zh) 基于多传感器信息融合的碰撞及偏离预警装置
CN102713987B (zh) 道路信息检测装置以及车辆行驶控制装置
CN104554105B (zh) 一种汽车防碰撞网络预警方法及装置与验证实验平台
CN106828495B (zh) 一种控制车辆行驶的方法及装置
CN105551282A (zh) 一种超车提示方法和装置
CN104575068A (zh) 一种提示驾驶员的方法和装置
CN104916165A (zh) 一种前车驾驶员不安全驾驶行为检测方法及装置
CN111391856A (zh) 汽车自适应巡航的前方弯道检测系统及方法
CN105069859A (zh) 车辆行驶状态监测方法和装置
CN102591332A (zh) 用于无人驾驶汽车局部路径规划的装置及方法
DE102009047066A1 (de) Verfahren zur Warnung vor einem Objekt in der Umgebung eines Fahrzeugs sowie Fahrassistentensystem
CN110045736A (zh) 一种基于无人机的弯道障碍物避让方法及其系统
CN102358289A (zh) 一种车辆acc工况弯道主目标快速识别方法
CN105774655B (zh) 一种倾斜车位探测装置及方法
CN105205805A (zh) 基于视觉的智能车辆横向控制方法
CN107650906A (zh) 智能泊车系统及其控制方法
CN108569289A (zh) 一种车载雷达及其逼近探测和目标判别方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20171103

CF01 Termination of patent right due to non-payment of annual fee