CN113696893B - 跟车方法、车辆及计算机可读存储介质 - Google Patents
跟车方法、车辆及计算机可读存储介质 Download PDFInfo
- Publication number
- CN113696893B CN113696893B CN202110905626.7A CN202110905626A CN113696893B CN 113696893 B CN113696893 B CN 113696893B CN 202110905626 A CN202110905626 A CN 202110905626A CN 113696893 B CN113696893 B CN 113696893B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- speed
- following
- signal point
- self
- 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
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Purposes 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, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
- B60W30/14—Adaptive cruise control
- B60W30/16—Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
- B60W30/165—Automatically following the path of a preceding lead vehicle, e.g. "electronic tow-bar"
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Abstract
本发明提出的一种跟车方法、车辆及计算机可读存储介质,跟车方法包括:获取自车车辆的第一位置信息,根据所述第一位置信息得到所述自车车辆的自车位置点;记录目标车辆的第二位置信息,根据所述第二位置信息生成所述目标车辆行驶的目标车轨迹;根据所述目标车轨迹和所述自车位置点构建跟车路径,并控制所述自车车辆沿所述跟车路径进行跟车行驶;实时监测所述跟车行驶的自车车辆和所述目标车辆之间的距离是否大于预设间隔距离;若大于,则控制所述自车车辆沿所述跟车路径进行提速跟车行驶。本发明解决了远距离跟车时,容易出现对目标车辆的跟车行驶失效的问题,实现了较长距离对特定车辆的智能跟车与编队跟车,提高了跟车行驶的有效性。
Description
技术领域
本发明涉及自动驾驶技术领域,尤其涉及一种跟车方法、车辆及计算机可读存储介质。
背景技术
随着驾驶技术的发展,自动驾驶能够解决处理的场景逐渐增多完善,越来越多的智能汽车中都配置了跟车功能。
当前,自动驾驶车辆所采用的跟车方法主要是通过感知设备,如摄像头和毫米波雷达感知目标跟随车辆的行车轨迹,从而拟合生成自车车辆的跟车轨迹。但是,在目标车辆与自车车辆的距离较远时,容易出现目标车辆被其他车辆遮挡等情况,受限于感知设备的感知距离和感知视角的限制,感知设备常常感知不到目标车辆,而导致自车车辆对目标车辆的跟车行驶失效。
发明内容
本发明的主要目的在于提供一种跟车方法、车辆及计算机可读存储介质,旨在解决远距离跟车时,容易跟车行驶失效的技术问题。
为实现上述目的,本发明提供一种跟车方法,所述跟车方法的步骤包括:
获取自车车辆的第一位置信息,根据所述第一位置信息得到所述自车车辆的自车位置点;
记录目标车辆的第二位置信息,根据所述第二位置信息生成所述目标车辆行驶的目标车轨迹;
根据所述目标车轨迹和所述自车位置点构建跟车路径,并控制所述自车车辆沿所述跟车路径进行跟车行驶;
实时监测所述跟车行驶的自车车辆和所述目标车辆之间的距离是否大于预设间隔距离;
若大于,则控制所述自车车辆沿所述跟车路径进行提速跟车行驶。
可选地,所述根据所述第一位置信息得到所述自车车辆的自车位置点的步骤,包括:
获取所述第一位置信息中的当前位置信号点和自车行驶车道;
若所述当前位置信号点偏离所述自车行驶车道,则获取所述当前位置信号点与所述自车车道之间的第一偏离距离;
若所述第一偏离距离小于预设自车舍弃阈值,则修正所述当前位置信号点,并将修正后的当前位置信号点作为所述自车位置点。
可选地,所述根据所述第一位置信息得到所述自车车辆的自车位置点的步骤,还包括:
获取所述第一位置信息中的前一个位置信号点和当前位置信号点;
获取所述当前位置信号点相对所述前一个位置信号点的位置约束值;
得到以所述前一个位置信号点为圆心、以所述位置约束值为半径的约束圆形;
若所述当前位置信号点在所述约束圆形范围内,则将所述当前位置信号点作为所述自车车辆的自车位置点。
可选地,所述获取所述当前位置信号点相对所述前一个位置信号点的位置约束值的步骤,包括:
获取所述自车车辆的整车信号,提取整车信号中的速度信息和方向盘角度信息;
记录获取所述当前位置信号点和前一个位置信号点的间隔时间;
对所述速度信息、方向盘角度信息和间隔时间进行计算,得到所述当前位置信号点相对所述前一个位置信号点的位置约束值。
可选地,所述控制所述自车车辆沿所述跟车路径进行跟车行驶的步骤,包括:
获取所述自车车辆所对应的自车行驶车道;
判断所述跟车路径是否跨越所述自车行驶车道;
若所述跟车路径跨越所述自车行驶车道,则控制所述自车车辆沿所述跟车路径进行变道跟车行驶。
可选地,所述控制所述自车车辆沿所述跟车路径进行提速跟车行驶的步骤,包括:
获取所述自车车辆所在的自车行驶车道的限速值和自车车辆行驶的自车车速;
判断所述自车车速是否小于所述限速值;
若所述自车车速小于所述限速值,则控制所述自车车辆沿所述跟车路径进行提速跟车行驶。
可选地,所述控制所述自车车辆沿所述跟车路径进行跟车行驶的步骤,包括:
通过所述第二位置信息获取所述目标车辆行驶的目标车车速;
检测所述目标车车速是否大于预设速度阈值;
若所述目标车车速大于预设速度阈值,则获取所述自车车辆的前方车辆的行驶速度;
判断所述前方车辆的行驶速度是否大于所述目标车车速;
若所述前方车辆的行驶速度大于所述目标车车速,则控制所述自车车辆沿所述跟车路径进行提速跟车行驶。
可选地,所述判断所述前方车辆的行驶速度是否大于所述目标车车速的步骤之后,还包括:
若所述前方车辆的行驶速度小于所述目车标车速,则控制所述自车车辆进行变道,并控制变道后的自车车辆执行所述获取自车车辆的第一位置信息,根据所述第一位置信息得到所述自车车辆的自车位置点的步骤。
此外,为实现上述目的,本发明还提供一种车辆,所述车辆包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的跟车程序,其中:所述跟车程序被所述处理器执行时实现如上所述的跟车方法的步骤。
此外,为实现上述目的,本发明还提供一种计算机可读存储介质,所述计算机可读存储介质上存储有跟车程序,所述跟车程序被处理器执行时实现如上所述的跟车方法的步骤。
本发明通过目标车辆的位置信息得到目标车辆行驶轨迹,通过自车车辆的位置点与目标车辆的行驶轨迹规划出跟车路径,并控制自车车辆沿所述跟车路径进行跟车行驶,并且,当自车车辆与目标车辆的距离大于预设间隔距离时,智能地控制自车车辆进行提速跟车行驶。通过对位置信息采集,而不再只依赖感知设备进行跟车,从而解决了远距离跟车时,容易出现对目标车辆的跟车行驶失效的问题,实现了较长距离对特定车辆的智能跟车与编队跟车,进而提高了跟车行驶的有效性。
附图说明
图1是本发明实施例方案涉及的硬件运行环境的装置结构示意图;
图2为本发明跟车方法第一实施例的流程示意图;
图3为本发明跟车方法位置信号点偏离修正一示意图;
图4为本发明跟车方法位置点信号偏离修正另一示意图;
本发明目的的实现、功能特点及优点将结合实施例,参照附图做进一步说明。
具体实施方式
目前,智能驾驶车辆主流的传感器包含摄像头和毫米波雷达,其跟车的方式主要是通过前向摄像头与前向毫米波雷达感知前车的行车轨迹去拟合一条跟车的轨迹。受限于传感器的感知距离和感知视角的能力,在目标车辆距离自车车辆较远、期望的目标车辆被其他车辆遮挡、目标车辆切出车道等情况下,由于传感器感知不到目标车辆,而导致交通拥堵辅助功能无法跟随目标车辆。具体的,现阶段的跟车系统存在以下缺陷:
1)传感器感知距离受限:现阶段量产的前视摄像头和前视雷达通常在200米以下,远距离的跟车难以实现;
2)传感器的感知视角:现阶段量产的前视摄像头和前视雷达可视角通常不会太大,相邻车道的跟车难以实现;
3)抗遮挡能力差:传感器到目标跟踪车辆之间不能有遮挡的物体,否则将不会感知到目标车辆的存在,容易出现车辆跟丢的情况。跟车系统需要对目标车辆实时地跟随,中途不能有间断的时间。
本发明实施例的主要解决方案是:获取自车车辆的第一位置信息,根据所述第一位置信息得到所述自车车辆的自车位置点;
连续记录目标车辆的第二位置信息,根据所述第二位置信息生成所述目标车辆行驶的目标车轨迹;
根据所述目标车轨迹和所述自车位置点构建跟车路径,并控制所述自车车辆沿所述跟车路径进行跟车行驶;
实时监测所述跟车行驶的自车车辆和所述目标车辆之间的距离是否大于预设间隔距离;
若大于,则控制所述自车车辆沿所述跟车路径进行提速跟车行驶。
本发明实施例通过目标车辆的位置信息得到目标车辆行驶轨迹,通过自车车辆的位置点与目标车辆的行驶轨迹规划出跟车路径,并控制自车车辆沿所述跟车路径进行跟车行驶,并且,当自车车辆与目标车辆的距离大于预设间隔距离时,智能地控制自车车辆进行提速跟车行驶。通过对位置信息采集和应用,而不再只依赖感知设备,从而解决了远距离跟车时,容易出现对目标车辆的跟车行驶失效的问题。避免中途因交通拥堵问题,车辆编队中出现其他车辆导致编队行驶失败,实现了较长距离对特定车辆的智能跟车与编队跟车,进而提高了跟车行驶的有效性。
为了使本发明的目的、技术方案及优点更加清楚明白,下面将参照附图更详细地描述本公开的示例性实施例。虽然附图中显示了本公开的示例性实施例,然而应当理解,可以以各种形式实现本公开而不应被这里阐述的实施例所限制。相反,提供这些实施例是为了能够更透彻地理解本公开,并且能够将本公开的范围完整的传达给本领域的技术人员。
为了更好的理解上述技术方案,下面将结合说明书附图以及具体的实施方式对上述技术方案进行详细的说明。
如图1所示,图1是本发明实施例方案涉及的硬件运行环境的装置结构示意图。
本发明实施例终端可以为车辆。如图1所示,该为车辆可以包括:处理器1001,例如CPU,通信总线1002,用户接口1003,网络接口1004,存储器1005。其中,通信总线1002用于实现这些组件之间的连接通信。用户接口1003可以包括显示屏(Display)、输入单元比如键盘(Keyboard),可选的用户接口1003还可以包括标准的有线接口、无线接口。网络接口1004可选的可以包括标准的有线接口、无线接口(如WI-FI接口)。存储器1005可以是高速RAM存储器,也可以是稳定的存储器(non-volatile memory),例如磁盘存储器。存储器1005可选的还可以是独立于前述处理器1001的存储装置。
可选地,车辆还可以包括摄像头、传感器、车载定位模块、毫米波雷达模块、音频电路、RF(Radio Frequency,射频)电路,Wi-Fi模块等等。其中,摄像头包括环视摄像头和前视摄像头等,传感器比如光传感器、运动传感器以及其他传感器。具体地,环视摄像头,或称为全景式影像监控系统,能将汽车顶部各个方向鸟视画面拼接起来,并动态显示在车内的液晶屏上,此外,环视摄像头还能识别停车通道标识、车道线、路缘和附近车辆。前视长距离摄像头为安装在车辆前方的摄像头,可视距离在百米左右。光传感器可包括环境光传感器及接近传感器,其中,环境光传感器可根据环境光线的明暗来调节显示屏的亮度,接近传感器可在硬件设备移动到耳边时,关闭显示屏和/或背光。当然,硬件设备还可配置陀螺仪、气压计、湿度计、温度计、红外线传感器等其他传感器,在此不再赘述。
本领域技术人员可以理解,图1中示出的车辆的结构并不构成对车辆的限定,可以包括比图示更多或更少的部件,或者组合某些部件,或者不同的部件布置。
如图1所示,作为一种计算机存储介质的存储器1005中可以包括操作系统、网络通信模块、用户接口模块以及车辆加塞的预判断程序。
在图1所示的终端中,网络接口1004主要用于连接后台服务器,与后台服务器进行数据通信;用户接口1003主要用于连接客户端(用户端),与客户端进行数据通信;而处理器1001可以用于调用存储器1005中存储的车辆加塞的预判断程序,并执行以下操作:
获取自车车辆的第一位置信息,根据所述第一位置信息得到所述自车车辆的自车位置点;
连续记录目标车辆的第二位置信息,根据所述第二位置信息生成所述目标车辆行驶的目标车轨迹;
根据所述目标车轨迹和所述自车位置点构建跟车路径,并控制所述自车车辆沿所述跟车路径进行跟车行驶;
实时监测所述跟车行驶的自车车辆和所述目标车辆之间的距离是否大于预设间隔距离;
若大于,则控制所述自车车辆沿所述跟车路径进行提速跟车行驶。
参照图2,本发明提供一种跟车方法,在跟车方法的第一实施例中,跟车方法包括以下步骤:
步骤S10,获取自车车辆的第一位置信息,根据所述第一位置信息得到所述自车车辆的自车位置点;
需要说明的是,由于车辆行驶是动态的过程,因此对自车车辆或者目标车辆的位置信息获取也是动态的,所述第一位置信息根据采集和计算周期进行记录和更新。
所述第一位置信息为自车车辆各计算周期的位置信息,其中,位置信息中可以通过自车车辆的摄像头、传感器、车载定位模块、毫米波雷达模块进行获取,位置信息的具体内容可以参照现有技术中摄像头、传感器、车载定位模块、毫米波雷达模块的应用和功能进行设定。位置信息可以包括但不限于下述信息:连续采集到的自车车辆的周围环境信息、跟车的目标车辆的信息、位置点信息,具体的,周围环境信息可以包括自车车辆行驶的车道信息、本车道前车的行驶信息、前车与自车车辆的距离信息、相邻车道是否有车辆以及相邻车道车辆的行驶信息、相邻车道车辆与自车车辆的距离信息等;目标车辆的信息可以包括目标车辆的周围环境信息、目标车辆的行驶信息等;位置点信息可以为GPS(GlobalPositioning System,全球定位系统)或者北斗卫星导航系统采集到的位置信息,定位系统在此不作限定。
所述自车车辆的自车位置点为自车车辆当前的定位位置点。所述根据所述第一位置信息得到所述自车车辆的自车位置点,可以根据实际情况进行设定。可以理解的,由于定位系统采集到的定位位置点存在不精确的情况,有时会发生位置点漂移,因此也可以对位置点进行筛选。若不筛选,则可以根据第一位置信息直接提取自车位置点,若对位置点进行筛选,可以将偏离自车车道的位置点进行舍弃,或者通过上一周期中自车的位置点以及自车车辆的行驶情况进行计算,得到自车车辆的当前周期中位置点的范围,从而对不符合的位置点进行舍弃。
步骤S20,记录目标车辆的第二位置信息,根据所述第二位置信息生成所述目标车辆行驶的目标车轨迹;
所述第二位置信息为目标车辆连续反馈回来的各计算周期的位置信息。根据所述第二位置信息生成所述目标车辆行驶的目标车轨迹具体可以为:提取第二位置信息中目标车辆的连续的位置点以及目标车辆的道路数据,从而在地图上拟合生成目标车辆的行驶轨迹。
其中,提取第二位置信息中目标车辆的连续的位置点的步骤可以包括:根据第二位置信息直接提取目标车位置点,也可以对接收到的目标车位置点进行筛选修正。对目标车位置点进行筛选修正的具体步骤为:接收所述目标车辆反馈的目标车位置信号点;获取所述目标车辆对应的目标车车道;判断所述目标车位置信号点是否偏离所述目标车车道;若所述目标车位置信号点偏离所述目标车车道,则获取所述目标车位置信号点与所偏离车道的目标车偏离距离;判断所述目标车偏离距离是否小于预设目标车位置点舍弃阈值;若大于或等于所述目标车位置点舍弃阈值,则舍弃该位置信号点,若小于所述预设目标车位置点舍弃阈值,则修正所述目标车位置信号点,并将修正后的当前位置信号点作为所述目标车辆的位置信息。
步骤S30,根据所述目标车轨迹和所述自车位置点构建跟车路径,并控制所述自车车辆沿所述跟车路径进行跟车行驶;
根据所述目标车轨迹和所述自车位置点构建跟车路径的步骤具体为,以自身位置点为起点,预瞄自车车辆正前方某一预设距离,提取目标车轨迹上的一个点,使用单点预瞄法进行局部路径规划,生成一条三次曲线,将该三次曲线作为跟车路径。参照图3,以位置信号点为GPS信号点为例,预瞄点为目标车轨迹上,与自车车辆正前方某一预设距离处截取的一个点,使用单点预瞄法在预瞄点与自车GPS点(即自车位置点)之间进行局部路径规划,生成局部路径,即局部跟车路径。
步骤S40,实时监测所述跟车行驶的自车车辆和所述目标车辆之间的距离是否大于预设间隔距离;
通过目标车辆的第二位置信息可以获取到目标车辆位置点,再结合自车车辆的位置点可以得到所述目标车辆与所述自车车辆的间隔距离;所述预设间隔距离为预设的自车是否需要加速的阈值。
步骤S50,若大于,则控制所述自车车辆沿所述跟车路径进行提速跟车行驶。
通过对自车车辆与目标车辆之间的距离进行判断,当超过一定的阈值时,控制自车车辆提速追赶,从而减少因跟车距离过大,出现跟车有效性降低的问题发生,同时可以使跟车组车队的效果更加显著。
在本实施例中,通过目标车辆的位置信息得到目标车辆行驶轨迹,通过自车车辆的位置点与目标车辆的行驶轨迹规划出跟车路径,并控制自车车辆沿所述跟车路径进行跟车行驶,并且,当自车车辆与目标车辆的距离大于预设间隔距离时,智能地控制自车车辆进行提速跟车行驶。通过对位置信息采集,而不再只依赖感知设备进行跟车,从而解决了远距离跟车时,容易出现对目标车辆的跟车行驶失效的问题,实现了较长距离对特定车辆的智能跟车与编队跟车,进而提高了跟车行驶的有效性。
进一步地,基于上述本发明的第一实施例,提出本发明跟车方法的第二实施例,在本实施例中,上述实施例步骤S20,根据所述第一位置信息得到所述自车车辆的自车位置点的步骤,包括:
步骤a,获取所述第一位置信息中的当前位置信号点和自车行驶车道;
步骤b,若所述当前位置信号点偏离所述自车行驶车道,则获取所述当前位置信号点与所述自车车道之间的第一偏离距离;
步骤c,若所述第一偏离距离小于预设自车舍弃阈值,则修正所述当前位置信号点,并将修正后的当前位置信号点作为所述自车位置点。
当所述当前位置信号点出现漂移时,视漂移情况对位置信号点进行取舍。当漂移偏差较大时,可能会出现偏离车道的情况,当偏离点在车道外时,判断第一偏离距离是否小于预设自车舍弃阈值,若大于该自车舍弃阈值,则认为该位置信号点失效,舍弃该信号点,若小于,则将该偏离信号点修正到道路范围之内,并将修正后的信号点作为所述自车信号点。以位置信号点为GPS信号点为例,参照图4,当位置信号点GPS偏离点漂移到自车行驶车道外时,如果位置信号点GPS偏离点与所偏离车道的距离是小于预设自车舍弃阈值,则将该GPS偏离点修正到道路范围内,修正后的信号点为GPS修正点,将该GPS修正点作为自车信号点。
本实施例中,通过对位置信号点的漂移进行检测,当偏离距离超出预设的舍弃阈值时进行舍弃,当偏离距离小于预设舍弃阈值时进行修正,从而改善位置信号点漂移的问题,提升位置信号点选取的精确性,进而提高跟车路径规划的准确性,提高跟车有效性。
进一步地,基于上述本发明的第一实施例,提出本发明跟车方法的第三实施例,在本实施例中,上述实施例步骤S20,根据所述第一位置信息得到所述自车车辆的自车位置点的步骤,还包括:
步骤d,获取所述第一位置信息中的前一个位置信号点和当前位置信号点;
步骤e,获取所述当前位置信号点相对所述前一个位置信号点的位置约束值;
步骤f,得到以所述前一个位置信号点为圆心、以所述位置约束值为半径的约束圆形;
步骤g,若所述当前位置信号点在所述约束圆形范围内,则将所述当前位置信号点作为所述自车车辆的自车位置点。
所述前一个位置信号点为上一周期的位置信号点,通过对自车车辆的行驶参数的获取可以得到自车车辆的行驶状况,继而得出自车车辆上一周期到本周期的位置变化的理论值,即当前位置信号点相对所述前一个位置信号点的位置约束值,从而通过理论计算可以得出自车车辆的理论运动范围,也可以理解为,位置约束值是自车车辆运动的极限值,假设自车车辆以5米每秒的速度运行了一秒(计算周期假设为一秒),那么位置约束值就是5米,因为自车车辆偏移前一个位置点的最远直线距离只有5米,约束圆形的半径为5米。若当前获取的位置信号点在约束圆形外,则可知该位置信号发生漂移,且幅度过大,需舍弃该信号点;若当前位置信号点在所述约束圆形范围内,则该信号点可能没有漂移,或者即使漂移也在可接收的误差范围内,则该位置信号点可取。
本实施例中,通过对自车车辆运动范围的理论值进行计算,进而对发生漂移的自车位置点的选取进行了约束,从而提升位置信号点选取的精确性,进而提高跟车路径规划的准确性,提高跟车有效性。
本领域技术人员可以理解的,再次参照图3,在另一实施例中,根据所述第一位置信息得到所述自车车辆的自车位置点的步骤,可以包括:第一实施例中的步骤a~c和/或第二实施例中步骤d~g,具体的,步骤a~c和步骤d~g的具体顺序不作限定。
本实施例中,既通过自车车辆运动范围的理论值对发生漂移的自车位置点的选取进行了约束,又可以通过自车车道对自车位置点的漂移进行约束,从而改善位置信号点漂移的问题,大大提升位置信号点选取的精确性,进而提高跟车路径规划的准确性,提高跟车有效性。
进一步地,步骤e,获取所述当前位置信号点相对所述前一个位置信号点的位置约束值的细化步骤,包括:
步骤h,获取所述自车车辆的整车信号,提取整车信号中的速度信息和方向盘角度信息;
步骤i,记录获取所述当前位置信号点和前一个位置信号点的间隔时间;
步骤j,对所述速度信息、方向盘角度信息和间隔时间进行计算,得到所述当前位置信号点相对所述前一个位置信号点的位置约束值。
本实施例中,通过对自车车辆的行驶信息进行提取,可以得到自车车辆的速度和行驶方向等信息,当前位置信号点与前一个位置信号点的间隔时间为预设的计算周期,从而可以计算得到自车车辆运动的位置变化范围,假设自车车辆以5米每秒的速度运行了一秒(计算周期假设为一秒),那么位置约束值就是5米,因为自车车辆偏移前一个位置点的最远直线距离只有5米,约束圆形的半径为5米,由此得到自车车辆在该周期内的位置变化的理论值,进而提升了跟车路径规划时参数提取的准确性。
进一步地,控制所述自车车辆沿所述跟车路径进行跟车行驶的步骤,包括:
步骤k,获取所述自车车辆所对应的自车行驶车道;
步骤l,判断所述跟车路径是否跨越所述自车行驶车道;
步骤m,若所述跟车路径跨越所述自车行驶车道,则控制所述自车车辆沿所述跟车路径进行变道跟车行驶。
其中,控制所述自车车辆沿所述跟车路径进行变道跟车行驶实现时可以分为不同的情况,如提醒驾驶员进行变道,或者车辆具有权限,则可以自动变道。可以理解的,变道前还包括对车辆周围环境信息是否具备变道条件进行判断,如相邻车道是否有车,前后车辆以及相邻车道与自车车辆的距离和车速是否合适等,在次不再赘述。
本实施例中,通过自动变道功能或变道提醒功能的实现提升了自车车辆对跟车路径的跟车行驶准确性,进而提高对目标车辆跟车的有效性。
进一步地,控制所述自车车辆沿所述跟车路径进行提速跟车行驶的步骤,包括:
步骤o,获取所述自车车辆所在的自车行驶车道的限速值和自车车辆行驶的自车车速;
步骤p,判断所述自车车速是否小于所述限速值;
步骤q,若所述自车车速小于所述限速值,则控制所述自车车辆沿所述跟车路径进行提速跟车行驶。
可以理解的,车辆在行驶过程中,摄像头系统实时对周围环境进行感知,包括自车行驶车道两侧的标识,当然,通过对道路限速标识进行处理可以提取出当前车道的限速值。如果自车提速前,车速小于限速值,则控制自车车辆进行提速,提速后的车速可以参照目标车辆的车速、当前路况、与目标车辆的距离等综合参数进行设定。
本实施例中,通过对当前车道的限速值进行确认,防止或减少道路交通事故发生,为人车行驶建立了安全保护屏障。
进一步地,控制所述自车车辆沿所述跟车路径进行跟车行驶的步骤,包括:
步骤r,通过所述第二位置信息获取所述目标车辆行驶的目标车车速;
步骤s,检测所述目标车车速是否大于预设速度阈值;
步骤t,若所述目标车车速大于预设速度阈值,则获取所述自车车辆的前方车辆的行驶速度;
步骤u,判断所述前方车辆的行驶速度是否大于所述目标车车速;
步骤v,若所述前方车辆的行驶速度大于所述目标车车速,则控制所述自车车辆沿所述跟车路径进行提速跟车行驶。
所述预设速度阈值为根据经验和计算进行预设的速度值,当所述目标车辆行驶的目标车车速大于预设速度阈值时,认为目标车辆在加速偏离自车车速,为了跟车的有效性,需要触发自车车辆提速,以对目标车辆及时进行跟进。
为了安全提速需判断自车车道的前方车辆的距离和车速,如果前方车辆与自车车辆的距离较远,前方车辆车速大于目标车车速,则认为自车车辆可以安全提速到目标车车速。
可以理解的,在步骤r之前,也可以先检测目标车辆是否提速,如果目标车辆没有提速,可以认为自车车辆仍处于有效跟车状态,如果目标车辆提速,且提速后的速度大于预设速度阈值则需要对自车车辆进行提速跟车。检测目标车辆是否提速的步骤可以包括:通过所述第二位置信息获取所述目标车辆行驶的初始车速;检测所述初始车速是否变更为目标车速;若所述初始车速变更为目标车速,则认为目标车辆正在改变速度。其中初始车速和目标车速为检测到的目标车辆速度改变前、后的速度值,所述目标车速可以大于初始车速,即目标车辆提速行驶,此时需要判断是否对自车车辆进行提速跟车;所述目标车速也可以小于初始车速,即目标车辆减速行驶时,自车车辆的当前车速足够对目标车辆进行跟车行驶,则不需要特意对车速进行调整。
本实施例中,当目标车辆加速偏离自车车速时,在具备提速条件下自动提速跟车,提升了车辆跟车的智能性,进而提升用户的体验感。
进一步地,判断所述前方车辆的行驶速度是大于所述目标车车速的步骤之后,还包括:
步骤w,若所述前方车辆的行驶速度小于或等于所述目标车车速,则控制所述自车车辆进行变道,并控制变道后的自车车辆执行所述获取自车车辆的第一位置信息,根据所述第一位置信息得到所述自车车辆的自车位置点的步骤。
如果自车车辆所在车道的前方车辆车速小于目标车车速,则自车车辆在该车道提速后的车速仍小于目标车辆的目标车车速,那么就容易产生跟车距离增大甚至跟车难度大实现困难的情况,因此,此时自车车辆对周围环境情况判断后可以自动变道或者发出变道提醒,以为自车车辆提速行驶创造条件。
可以理解的,当跟车路径为在本车道行驶,而在本车道不满足提速条件时,自动触发了变道规划,会使自车车辆不在跟车路径上行驶,此时只需沿着目标车辆的行驶方向即可,下一个周期会基于变道后的自车车辆重新进行跟车路径规划。
本实施例中,当感知到目标车辆正在加速,而自车车辆前方的车辆行驶缓慢的时候,触发变道规划,若自身车辆具备自动变道功能,经驾驶员确认变道后,可以进行自动变道,可以避开前方缓慢行驶的车辆,为自车车辆提速跟车创造条件,从而提高跟车的有效性。
此外,本发明还提供一种车辆,所述车辆包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的跟车程序,所述处理器用于执行所述跟车程序,以实现上述跟车方法各实施例的步骤。
此外,本发明还提供一种计算机可读存储介质,所述计算机可读存储介质存储有一个或者一个以上程序,所述一个或者一个以上程序还可被一个或者一个以上的处理器执行以用于实现上述跟车方法各实施例的步骤。
需要说明的是,在本文中,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者系统不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者系统所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括该要素的过程、方法、物品或者系统中还存在另外的相同要素。
上述本发明实施例序号仅仅为了描述,不代表实施例的优劣。
通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到上述实施例方法可借助软件加必需的通用硬件平台的方式来实现,当然也可以通过硬件,但很多情况下前者是更佳的实施方式。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品存储在如上所述的一个存储介质(如ROM/RAM、磁碟、光盘)中,包括若干指令用以使得一台终端设备(可以是手机,计算机,服务器,空调器,或者网络设备等)执行本发明各个实施例所述的方法。
以上仅为本发明的优选实施例,并非因此限制本发明的专利范围,凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本发明的专利保护范围内。
Claims (8)
1.一种跟车方法,其特征在于,所述跟车方法的步骤包括:
获取自车车辆的第一位置信息,根据所述第一位置信息得到所述自车车辆的自车位置点;
记录目标车辆的第二位置信息,根据所述第二位置信息生成所述目标车辆行驶的目标车轨迹;
根据所述目标车轨迹和所述自车位置点构建跟车路径,并控制所述自车车辆沿所述跟车路径进行跟车行驶;
实时监测所述跟车行驶的自车车辆和所述目标车辆之间的距离是否大于预设间隔距离;
若大于,则控制所述自车车辆沿所述跟车路径进行提速跟车行驶;
所述控制所述自车车辆沿所述跟车路径进行跟车行驶的步骤,包括:
通过所述第二位置信息获取所述目标车辆行驶的目标车车速;
检测所述目标车车速是否大于预设速度阈值;
若所述目标车车速大于预设速度阈值,则获取所述自车车辆的前方车辆的行驶速度;
判断所述前方车辆的行驶速度是否大于所述目标车车速;
若所述前方车辆的行驶速度大于所述目标车车速,则控制所述自车车辆沿所述跟车路径进行提速跟车行驶;
所述判断所述前方车辆的行驶速度是否大于所述目标车车速的步骤之后,还包括:
若所述前方车辆的行驶速度小于所述目标车车速,则控制所述自车车辆进行变道,并控制变道后的自车车辆执行所述获取自车车辆的第一位置信息,根据所述第一位置信息得到所述自车车辆的自车位置点的步骤。
2.根据权利要求1所述的跟车方法,其特征在于,所述根据所述第一位置信息得到所述自车车辆的自车位置点的步骤,包括:
获取所述第一位置信息中的当前位置信号点和自车行驶车道;
若所述当前位置信号点偏离所述自车行驶车道,则获取所述当前位置信号点与所述自车行驶车道之间的第一偏离距离;
若所述第一偏离距离小于预设自车舍弃阈值,则修正所述当前位置信号点,并将修正后的当前位置信号点作为所述自车位置点。
3.根据权利要求1所述的跟车方法,其特征在于,所述根据所述第一位置信息得到所述自车车辆的自车位置点的步骤,还包括:
获取所述第一位置信息中的前一个位置信号点和当前位置信号点;
获取所述当前位置信号点相对所述前一个位置信号点的位置约束值;
得到以所述前一个位置信号点为圆心、以所述位置约束值为半径的约束圆形;
若所述当前位置信号点在所述约束圆形范围内,则将所述当前位置信号点作为所述自车车辆的自车位置点。
4.根据权利要求3所述的跟车方法,其特征在于,所述获取所述当前位置信号点相对所述前一个位置信号点的位置约束值的步骤,包括:
获取所述自车车辆的整车信号,提取整车信号中的速度信息和方向盘角度信息;
记录获取所述当前位置信号点和前一个位置信号点的间隔时间;
对所述速度信息、方向盘角度信息和间隔时间进行计算,得到所述当前位置信号点相对所述前一个位置信号点的位置约束值。
5.根据权利要求1所述的跟车方法,其特征在于,所述控制所述自车车辆沿所述跟车路径进行跟车行驶的步骤,包括:
获取所述自车车辆所对应的自车行驶车道;
判断所述跟车路径是否跨越所述自车行驶车道;
若所述跟车路径跨越所述自车行驶车道,则控制所述自车车辆沿所述跟车路径进行变道跟车行驶。
6.根据权利要求1所述的跟车方法,其特征在于,所述控制所述自车车辆沿所述跟车路径进行提速跟车行驶的步骤,包括:
获取所述自车车辆所在的自车行驶车道的限速值和自车车辆行驶的自车车速;
判断所述自车车速是否小于所述限速值;
若所述自车车速小于所述限速值,则控制所述自车车辆沿所述跟车路径进行提速跟车行驶。
7.一种车辆,其特征在于,所述车辆包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的跟车程序,其中:所述跟车程序被所述处理器执行时实现如权利要求1~6中任一项所述的跟车方法的步骤。
8.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质上存储有跟车程序,所述跟车程序被处理器执行时实现如权利要求1~6中任一项所述的跟车方法的步骤。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110905626.7A CN113696893B (zh) | 2021-08-06 | 2021-08-06 | 跟车方法、车辆及计算机可读存储介质 |
PCT/CN2022/091751 WO2023010928A1 (zh) | 2021-08-06 | 2022-05-09 | 跟车方法、车辆及计算机可读存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110905626.7A CN113696893B (zh) | 2021-08-06 | 2021-08-06 | 跟车方法、车辆及计算机可读存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113696893A CN113696893A (zh) | 2021-11-26 |
CN113696893B true CN113696893B (zh) | 2023-07-04 |
Family
ID=78651778
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110905626.7A Active CN113696893B (zh) | 2021-08-06 | 2021-08-06 | 跟车方法、车辆及计算机可读存储介质 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN113696893B (zh) |
WO (1) | WO2023010928A1 (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113696893B (zh) * | 2021-08-06 | 2023-07-04 | 上汽通用五菱汽车股份有限公司 | 跟车方法、车辆及计算机可读存储介质 |
CN114162123B (zh) * | 2021-12-31 | 2023-03-14 | 苏州立方元智能科技有限公司 | 一种自动成列行驶车辆系统及控制方法 |
CN115909797A (zh) * | 2022-11-03 | 2023-04-04 | 中国第一汽车股份有限公司 | 一种多车智能协同方法及系统 |
CN115973162A (zh) * | 2023-02-14 | 2023-04-18 | 吉咖智能机器人有限公司 | 用于确定车辆行驶轨迹的方法、装置、电子设备和介质 |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000118261A (ja) * | 1998-10-16 | 2000-04-25 | Toyota Motor Corp | 渋滞追従装置および車両制御装置 |
CN104215256B (zh) * | 2013-06-05 | 2018-03-23 | 深圳市赛格导航科技股份有限公司 | 在地图上显示车辆行驶路线的方法 |
CN106114507B (zh) * | 2016-06-21 | 2018-04-03 | 百度在线网络技术(北京)有限公司 | 用于智能车辆的局部轨迹规划方法和装置 |
CN106114511B (zh) * | 2016-07-21 | 2018-03-06 | 辽宁工业大学 | 一种汽车巡航系统关键目标识别方法 |
US10762788B2 (en) * | 2017-08-01 | 2020-09-01 | Swoppz, LLC | Method and system for requesting and granting priority between vehicles |
CN109131312B (zh) * | 2018-08-01 | 2020-08-18 | 厦门大学 | 一种智能电动汽车acc/esc集成控制系统及其方法 |
CN110871797A (zh) * | 2018-08-13 | 2020-03-10 | 富泰华工业(深圳)有限公司 | 自动跟车方法、电子装置和存储介质 |
CN111845742B (zh) * | 2019-04-22 | 2021-11-23 | 上海汽车集团股份有限公司 | 智能驾驶车辆的跟车控制系统及方法 |
CN110435654B (zh) * | 2019-07-11 | 2021-07-23 | 浙江吉利汽车研究院有限公司 | 一种用于智能领航系统的跟车方法、装置和设备 |
JP7091290B2 (ja) * | 2019-08-09 | 2022-06-27 | 本田技研工業株式会社 | 車両制御装置、車両制御方法、およびプログラム |
CN111273673A (zh) * | 2020-03-09 | 2020-06-12 | 新石器慧通(北京)科技有限公司 | 一种无人车的自动驾驶跟随方法、系统及无人车 |
CN111319623B (zh) * | 2020-03-18 | 2021-10-26 | 东软睿驰汽车技术(上海)有限公司 | 一种基于自适应巡航控制的车辆筛选方法及装置 |
CN113696893B (zh) * | 2021-08-06 | 2023-07-04 | 上汽通用五菱汽车股份有限公司 | 跟车方法、车辆及计算机可读存储介质 |
-
2021
- 2021-08-06 CN CN202110905626.7A patent/CN113696893B/zh active Active
-
2022
- 2022-05-09 WO PCT/CN2022/091751 patent/WO2023010928A1/zh unknown
Also Published As
Publication number | Publication date |
---|---|
WO2023010928A1 (zh) | 2023-02-09 |
CN113696893A (zh) | 2021-11-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113696893B (zh) | 跟车方法、车辆及计算机可读存储介质 | |
US20230115658A1 (en) | Autonomous driving system | |
US9507345B2 (en) | Vehicle control system and method | |
US10184801B2 (en) | Route searching apparatus and route searching method | |
EP2372308B1 (en) | Image processing system and vehicle control system | |
JP6269552B2 (ja) | 車両走行制御装置 | |
US20190315348A1 (en) | Vehicle control device, vehicle control method, and storage medium | |
US10795374B2 (en) | Vehicle control device | |
CA2973113C (en) | Target pathway generating device and driving control device | |
US10891747B1 (en) | Sensor calibration system for autonomous driving vehicles | |
KR101744781B1 (ko) | 도로의 형상 인식을 통한 예측 변속 제어 방법 | |
US20170323566A1 (en) | Electronic apparatus, guide method, and guide system | |
CN110920521A (zh) | 显示系统、显示方法及存储介质 | |
CN109952491B (zh) | 生成由车辆的感知系统检测的对象的表示的方法和系统 | |
CN111824141B (zh) | 显示控制装置、显示控制方法及存储介质 | |
US11137264B2 (en) | Display system, display method, and storage medium | |
CN112513955A (zh) | 行驶轨道生成方法及行驶轨道生成装置 | |
JP2021041859A (ja) | 車両制御装置 | |
US20210179115A1 (en) | Method and apparatus for monitoring a yaw sensor | |
KR102630991B1 (ko) | 차량의 위치 결정 방법, 위치 결정 장치 및 주행 제어 시스템 | |
JP2009166722A (ja) | 車両制御装置 | |
US11845429B2 (en) | Localizing and updating a map using interpolated lane edge data | |
US11640173B2 (en) | Control apparatus, control method, and computer-readable storage medium storing program | |
JP7216695B2 (ja) | 周囲車両監視装置及び周囲車両監視方法 | |
US20210291872A1 (en) | Driving assistance system, and driving assistance program |
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 |