CN116118751A - 车辆的控制方法、装置、车辆和存储介质 - Google Patents
车辆的控制方法、装置、车辆和存储介质 Download PDFInfo
- Publication number
- CN116118751A CN116118751A CN202310417703.3A CN202310417703A CN116118751A CN 116118751 A CN116118751 A CN 116118751A CN 202310417703 A CN202310417703 A CN 202310417703A CN 116118751 A CN116118751 A CN 116118751A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- aiming
- distance
- point
- curvature
- 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.)
- Granted
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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/105—Speed
-
- 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
- B60W40/06—Road conditions
- B60W40/072—Curvature of the road
-
- 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
-
- 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
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
-
- 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
-
- 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
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0043—Signal treatments, identification of variables or parameters, parameter estimation or state estimation
-
- 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/10—Longitudinal speed
-
- 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
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/30—Road curve radius
-
- 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
- B60W2556/00—Input parameters relating to data
- B60W2556/10—Historical data
-
- 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/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/72—Electric energy management in electromobility
Abstract
本申请涉及一种车辆的控制方法、装置、车辆和存储介质。该方法包括:获取车辆当前行驶道路的道路信息以及车辆当前的行驶状态数据和当前所在第一坐标系的信息,并在车辆的行驶轨迹上确定历史目标位置以及历史目标位置所在第二坐标系的信息;获得车辆在行驶方向上的前视预瞄距离;根据前视预瞄距离、第一车辆航向角和道路信息获得车辆的前视预瞄曲率;获得车辆横摆角的变化值,以及历史目标位置到前视预瞄线段的第一距离;根据横摆角的变化值、第一距离、第一车辆航向角和道路信息获得车辆当前的后视预瞄曲率;根据前视预瞄曲率和后视预瞄曲率进行加权求和,获得道路曲率以控制车辆进行自动驾驶。采用本方法能够车辆自动驾驶精度。
Description
技术领域
本申请涉及自动驾驶技术领域,特别是涉及一种车辆的控制方法、装置、车辆和存储介质。
背景技术
道路曲率对自动驾驶技术有着举足轻重的影响,道路曲率计算的精度影响车辆前馈控制量,进而影响车辆控制的准确度。传统技术中,通常采用PID(ProportionIntegration Differentiation,比例积分微分)控制算法来实现路径跟踪,而通过PID控制算法并未考虑轨迹动态特征,这导致传统的自动驾驶技术无法准确获得道路曲率,进而车辆控制效果较差。
发明内容
基于此,有必要针对上述技术问题,提供一种能够提高车辆自动驾驶控制性能的车辆的控制方法、装置、车辆和存储介质。
第一方面,本申请提供了一种车辆的控制方法。所述方法包括:
获取所述车辆当前行驶道路的道路信息以及所述车辆当前的第一行驶速度、第一车辆航向角和当前所在第一坐标系的信息,并在所述车辆的行驶轨迹上确定历史目标位置以及所述历史目标位置所在第二坐标系的信息,所述道路信息至少包括道路中线或者道路边线;
根据所述第一行驶速度获得所述车辆在行驶方向上的前视预瞄距离;
根据所述前视预瞄距离、所述第一车辆航向角和所述道路信息获得所述车辆的前视预瞄曲率;
根据所述第一坐标系的信息和所述第二坐标系的信息获得所述车辆横摆角的变化值,并获得所述历史目标位置到所述前视预瞄距离对应的前视预瞄线段的第一距离;
根据所述横摆角的变化值、所述第一距离、所述第一车辆航向角和所述道路信息获得所述车辆当前的后视预瞄曲率;
根据所述前视预瞄曲率和后视预瞄曲率进行加权求和,获得道路曲率;
根据所述道路曲率控制所述车辆进行自动驾驶。
在其中一个实施例中,所述根据所述第一行驶速度获得所述车辆在行驶方向上的前视预瞄距离,包括:
根据所述第一行驶速度和预设的前视预瞄距离修正参数,获得所述车辆在行驶方向上的前视预瞄距离。
在其中一个实施例中,所述根据所述前视预瞄距离、所述第一车辆航向角和所述道路信息获得所述车辆的前视预瞄曲率,包括:
在当前行驶道路的中线或者边线上确定第一点和第二点,所述第一点位于第一垂线上,所述第二点位于第二垂线上,所述第一垂线过所述前视预瞄线段的第一端点且与所述前视预瞄线段垂直,所述第二垂线过所述前视预瞄线段的第二端点且与所述前视预瞄线段垂直;
确定所述中线或者边线的第一切线上的第三点,所述第三点和所述第一点位于所述第一切线上,所述第三点与所述第二点的连线与所述第一切线垂直;
根据所述前视预瞄距离和所述第一车辆航向角分别确定所述第一点和所述第三点之间的第二距离,以及所述第二点和所述第三点之间的第三距离;
根据所述第二距离和所述第三距离获得所述前视预瞄曲率。
在其中一个实施例中,所述根据所述第二距离和所述第三距离获得所述前视预瞄曲率,包括:
根据所述第二距离和所述第三距离确定所述第一点和所述第二点所在圆的第一半径;
根据所述第一半径获得所述车辆的前视预瞄曲率。
在其中一个实施例中,所述根据所述横摆角的变化值、所述第一距离、所述第一车辆航向角和所述道路信息获得所述车辆当前的后视预瞄曲率,包括:
在当前行驶道路的中线或者边线上确定第四点,所述第四点位于所述第二坐标系的一轴线上;
确定所述第一切线上的第五点,所述第五点和所述第四点的连线与所述第一切线垂直;
获得所述第五点与所述第四点之间的第四距离,所述第一点与所述第五点之间的第五距离;
根据所述第四距离和所述第五距离获得所述后视预瞄曲率。
在其中一个实施例中,所述根据所述第四距离和所述第五距离获得所述后视预瞄曲率,包括:
根据所述第四距离和所述第五距离确定所述第一点和所述第四点所在圆的第二半径;
根据所述第二半径获得所述车辆的后视预瞄曲率。
在其中一个实施例中,所述第一坐标系和所述第二坐标系的圆点均为所述车辆的前保险杆中点,所述第一坐标系和所述第二坐标系的x轴均为所述车辆的行驶方向,y轴为垂直所述行驶方向的第一方向。
第二方面,本申请还提供了一种车辆的控制装置。所述装置包括:
第一获取模块,用于获取车辆当前行驶道路的道路信息以及所述车辆当前的第一行驶速度、第一车辆航向角和当前所在第一坐标系的信息,并在所述车辆的行驶轨迹上确定历史目标位置以及所述历史目标位置所在第二坐标系的信息,所述道路信息至少包括道路中线或者道路边线;
前视预瞄距离获取模块,用于根据所述第一行驶速度获得所述车辆在行驶方向上的前视预瞄距离;
前视预瞄曲率获取模块,用于根据所述前视预瞄距离、所述第一车辆航向角和所述道路信息获得所述车辆的前视预瞄曲率;
第二获取模块,用于根据所述第一坐标系的信息和所述第二坐标系的信息获得所述车辆横摆角的变化值,并获得所述历史目标位置到所述前视预瞄距离对应的前视预瞄线段的第一距离;
后视预瞄曲率获取模块,用于根据所述横摆角的变化值、所述第一距离、所述第一车辆航向角和所述道路信息获得所述车辆当前的后视预瞄曲率;
道路曲率获取模块,用于根据所述前视预瞄曲率和后视预瞄曲率进行加权求和,获得道路曲率;
控制模块,用于根据所述道路曲率控制所述车辆进行自动驾驶。
第三方面,本申请还提供了一种车辆。所述计算机设备包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现以下步骤:
获取所述车辆当前行驶道路的道路信息以及所述车辆当前的第一行驶速度、第一车辆航向角和当前所在第一坐标系的信息,并在所述车辆的行驶轨迹上确定历史目标位置以及所述历史目标位置所在第二坐标系的信息,所述道路信息至少包括道路中线或者道路边线;
根据所述第一行驶速度获得所述车辆在行驶方向上的前视预瞄距离;
根据所述前视预瞄距离、所述第一车辆航向角和所述道路信息获得所述车辆的前视预瞄曲率;
根据所述第一坐标系的信息和所述第二坐标系的信息获得所述车辆横摆角的变化值,并获得所述历史目标位置到所述前视预瞄距离对应的前视预瞄线段的第一距离;
根据所述横摆角的变化值、所述第一距离、所述第一车辆航向角和所述道路信息获得所述车辆当前的后视预瞄曲率;
根据所述前视预瞄曲率和后视预瞄曲率进行加权求和,获得道路曲率;
根据所述道路曲率控制所述车辆进行自动驾驶。
第四方面,本申请还提供了一种计算机可读存储介质。所述计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现以下步骤:
获取所述车辆当前行驶道路的道路信息以及所述车辆当前的第一行驶速度、第一车辆航向角和当前所在第一坐标系的信息,并在所述车辆的行驶轨迹上确定历史目标位置以及所述历史目标位置所在第二坐标系的信息,所述道路信息至少包括道路中线或者道路边线;
根据所述第一行驶速度获得所述车辆在行驶方向上的前视预瞄距离;
根据所述前视预瞄距离、所述第一车辆航向角和所述道路信息获得所述车辆的前视预瞄曲率;
根据所述第一坐标系的信息和所述第二坐标系的信息获得所述车辆横摆角的变化值,并获得所述历史目标位置到所述前视预瞄距离对应的前视预瞄线段的第一距离;
根据所述横摆角的变化值、所述第一距离、所述第一车辆航向角和所述道路信息获得所述车辆当前的后视预瞄曲率;
根据所述前视预瞄曲率和后视预瞄曲率进行加权求和,获得道路曲率;
根据所述道路曲率控制所述车辆进行自动驾驶。
第五方面,本申请还提供了一种计算机程序产品。所述计算机程序产品,包括计算机程序,该计算机程序被处理器执行时实现以下步骤:
获取所述车辆当前行驶道路的道路信息以及所述车辆当前的第一行驶速度、第一车辆航向角和当前所在第一坐标系的信息,并在所述车辆的行驶轨迹上确定历史目标位置以及所述历史目标位置所在第二坐标系的信息,所述道路信息至少包括道路中线或者道路边线;
根据所述第一行驶速度获得所述车辆在行驶方向上的前视预瞄距离;
根据所述前视预瞄距离、所述第一车辆航向角和所述道路信息获得所述车辆的前视预瞄曲率;
根据所述第一坐标系的信息和所述第二坐标系的信息获得所述车辆横摆角的变化值,并获得所述历史目标位置到所述前视预瞄距离对应的前视预瞄线段的第一距离;
根据所述横摆角的变化值、所述第一距离、所述第一车辆航向角和所述道路信息获得所述车辆当前的后视预瞄曲率;
根据所述前视预瞄曲率和后视预瞄曲率进行加权求和,获得道路曲率;
根据所述道路曲率控制所述车辆进行自动驾驶。
上述车辆的控制方法、装置、车辆和存储介质,通过获取所述车辆当前行驶道路的道路信息以及所述车辆当前的第一行驶速度、第一车辆航向角和当前所在第一坐标系的信息,并在所述车辆的行驶轨迹上确定历史目标位置以及所述历史目标位置所在第二坐标系的信息,所述道路信息至少包括道路中线或者道路边线;根据所述第一行驶速度获得所述车辆在行驶方向上的前视预瞄距离;根据所述前视预瞄距离、所述第一车辆航向角和所述道路信息获得所述车辆的前视预瞄曲率;根据所述第一坐标系的信息和所述第二坐标系的信息获得所述车辆横摆角的变化值,并获得所述历史目标位置到所述前视预瞄距离对应的前视预瞄线段的第一距离;根据所述横摆角的变化值、所述第一距离、所述第一车辆航向角和所述道路信息获得所述车辆当前的后视预瞄曲率;根据所述前视预瞄曲率和后视预瞄曲率进行加权求和,获得道路曲率;根据所述道路曲率控制所述车辆进行自动驾驶。通过上述方式,本申请根据车辆行驶道路的道路信息前视预瞄距离、车辆当前的航向角和道路信息获得所述车辆的前视预瞄曲率,再确定车辆的历史目标位置,以及在历史目标位置与当前位置车辆的横摆角变化、历史目标位置到前视预瞄线段的距离,并根据历史目标位置到前视预瞄线段的距离、横摆角变化车辆航向角和所述道路信息获得所述车辆当前的后视预瞄曲率,最后利用前视预瞄曲率和后视预瞄曲率进行加权计算,如此,本申请通过计算当前的前视预瞄曲率和后视预瞄曲率,然后根据当前的前后预瞄曲率进行加权,从而能够降低了误差的影响,提高了获得的道路曲率的精度,进而提高车辆控制效果。
附图说明
图1为一个实施例中车辆的控制方法的流程示意图;
图2为一个实施例中车辆的控制的应用场景示意图;
图3为一个实施例中车辆的控制装置的结构框图;
图4为一个实施例中车辆的内部结构图。
具体实施方式
为了使本申请的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本申请进行进一步详细说明。应当理解,此处描述的具体实施例仅仅用以解释本申请,并不用于限定本申请。
在一个实施例中,如图1所示,提供了一种车辆的控制方法,包括以下步骤:
步骤110,获取所述车辆当前行驶道路的道路信息以及所述车辆当前的第一行驶速度、第一车辆航向角和当前所在第一坐标系的信息,并在所述车辆的行驶轨迹上确定历史目标位置以及所述历史目标位置所在第二坐标系的信息,所述道路信息至少包括道路中线或者道路边线;
步骤120,根据所述第一行驶速度获得所述车辆在行驶方向上的前视预瞄距离;
具体的,同时参阅图2,图中方框为车辆,A点为车辆的前保险杆中点,线段AA′为车辆的行驶轨迹,车辆从A′点运动到A点,图中曲线CfBCr为车辆当前行驶道路的道路中线或者道路边线。
在车辆行驶过程中,车辆可以通过车辆上安装的各种传感器获取当前行驶道路的道路信息,该道路信息至少包括道路中线或者道路边线。并获得车辆在位置A时的车辆行驶速度,以及车辆当前的车辆航向角θf和坐标系的信息,为方便说明定义车辆航向角θf为第一车辆航向角,位于A点的坐标系定义为第一坐标系。行驶道路的道路信息、第一车辆航向角和行驶速度均可以通过传感器或者现有技术方式获得,此处不做限定。
同时,车辆还记录了其行驶过程中的历史数据,历史数据至少包括距离当前位置t时刻的历史目标位置,以及在该历史目标位置的横摆角,该历史位置建立的坐标系,为方便说明该坐标系定义为第二坐标系。
作为一种实施例,所述第一坐标系和所述第二坐标系的圆点均为所述车辆的前保险杆中点,所述第一坐标系和所述第二坐标系的x轴均为所述车辆的行驶方向,y轴为垂直所述行驶方向的第一方向。需要说明的是,第一坐标系和第二坐标的坐标轴可以为其他方向,只要两个坐标系定义的规则相同即可,否则两个坐标系需要进行换算,增加了计算难度。
其中,所述根据所述第一行驶速度获得所述车辆在行驶方向上的前视预瞄距离,可以包括:
根据所述第一行驶速度和预设的前视预瞄距离修正参数,获得所述车辆在行驶方向上的前视预瞄距离。
具体的,在获得第一行驶速度后,根据获得的第一行驶速度和预设的前视预瞄距离修正参数获得车辆在行驶方向上的前视预瞄距离,其中,预设的前视预瞄距离修正参数可以为集合[0.5,2]中任一值,示例性的,车辆在行驶方向上的前视预瞄距离Lf=|AFf|=λv(t),λ表示预设的前视预瞄距离修正参数,v(t)表示第一行驶速度的数值。本实施例根据当前的行驶速度有利于更准确的确定前视预瞄距离,相对传统技术中采用固定前视预瞄距离的方式,本实施例的方式更准确。
步骤130,根据所述前视预瞄距离、所述第一车辆航向角和所述道路信息获得所述车辆的前视预瞄曲率;
作为一种实施例,根据所述前视预瞄距离、所述第一车辆航向角和所述道路信息获得所述车辆的前视预瞄曲率,包括:
在当前行驶道路的中线或者边线上确定第一点和第二点,所述第一点位于第一垂线上,所述第二点位于第二垂线上,所述第一垂线过所述前视预瞄线段的第一端点且与所述前视预瞄线段垂直,所述第二垂线过所述前视预瞄线段的第二端点且与所述前视预瞄线段垂直;
确定所述中线或者边线的第一切线上的第三点,所述第三点和所述第一点位于所述第一切线上,所述第三点与所述第二点的连线与所述第一切线垂直;
根据所述前视预瞄距离和所述第一车辆航向角分别确定所述第一点和所述第三点之间的第二距离,以及所述第二点和所述第三点之间的第三距离;
根据所述第二距离和所述第三距离获得所述前视预瞄曲率。
具体的,如图2所述,在车辆运行到A点时,以A为圆心,车辆的行驶方向作为坐标系的x轴,垂直所述x轴且远离所述道路中线或者边线的方向作为坐标系的y轴方向,y轴的延长线与道路中线或者边线相交与B点,为方便说明,将该圆心为A的坐标系定义为第一坐标系。将B点作为第一点,第一垂线为直线AB所在的直线。
前视预瞄距离Lf对应的前视预瞄线段的两端分别为A点和Ff,过Ff点作前视预瞄线段AFf的第二垂线FfCf,第二垂线FfCf与道路中线或者边线相交于点Cf,将点Cf作为第二点。过B点作道路中线或者边线的第一切线,第一切线与线段FfCf相交与Df点,过Cf作第一切线的垂线,垂点为Ef,将点Ef作为第三点。
其中,点A和点B之间的距离:|AB|=Sref(0),点Cf和点Ff之间的距离:|CfFf|=Sref(Lf),距离|AB|和|CfFf|均可由车辆传感器获得,点Cf和点Df之间的距离:|CfDf|=|CfFf|-|DfFf|,因航向角θf在坐标系中为负值,因此。点Cf和点Ef之间的距离:。点B和点Ef之间的距离:。
过Cf作道路中线或边线的切线,并过Cf作该切线的垂线,过B作第一切线的垂线,两个垂线交于点Of,轨迹BCf段视为均匀曲率的曲线,即轨迹BCf视为一个圆的线段,该圆的圆心为Of,三角形BOfCf则为等腰三角形,然后根据正玄定理,可以得出:
因∠BOfCf=2∠CfBEf,并根据诱导公式,可得:
该车辆行驶的道路的曲率Kf=1/|BOf|
=2sin∠CfBDf/|BCf|
=2|CfEf|/|BCf|2
=2|CfEf|/(|CfEf|2+|BEf|2)
如此,根据上述公式中即可实现根据第二距离|BEf|和第三距离|CfEf|获得所述前视预瞄曲率。
作为一种实施例,根据所述第二距离和所述第三距离获得所述前视预瞄曲率,包括:
根据所述第二距离和所述第三距离确定所述第一点和所述第二点所在圆的第一半径;
根据所述第一半径获得所述车辆的前视预瞄曲率。
具体的,根据上述描述,还可以先根据第二距离|BEf|和第三距离|CfEf|确定第一点和第二点所在圆的半径,为方便描述将该半径定义为第一半径。
第一半径|BOf|=(|CfEf|2+|BEf|2)/2|CfEf|
车辆的前视预瞄曲率Kf=1/|BOf|
需要说明的是,根据上述描述,前视预瞄曲率可以有多个计算公式,在实际应用中可以选择任一公式获得前视预瞄曲率。此外,在确定A点、A点和B的的距离,可以确定B点的坐标,在确定Lf的长度可以确定Ff点的坐标,在确定|CfFf|的距离,可以确定Cf点的坐标,如此将轨迹BCf段视为均匀曲率的曲线,可以确定圆心Of的坐标,根据圆心Of的坐标和B点的坐标(或者Cf点的坐标)可以直接计算出第一半径,进而获得前视预瞄曲率。
步骤140,根据所述第一坐标系的信息和所述第二坐标系的信息获得所述车辆横摆角的变化值,并获得所述历史目标位置到所述前视预瞄距离对应的前视预瞄线段的第一距离;
具体的,参阅图2,第二坐标系以A′为圆心,x轴为所述车辆的行驶方向,y轴为垂直所述行驶方向的第一方向。实线框代表车辆实际在行驶道路上的姿态,虚线框代表车辆与A点相同姿态,根据两个坐标系之间的差距角即车辆的横摆角的变化值。车辆的横摆角的变化值可以通过现有技术获得,此处不再赘述。
过A′向前视预瞄线段作垂线,垂点为Gr,从A′到前视预瞄线段的第一距离即为。
步骤150,根据所述横摆角的变化值、所述第一距离、所述第一车辆航向角和所述道路信息获得所述车辆当前的后视预瞄曲率;
具体的,本实施在获得车辆的前视预瞄曲率,还需要获得车辆在A点的后视预瞄曲率,需要说明的是获得后视预瞄曲率与获得前视预瞄曲率可以不分先后。
作为一种实施例,所述根据所述横摆角的变化值、所述第一距离、所述第一车辆航向角和所述道路信息获得所述车辆当前的后视预瞄曲率,包括:
在当前行驶道路的中线或者边线上确定第四点,所述第四点位于所述第二坐标系的一轴线上;
确定所述第一切线上的第五点,所述第五点和所述第四点的连线与所述第一切线垂直;
获得所述第五点与所述第四点之间的第四距离,所述第一点与所述第五点之间的第五距离;
根据所述第四距离和所述第五距离获得所述后视预瞄曲率。
具体的,过A′延长第二坐标系中的y轴,第二坐标系中的y轴则与行驶道路的中线或者边线相交与Cr点,将点Cr定义为第四点,过第四点作第一切断的垂线,垂点为Er,将点Er定义为第五点。过Cr向前视预瞄线段作垂线,垂点为Fr。其中横摆角的变化值则为 ,通过车辆上的传感器可以获得。轨迹AA′在第一坐标系的投影为A′Gr,|A′Gr|=x,|AGr|=y。
其中,点Fr和点Gr之间的距离|FrGr|=|CrA′|sin ;
后视预瞄距离Lr=|AGr|-|FrGr|=y-|CrA′|sin ;
|CrFr|=|CrA′|cos -x;|CrDr|=|CrFr|-(|AB|-Lrtanθf);
第四距离|CrEr|=|CrDr|cosθf=(|CrA′|cos -x-Sref(0)+Lrtanθf)cosθf;
第五距离|BEr|=|BDr|+|DrEr|=Lr/cosθf-|CrDr|sinθf
BCrOr为等腰三角形,在BCrOr中,由正玄定理可得:
由∠BOrCr=2∠CrBEr,并根据诱导公式,可得后视预瞄曲率Kr:
作为一种实施例,所述根据所述第四距离和所述第五距离获得所述后视预瞄曲率,包括:
根据所述第四距离和所述第五距离确定所述第一点和所述第四点所在圆的第二半径;
根据所述第二半径获得所述车辆的后视预瞄曲率。
具体的,根据上述描述,还可以先根据第四距离和第五距离确定第一点B和所述第四点Cr所在圆的第二半径:
然后根据半径计算获得后视预瞄曲率Kr=1/|BOr|。
同样的,根据上述描述,第二半径可以存在多种计算方式,在实际应用中可以选择任一公式获得后视预瞄曲率。此外,根据历史轨迹可以确定A′点在第一坐标系的坐标,以及Cf点在第一坐标系的坐标,如此将轨迹BCr段视为均匀曲率的曲线,可以确定圆心Or的坐标,根据圆心Or的坐标和B点的坐标(或者Cr点的坐标)可以直接计算出第二半径,进而获得后视预瞄曲率。
步骤160,根据所述前视预瞄曲率和后视预瞄曲率进行加权求和,获得道路曲率;
具体的,根据获得的前视预瞄曲率和后视预瞄曲率进行加权求和获得该道路曲率K,
K=qKf+(1-q)Kr
其中,q为调节权重,q[0,1]。
步骤170,根据所述道路曲率控制所述车辆进行自动驾驶。
在获得道路曲率之后,根据获得的道路曲率控制车辆的方向盘的转动角度,从而实现控制车辆的自动驾驶。需要说明的是,本申请还可以用于半自动驾驶,即人工驾驶过程中,根据人工操控方向盘的情况,对人工控制车辆的转动角度进行修正。
上述车辆的控制方法,通过获取所述车辆当前行驶道路的道路信息以及所述车辆当前的第一行驶速度、第一车辆航向角和当前所在第一坐标系的信息,并在所述车辆的行驶轨迹上确定历史目标位置以及所述历史目标位置所在第二坐标系的信息,所述道路信息至少包括道路中线或者道路边线;根据所述第一行驶速度获得所述车辆在行驶方向上的前视预瞄距离;根据所述前视预瞄距离、所述第一车辆航向角和所述道路信息获得所述车辆的前视预瞄曲率;根据所述第一坐标系的信息和所述第二坐标系的信息获得所述车辆横摆角的变化值,并获得所述历史目标位置到所述前视预瞄距离对应的前视预瞄线段的第一距离;根据所述横摆角的变化值、所述第一距离、所述第一车辆航向角和所述道路信息获得所述车辆当前的后视预瞄曲率;根据所述前视预瞄曲率和后视预瞄曲率进行加权求和,获得道路曲率;根据所述道路曲率控制所述车辆进行自动驾驶。通过上述方式,本申请根据车辆行驶道路的道路信息前视预瞄距离、车辆当前的航向角和道路信息获得所述车辆的前视预瞄曲率,再确定车辆的历史目标位置,以及在历史目标位置与当前位置车辆的横摆角变化、历史目标位置到前视预瞄线段的距离,并根据历史目标位置到前视预瞄线段的距离、横摆角变化车辆航向角和所述道路信息获得所述车辆当前的后视预瞄曲率,最后利用前视预瞄曲率和后视预瞄曲率进行加权计算,如此,本申请通过计算当前的前视预瞄曲率和后视预瞄曲率,然后根据当前的前后预瞄曲率进行加权,从而能够降低了误差的影响,进而提高了获得的道路曲率的精度,进而提高车辆控制效果。
应该理解的是,虽然如上所述的各实施例所涉及的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,这些步骤可以以其它的顺序执行。而且,如上所述的各实施例所涉及的流程图中的至少一部分步骤可以包括多个步骤或者多个阶段,这些步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,这些步骤或者阶段的执行顺序也不必然是依次进行,而是可以与其它步骤或者其它步骤中的步骤或者阶段的至少一部分轮流或者交替地执行。
基于同样的发明构思,本申请实施例还提供了一种用于实现上述所涉及的车辆的控制方法的车辆的控制装置。该装置所提供的解决问题的实现方案与上述方法中所记载的实现方案相似,故下面所提供的一个或多个车辆的控制装置实施例中的具体限定可以参见上文中对于车辆的控制方法的限定,在此不再赘述。
在一个实施例中,如图3所示,提供了一种车辆的控制装置,包括:
第一获取模块310,用于获取车辆当前行驶道路的道路信息以及所述车辆当前的第一行驶速度、第一车辆航向角和当前所在第一坐标系的信息,并在所述车辆的行驶轨迹上确定历史目标位置以及所述历史目标位置所在第二坐标系的信息,所述道路信息至少包括道路中线或者道路边线;
前视预瞄距离获取模块320,用于根据所述第一行驶速度获得所述车辆在行驶方向上的前视预瞄距离;
前视预瞄曲率获取模块330,用于根据所述前视预瞄距离、所述第一车辆航向角和所述道路信息获得所述车辆的前视预瞄曲率;
第二获取模块340,用于根据所述第一坐标系的信息和所述第二坐标系的信息获得所述车辆横摆角的变化值,并获得所述历史目标位置到所述前视预瞄距离对应的前视预瞄线段的第一距离;
后视预瞄曲率获取模块350,用于根据所述横摆角的变化值、所述第一距离、所述第一车辆航向角和所述道路信息获得所述车辆当前的后视预瞄曲率;
道路曲率获取模块360,用于根据所述前视预瞄曲率和后视预瞄曲率进行加权求和,获得道路曲率;
控制模块370,用于根据所述道路曲率控制所述车辆进行自动驾驶。
在一个实施例中,前视预瞄距离获取模块320,还用于:
根据所述第一行驶速度和预设的前视预瞄距离修正参数,获得所述车辆在行驶方向上的前视预瞄距离。
在一个实施例中,前视预瞄距离获取模块320,还用于:
在当前行驶道路的中线或者边线上确定第一点和第二点,所述第一点位于第一垂线上,所述第二点位于第二垂线上,所述第一垂线过所述前视预瞄线段的第一端点且与所述前视预瞄线段垂直,所述第二垂线过所述前视预瞄线段的第二端点且与所述前视预瞄线段垂直;
确定所述中线或者边线的第一切线上的第三点,所述第三点和所述第一点位于所述第一切线上,所述第三点与所述第二点的连线与所述第一切线垂直;
根据所述前视预瞄距离和所述第一车辆航向角分别确定所述第一点和所述第三点之间的第二距离,以及所述第二点和所述第三点之间的第三距离;
根据所述第二距离和所述第三距离获得所述前视预瞄曲率。
在一个实施例中,前视预瞄距离获取模块320,还用于:
根据所述第二距离和所述第三距离确定所述第一点和所述第二点所在圆的第一半径;
根据所述第一半径获得所述车辆的前视预瞄曲率。
在一个实施例中,后视预瞄曲率获取模块350,用于:
在当前行驶道路的中线或者边线上确定第四点,所述第四点位于所述第二坐标系的一轴线上;
确定所述第一切线上的第五点,所述第五点和所述第四点的连线与所述第一切线垂直;
获得所述第五点与所述第四点之间的第四距离,所述第一点与所述第五点之间的第五距离;
根据所述第四距离和所述第五距离获得所述后视预瞄曲率。
在一个实施例中,后视预瞄曲率获取模块350,用于:
根据所述第四距离和所述第五距离确定所述第一点和所述第四点所在圆的第二半径;
根据所述第二半径获得所述车辆的后视预瞄曲率。
在一个实施例中,所述第一坐标系和所述第二坐标系的圆点均为所述车辆的前保险杆中点,所述第一坐标系和所述第二坐标系的x轴均为所述车辆的行驶方向,y轴为垂直所述行驶方向的第一方向。
上述车辆的控制装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中,也可以以软件形式存储于计算机设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。
在一个实施例中,提供了一种车辆,该车辆可以是新能源汽车、汽车、玩具汽车等可以实现自动驾驶的车辆,其内部结构图可以如图4所示。该车辆包括通过系统总线连接的处理器、存储器和网络接口。其中,该车辆的处理器用于提供计算和控制能力。该车辆的存储器包括非易失性存储介质和内存储器。该非易失性存储介质存储有操作系统、计算机程序和数据库。该内存储器为非易失性存储介质中的操作系统和计算机程序的运行提供环境。该车辆的数据库用于存储道路信息、车辆的行驶路径和行驶速度等数据。该车辆的网络接口用于与外部的终端通过网络连接通信。该计算机程序被处理器执行时以实现一种车辆的控制方法。
本领域技术人员可以理解,图4中示出的结构,仅仅是与本申请方案相关的部分结构的框图,并不构成对本申请方案所应用于其上的计算机设备的限定,具体的计算机设备可以包括比图中所示更多或更少的部件,或者组合某些部件,或者具有不同的部件布置。
在一个实施例中,提供了一种车辆,包括存储器和处理器,存储器中存储有计算机程序,该处理器执行计算机程序时实现以下步骤:
获取所述车辆当前行驶道路的道路信息以及所述车辆当前的第一行驶速度、第一车辆航向角和当前所在第一坐标系的信息,并在所述车辆的行驶轨迹上确定历史目标位置以及所述历史目标位置所在第二坐标系的信息,所述道路信息至少包括道路中线或者道路边线;
根据所述第一行驶速度获得所述车辆在行驶方向上的前视预瞄距离;
根据所述前视预瞄距离、所述第一车辆航向角和所述道路信息获得所述车辆的前视预瞄曲率;
根据所述第一坐标系的信息和所述第二坐标系的信息获得所述车辆横摆角的变化值,并获得所述历史目标位置到所述前视预瞄距离对应的前视预瞄线段的第一距离;
根据所述横摆角的变化值、所述第一距离、所述第一车辆航向角和所述道路信息获得所述车辆当前的后视预瞄曲率;
根据所述前视预瞄曲率和后视预瞄曲率进行加权求和,获得道路曲率;
根据所述道路曲率控制所述车辆进行自动驾驶。
在一个实施例中,处理器执行计算机程序时还实现以下步骤:
根据所述第一行驶速度和预设的前视预瞄距离修正参数,获得所述车辆在行驶方向上的前视预瞄距离。
在一个实施例中,处理器执行计算机程序时还实现以下步骤:
在当前行驶道路的中线或者边线上确定第一点和第二点,所述第一点位于第一垂线上,所述第二点位于第二垂线上,所述第一垂线过所述前视预瞄线段的第一端点且与所述前视预瞄线段垂直,所述第二垂线过所述前视预瞄线段的第二端点且与所述前视预瞄线段垂直;
确定所述中线或者边线的第一切线上的第三点,所述第三点和所述第一点位于所述第一切线上,所述第三点与所述第二点的连线与所述第一切线垂直;
根据所述前视预瞄距离和所述第一车辆航向角分别确定所述第一点和所述第三点之间的第二距离,以及所述第二点和所述第三点之间的第三距离;
根据所述第二距离和所述第三距离获得所述前视预瞄曲率。
在一个实施例中,处理器执行计算机程序时还实现以下步骤:
根据所述第二距离和所述第三距离确定所述第一点和所述第二点所在圆的第一半径;
根据所述第一半径获得所述车辆的前视预瞄曲率。
在一个实施例中,处理器执行计算机程序时还实现以下步骤:
在当前行驶道路的中线或者边线上确定第四点,所述第四点位于所述第二坐标系的一轴线上;
确定所述第一切线上的第五点,所述第五点和所述第四点的连线与所述第一切线垂直;
获得所述第五点与所述第四点之间的第四距离,所述第一点与所述第五点之间的第五距离;
根据所述第四距离和所述第五距离获得所述后视预瞄曲率。
在一个实施例中,处理器执行计算机程序时还实现以下步骤:
根据所述第四距离和所述第五距离确定所述第一点和所述第四点所在圆的第二半径;
根据所述第二半径获得所述车辆的后视预瞄曲率。
在一个实施例中,所述第一坐标系和所述第二坐标系的圆点均为所述车辆的前保险杆中点,所述第一坐标系和所述第二坐标系的x轴均为所述车辆的行驶方向,y轴为垂直所述行驶方向的第一方向。
在一个实施例中,提供了一种计算机可读存储介质,其上存储有计算机程序,计算机程序被处理器执行时实现以下步骤:
获取所述车辆当前行驶道路的道路信息以及所述车辆当前的第一行驶速度、第一车辆航向角和当前所在第一坐标系的信息,并在所述车辆的行驶轨迹上确定历史目标位置以及所述历史目标位置所在第二坐标系的信息,所述道路信息至少包括道路中线或者道路边线;
根据所述第一行驶速度获得所述车辆在行驶方向上的前视预瞄距离;
根据所述前视预瞄距离、所述第一车辆航向角和所述道路信息获得所述车辆的前视预瞄曲率;
根据所述第一坐标系的信息和所述第二坐标系的信息获得所述车辆横摆角的变化值,并获得所述历史目标位置到所述前视预瞄距离对应的前视预瞄线段的第一距离;
根据所述横摆角的变化值、所述第一距离、所述第一车辆航向角和所述道路信息获得所述车辆当前的后视预瞄曲率;
根据所述前视预瞄曲率和后视预瞄曲率进行加权求和,获得道路曲率;
根据所述道路曲率控制所述车辆进行自动驾驶。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:
根据所述第一行驶速度和预设的前视预瞄距离修正参数,获得所述车辆在行驶方向上的前视预瞄距离。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:
在当前行驶道路的中线或者边线上确定第一点和第二点,所述第一点位于第一垂线上,所述第二点位于第二垂线上,所述第一垂线过所述前视预瞄线段的第一端点且与所述前视预瞄线段垂直,所述第二垂线过所述前视预瞄线段的第二端点且与所述前视预瞄线段垂直;
确定所述中线或者边线的第一切线上的第三点,所述第三点和所述第一点位于所述第一切线上,所述第三点与所述第二点的连线与所述第一切线垂直;
根据所述前视预瞄距离和所述第一车辆航向角分别确定所述第一点和所述第三点之间的第二距离,以及所述第二点和所述第三点之间的第三距离;
根据所述第二距离和所述第三距离获得所述前视预瞄曲率。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:
根据所述第二距离和所述第三距离确定所述第一点和所述第二点所在圆的第一半径;
根据所述第一半径获得所述车辆的前视预瞄曲率。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:
在当前行驶道路的中线或者边线上确定第四点,所述第四点位于所述第二坐标系的一轴线上;
确定所述第一切线上的第五点,所述第五点和所述第四点的连线与所述第一切线垂直;
获得所述第五点与所述第四点之间的第四距离,所述第一点与所述第五点之间的第五距离;
根据所述第四距离和所述第五距离获得所述后视预瞄曲率。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:
根据所述第四距离和所述第五距离确定所述第一点和所述第四点所在圆的第二半径;
根据所述第二半径获得所述车辆的后视预瞄曲率。
在一个实施例中,所述第一坐标系和所述第二坐标系的圆点均为所述车辆的前保险杆中点,所述第一坐标系和所述第二坐标系的x轴均为所述车辆的行驶方向,y轴为垂直所述行驶方向的第一方向。
在一个实施例中,提供了一种计算机程序产品,包括计算机程序,该计算机程序被处理器执行时实现以下步骤:
获取所述车辆当前行驶道路的道路信息以及所述车辆当前的第一行驶速度、第一车辆航向角和当前所在第一坐标系的信息,并在所述车辆的行驶轨迹上确定历史目标位置以及所述历史目标位置所在第二坐标系的信息,所述道路信息至少包括道路中线或者道路边线;
根据所述第一行驶速度获得所述车辆在行驶方向上的前视预瞄距离;
根据所述前视预瞄距离、所述第一车辆航向角和所述道路信息获得所述车辆的前视预瞄曲率;
根据所述第一坐标系的信息和所述第二坐标系的信息获得所述车辆横摆角的变化值,并获得所述历史目标位置到所述前视预瞄距离对应的前视预瞄线段的第一距离;
根据所述横摆角的变化值、所述第一距离、所述第一车辆航向角和所述道路信息获得所述车辆当前的后视预瞄曲率;
根据所述前视预瞄曲率和后视预瞄曲率进行加权求和,获得道路曲率;
根据所述道路曲率控制所述车辆进行自动驾驶。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:
根据所述第一行驶速度和预设的前视预瞄距离修正参数,获得所述车辆在行驶方向上的前视预瞄距离。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:
在当前行驶道路的中线或者边线上确定第一点和第二点,所述第一点位于第一垂线上,所述第二点位于第二垂线上,所述第一垂线过所述前视预瞄线段的第一端点且与所述前视预瞄线段垂直,所述第二垂线过所述前视预瞄线段的第二端点且与所述前视预瞄线段垂直;
确定所述中线或者边线的第一切线上的第三点,所述第三点和所述第一点位于所述第一切线上,所述第三点与所述第二点的连线与所述第一切线垂直;
根据所述前视预瞄距离和所述第一车辆航向角分别确定所述第一点和所述第三点之间的第二距离,以及所述第二点和所述第三点之间的第三距离;
根据所述第二距离和所述第三距离获得所述前视预瞄曲率。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:
根据所述第二距离和所述第三距离确定所述第一点和所述第二点所在圆的第一半径;
根据所述第一半径获得所述车辆的前视预瞄曲率。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:
在当前行驶道路的中线或者边线上确定第四点,所述第四点位于所述第二坐标系的一轴线上;
确定所述第一切线上的第五点,所述第五点和所述第四点的连线与所述第一切线垂直;
获得所述第五点与所述第四点之间的第四距离,所述第一点与所述第五点之间的第五距离;
根据所述第四距离和所述第五距离获得所述后视预瞄曲率。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:
根据所述第四距离和所述第五距离确定所述第一点和所述第四点所在圆的第二半径;
根据所述第二半径获得所述车辆的后视预瞄曲率。
在一个实施例中,所述第一坐标系和所述第二坐标系的圆点均为所述车辆的前保险杆中点,所述第一坐标系和所述第二坐标系的x轴均为所述车辆的行驶方向,y轴为垂直所述行驶方向的第一方向。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。其中,本申请所提供的各实施例中所使用的对存储器、数据库或其它介质的任何引用,均可包括非易失性和易失性存储器中的至少一种。非易失性存储器可包括只读存储器(Read-OnlyMemory,ROM)、磁带、软盘、闪存、光存储器、高密度嵌入式非易失性存储器、阻变存储器(ReRAM)、磁变存储器(Magnetoresistive Random Access Memory,MRAM)、铁电存储器(Ferroelectric Random Access Memory,FRAM)、相变存储器(Phase Change Memory,PCM)、石墨烯存储器等。易失性存储器可包括随机存取存储器(Random Access Memory,RAM)或外部高速缓冲存储器等。作为说明而非局限,RAM可以是多种形式,比如静态随机存取存储器(Static Random Access Memory,SRAM)或动态随机存取存储器(Dynamic RandomAccessMemory,DRAM)等。本申请所提供的各实施例中所涉及的数据库可包括关系型数据库和非关系型数据库中至少一种。非关系型数据库可包括基于区块链的分布式数据库等,不限于此。本申请所提供的各实施例中所涉及的处理器可为通用处理器、中央处理器、图形处理器、数字信号处理器、可编程逻辑器、基于量子计算的数据处理逻辑器等,不限于此。
以上实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
以上所述实施例仅表达了本申请的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对本申请专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请构思的前提下,还可以做出若干变形和改进,这些都属于本申请的保护范围。因此,本申请的保护范围应以所附权利要求为准。
Claims (10)
1.一种车辆的控制方法,其特征在于,所述方法包括:
获取所述车辆当前行驶道路的道路信息以及所述车辆当前的第一行驶速度、第一车辆航向角和当前所在第一坐标系的信息,并在所述车辆的行驶轨迹上确定历史目标位置以及所述历史目标位置所在第二坐标系的信息,所述道路信息至少包括道路中线或者道路边线;
根据所述第一行驶速度获得所述车辆在行驶方向上的前视预瞄距离;
根据所述前视预瞄距离、所述第一车辆航向角和所述道路信息获得所述车辆的前视预瞄曲率;
根据所述第一坐标系的信息和所述第二坐标系的信息获得所述车辆横摆角的变化值,并获得所述历史目标位置到所述前视预瞄距离对应的前视预瞄线段的第一距离;
根据所述横摆角的变化值、所述第一距离、所述第一车辆航向角和所述道路信息获得所述车辆当前的后视预瞄曲率;
根据所述前视预瞄曲率和后视预瞄曲率进行加权求和,获得道路曲率;
根据所述道路曲率控制所述车辆进行自动驾驶。
2.根据权利要求1所述的方法,其特征在于,所述根据所述第一行驶速度获得所述车辆在行驶方向上的前视预瞄距离,包括:
根据所述第一行驶速度和预设的前视预瞄距离修正参数,获得所述车辆在行驶方向上的前视预瞄距离。
3.根据权利要求1所述的方法,其特征在于,所述根据所述前视预瞄距离、所述第一车辆航向角和所述道路信息获得所述车辆的前视预瞄曲率,包括:
在当前行驶道路的中线或者边线上确定第一点和第二点,所述第一点位于第一垂线上,所述第二点位于第二垂线上,所述第一垂线过所述前视预瞄线段的第一端点且与所述前视预瞄线段垂直,所述第二垂线过所述前视预瞄线段的第二端点且与所述前视预瞄线段垂直;
确定所述中线或者边线的第一切线上的第三点,所述第三点和所述第一点位于所述第一切线上,所述第三点与所述第二点的连线与所述第一切线垂直;
根据所述前视预瞄距离和所述第一车辆航向角分别确定所述第一点和所述第三点之间的第二距离,以及所述第二点和所述第三点之间的第三距离;
根据所述第二距离和所述第三距离获得所述前视预瞄曲率。
4.根据权利要求3所述的方法,其特征在于,所述根据所述第二距离和所述第三距离获得所述前视预瞄曲率,包括:
根据所述第二距离和所述第三距离确定所述第一点和所述第二点所在圆的第一半径;
根据所述第一半径获得所述车辆的前视预瞄曲率。
5.根据权利要求3所述的方法,其特征在于,所述根据所述横摆角的变化值、所述第一距离、所述第一车辆航向角和所述道路信息获得所述车辆当前的后视预瞄曲率,包括:
在当前行驶道路的中线或者边线上确定第四点,所述第四点位于所述第二坐标系的一轴线上;
确定所述第一切线上的第五点,所述第五点和所述第四点的连线与所述第一切线垂直;
获得所述第五点与所述第四点之间的第四距离,所述第一点与所述第五点之间的第五距离;
根据所述第四距离和所述第五距离获得所述后视预瞄曲率。
6.根据权利要求5所述的方法,其特征在于,所述根据所述第四距离和所述第五距离获得所述后视预瞄曲率,包括:
根据所述第四距离和所述第五距离确定所述第一点和所述第四点所在圆的第二半径;
根据所述第二半径获得所述车辆的后视预瞄曲率。
7.根据权利要求1-6中任一项所述的方法,其特征在于,所述第一坐标系和所述第二坐标系的圆点均为所述车辆的前保险杆中点,所述第一坐标系和所述第二坐标系的x轴均为所述车辆的行驶方向,y轴为垂直所述行驶方向的第一方向。
8.一种车辆的控制装置,其特征在于,所述装置包括:
第一获取模块,用于获取车辆当前行驶道路的道路信息以及所述车辆当前的第一行驶速度、第一车辆航向角和当前所在第一坐标系的信息,并在所述车辆的行驶轨迹上确定历史目标位置以及所述历史目标位置所在第二坐标系的信息,所述道路信息至少包括道路中线或者道路边线;
前视预瞄距离获取模块,用于根据所述第一行驶速度获得所述车辆在行驶方向上的前视预瞄距离;
前视预瞄曲率获取模块,用于根据所述前视预瞄距离、所述第一车辆航向角和所述道路信息获得所述车辆的前视预瞄曲率;
第二获取模块,用于根据所述第一坐标系的信息和所述第二坐标系的信息获得所述车辆横摆角的变化值,并获得所述历史目标位置到所述前视预瞄距离对应的前视预瞄线段的第一距离;
后视预瞄曲率获取模块,用于根据所述横摆角的变化值、所述第一距离、所述第一车辆航向角和所述道路信息获得所述车辆当前的后视预瞄曲率;
道路曲率获取模块,用于根据所述前视预瞄曲率和后视预瞄曲率进行加权求和,获得道路曲率;
控制模块,用于根据所述道路曲率控制所述车辆进行自动驾驶。
9.一种车辆,包括存储器和处理器,所述存储器存储有计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1至7中任一项所述的方法的步骤。
10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至7中任一项所述的方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310417703.3A CN116118751B (zh) | 2023-04-19 | 2023-04-19 | 车辆的控制方法、装置、车辆和存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310417703.3A CN116118751B (zh) | 2023-04-19 | 2023-04-19 | 车辆的控制方法、装置、车辆和存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN116118751A true CN116118751A (zh) | 2023-05-16 |
CN116118751B CN116118751B (zh) | 2023-08-29 |
Family
ID=86312190
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310417703.3A Active CN116118751B (zh) | 2023-04-19 | 2023-04-19 | 车辆的控制方法、装置、车辆和存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116118751B (zh) |
Citations (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002264688A (ja) * | 2001-03-07 | 2002-09-18 | Honda Motor Co Ltd | オートクルーズ装置 |
US20050240334A1 (en) * | 2004-04-23 | 2005-10-27 | Nissan Motor Co., Ltd. | Adaptive cruise control system for automotive vehicle |
JP2010191661A (ja) * | 2009-02-18 | 2010-09-02 | Nissan Motor Co Ltd | 走行路認識装置、自動車及び走行路認識方法 |
US20100318263A1 (en) * | 2009-06-16 | 2010-12-16 | Nissan Motor Co., Ltd. | Vehicle driving support system and vehicle driving support method |
KR101672133B1 (ko) * | 2015-05-12 | 2016-11-16 | 한양대학교 산학협력단 | 차량 궤적 예측 장치 및 방법과, 이를 이용한 적응식 정속 주행 시스템 |
CN108116497A (zh) * | 2017-12-08 | 2018-06-05 | 驭势科技(北京)有限公司 | 用于智能驾驶的转向预瞄点、转向角的确定方法及装置 |
WO2019052567A1 (zh) * | 2017-09-18 | 2019-03-21 | 中车株洲电力机车研究所有限公司 | 一种用于虚拟轨道车辆的虚拟道岔系统及方法 |
CN111717204A (zh) * | 2019-03-18 | 2020-09-29 | 长城汽车股份有限公司 | 自动驾驶车辆的横向控制方法及系统 |
CN111717189A (zh) * | 2019-03-18 | 2020-09-29 | 长城汽车股份有限公司 | 车道保持控制方法、装置及系统 |
CN112537303A (zh) * | 2020-12-14 | 2021-03-23 | 英博超算(南京)科技有限公司 | 一种智能车辆车道居中保持方法 |
CN112558617A (zh) * | 2021-02-19 | 2021-03-26 | 深圳佑驾创新科技有限公司 | 泊车控制方法、装置、计算机设备和存储介质 |
CN113204236A (zh) * | 2021-04-14 | 2021-08-03 | 华中科技大学 | 一种智能体路径跟踪控制方法 |
CN113928325A (zh) * | 2021-12-17 | 2022-01-14 | 深圳佑驾创新科技有限公司 | 一种驾驶辅助接管提示方法、装置、终端设备及存储介质 |
CN113942527A (zh) * | 2021-12-03 | 2022-01-18 | 天津天瞳威势电子科技有限公司 | 一种基于自动驾驶的车辆控制方法及装置 |
CN114148320A (zh) * | 2021-12-08 | 2022-03-08 | 华人运通(上海)自动驾驶科技有限公司 | 一种路径跟踪控制方法及设备 |
CN114291071A (zh) * | 2021-12-02 | 2022-04-08 | 江铃汽车股份有限公司 | 一种车辆稳定性控制主动介入时机的判定方法、系统、可读存储介质及车辆 |
CN114655248A (zh) * | 2021-05-11 | 2022-06-24 | 雄狮汽车科技(南京)有限公司 | 自动驾驶车辆的横向控制方法、装置及车辆 |
CN114740835A (zh) * | 2022-03-02 | 2022-07-12 | 深圳鹏行智能研究有限公司 | 路径规划方法、路径规划装置、机器人和存储介质 |
CN114779641A (zh) * | 2022-04-27 | 2022-07-22 | 福州大学 | 基于新航向误差定义的环境自适应mpc路径追踪控制方法 |
WO2022160196A1 (zh) * | 2021-01-28 | 2022-08-04 | 浙江吉利控股集团有限公司 | 车辆驾驶控制方法、装置、车辆及存储介质 |
CN114906173A (zh) * | 2022-06-30 | 2022-08-16 | 电子科技大学 | 一种基于两点预瞄驾驶员模型的自动驾驶决策方法 |
EP4056441A1 (en) * | 2021-03-12 | 2022-09-14 | Aptiv Technologies Limited | Back propagation planning for adas/ad motion planning and control |
-
2023
- 2023-04-19 CN CN202310417703.3A patent/CN116118751B/zh active Active
Patent Citations (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002264688A (ja) * | 2001-03-07 | 2002-09-18 | Honda Motor Co Ltd | オートクルーズ装置 |
US20050240334A1 (en) * | 2004-04-23 | 2005-10-27 | Nissan Motor Co., Ltd. | Adaptive cruise control system for automotive vehicle |
JP2010191661A (ja) * | 2009-02-18 | 2010-09-02 | Nissan Motor Co Ltd | 走行路認識装置、自動車及び走行路認識方法 |
US20100318263A1 (en) * | 2009-06-16 | 2010-12-16 | Nissan Motor Co., Ltd. | Vehicle driving support system and vehicle driving support method |
KR101672133B1 (ko) * | 2015-05-12 | 2016-11-16 | 한양대학교 산학협력단 | 차량 궤적 예측 장치 및 방법과, 이를 이용한 적응식 정속 주행 시스템 |
WO2019052567A1 (zh) * | 2017-09-18 | 2019-03-21 | 中车株洲电力机车研究所有限公司 | 一种用于虚拟轨道车辆的虚拟道岔系统及方法 |
CN108116497A (zh) * | 2017-12-08 | 2018-06-05 | 驭势科技(北京)有限公司 | 用于智能驾驶的转向预瞄点、转向角的确定方法及装置 |
CN111717204A (zh) * | 2019-03-18 | 2020-09-29 | 长城汽车股份有限公司 | 自动驾驶车辆的横向控制方法及系统 |
CN111717189A (zh) * | 2019-03-18 | 2020-09-29 | 长城汽车股份有限公司 | 车道保持控制方法、装置及系统 |
CN112537303A (zh) * | 2020-12-14 | 2021-03-23 | 英博超算(南京)科技有限公司 | 一种智能车辆车道居中保持方法 |
WO2022160196A1 (zh) * | 2021-01-28 | 2022-08-04 | 浙江吉利控股集团有限公司 | 车辆驾驶控制方法、装置、车辆及存储介质 |
CN112558617A (zh) * | 2021-02-19 | 2021-03-26 | 深圳佑驾创新科技有限公司 | 泊车控制方法、装置、计算机设备和存储介质 |
EP4056441A1 (en) * | 2021-03-12 | 2022-09-14 | Aptiv Technologies Limited | Back propagation planning for adas/ad motion planning and control |
CN113204236A (zh) * | 2021-04-14 | 2021-08-03 | 华中科技大学 | 一种智能体路径跟踪控制方法 |
CN114655248A (zh) * | 2021-05-11 | 2022-06-24 | 雄狮汽车科技(南京)有限公司 | 自动驾驶车辆的横向控制方法、装置及车辆 |
WO2022237392A1 (zh) * | 2021-05-11 | 2022-11-17 | 奇瑞汽车股份有限公司 | 车辆的横向控制方法、装置及车辆 |
CN114291071A (zh) * | 2021-12-02 | 2022-04-08 | 江铃汽车股份有限公司 | 一种车辆稳定性控制主动介入时机的判定方法、系统、可读存储介质及车辆 |
CN113942527A (zh) * | 2021-12-03 | 2022-01-18 | 天津天瞳威势电子科技有限公司 | 一种基于自动驾驶的车辆控制方法及装置 |
CN114148320A (zh) * | 2021-12-08 | 2022-03-08 | 华人运通(上海)自动驾驶科技有限公司 | 一种路径跟踪控制方法及设备 |
CN113928325A (zh) * | 2021-12-17 | 2022-01-14 | 深圳佑驾创新科技有限公司 | 一种驾驶辅助接管提示方法、装置、终端设备及存储介质 |
CN114740835A (zh) * | 2022-03-02 | 2022-07-12 | 深圳鹏行智能研究有限公司 | 路径规划方法、路径规划装置、机器人和存储介质 |
CN114779641A (zh) * | 2022-04-27 | 2022-07-22 | 福州大学 | 基于新航向误差定义的环境自适应mpc路径追踪控制方法 |
CN114906173A (zh) * | 2022-06-30 | 2022-08-16 | 电子科技大学 | 一种基于两点预瞄驾驶员模型的自动驾驶决策方法 |
Non-Patent Citations (3)
Title |
---|
FIRST A. GAO ZHENHAI ET AL: "Optimal preview trajectory decision model of lane-keeping system with driver behavior simulation and Artificial Potential Field", 2009 IEEE INTELLIGENT VEHICLES SYMPOSIUM, pages 797 - 801 * |
董婷;: "基于改进预瞄驾驶员模型的车道保持系统", 汽车实用技术, no. 24, pages 143 - 145 * |
高菲;李向瑜;段立飞;王兵;: "驾驶员前视行为特性的动态变化规律", 汽车工程师, no. 02, pages 30 - 33 * |
Also Published As
Publication number | Publication date |
---|---|
CN116118751B (zh) | 2023-08-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111717189B (zh) | 车道保持控制方法、装置及系统 | |
WO2020187257A1 (zh) | 车辆异常换道控制方法、装置及系统 | |
CN111717204B (zh) | 自动驾驶车辆的横向控制方法及系统 | |
CN110006419B (zh) | 一种基于预瞄的车辆轨迹跟踪点确定方法 | |
CN112277931B (zh) | 垂直泊车轨迹生成方法、装置、车辆及存储介质 | |
CN116457259A (zh) | 车辆驾驶控制方法、装置、车辆及存储介质 | |
WO2022095460A1 (zh) | 一种车辆横向控制方法、装置、车辆和可读存储介质 | |
CN110789530B (zh) | 一种四轮独立转向-独立驱动车辆轨迹跟踪方法和系统 | |
CN116118751B (zh) | 车辆的控制方法、装置、车辆和存储介质 | |
CN114643980A (zh) | 泊车路径实时调整方法、装置、设备及存储介质 | |
CN111169470B (zh) | 一种自动泊车方法、装置及电子设备 | |
CN114291117B (zh) | 一种四轮转向无人车辆轨迹跟踪控制方法 | |
CN116080678A (zh) | 一种面向菱形车辆的自动驾驶避障规划方法及装置 | |
CN115973191A (zh) | 智能汽车人机共驾控制方法 | |
CN115635967A (zh) | 一种车辆控制方法、装置、车载终端及存储介质 | |
CN114275041A (zh) | 自动驾驶车辆横向控制的方法、装置、车辆及存储介质 | |
CN116215654A (zh) | 水平运输车的转向控制方法、装置和计算机设备 | |
CN116729361B (zh) | 一种车辆横向控制方法及装置 | |
CN115892208A (zh) | 一种车辆终端、车辆转弯控制方法及装置 | |
CN116513175B (zh) | 一种自动驾驶中行驶偏差的校正方法、装置、设备及介质 | |
CN117048593A (zh) | 车辆横向控制方法、装置、计算机设备及存储介质 | |
CN117537841A (zh) | 一种自动驾驶车辆的倒车路径生成方法和系统 | |
CN117657121A (zh) | 车辆的自动泊车方法、装置、车辆及存储介质 | |
WO2021051405A1 (zh) | 车辆控制方法、车辆控制装置、车辆及计算机可读存储介质 | |
CN115933673A (zh) | 一种双差速轮组驱动型agv的轨迹跟踪方法及agv |
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 |