CN115230688B - 障碍物轨迹预测方法、系统和计算机可读存储介质 - Google Patents
障碍物轨迹预测方法、系统和计算机可读存储介质 Download PDFInfo
- Publication number
- CN115230688B CN115230688B CN202111486385.3A CN202111486385A CN115230688B CN 115230688 B CN115230688 B CN 115230688B CN 202111486385 A CN202111486385 A CN 202111486385A CN 115230688 B CN115230688 B CN 115230688B
- Authority
- CN
- China
- Prior art keywords
- obstacle
- candidate
- endpoints
- information
- end point
- 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
- 238000000034 method Methods 0.000 title claims abstract description 60
- 230000033001 locomotion Effects 0.000 claims abstract description 67
- 238000013528 artificial neural network Methods 0.000 claims description 12
- 238000005457 optimization Methods 0.000 claims description 9
- 238000004422 calculation algorithm Methods 0.000 claims description 7
- 238000013527 convolutional neural network Methods 0.000 claims description 4
- 230000004888 barrier function Effects 0.000 abstract description 4
- 230000008569 process Effects 0.000 description 10
- 238000005516 engineering process Methods 0.000 description 4
- 238000007781 pre-processing Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
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
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/095—Predicting travel path or likelihood of collision
- B60W30/0956—Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
-
- 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
- B60W50/0097—Predicting future conditions
-
- 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
- B60W50/0098—Details of control systems ensuring comfort, safety or stability not otherwise provided for
-
- 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
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/50—Barriers
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
Abstract
本申请提供一种障碍物轨迹预测方法、系统和计算机可读存储介质。其中,障碍物轨迹预测方法包括获取障碍物的信息及障碍物预估运动的地图信息;根据地图信息,确定障碍物的多个候选终点;根据多个候选终点提取多个候选终点的特征,根据地图信息提取地图特征,并根据障碍物的信息提取障碍物特征;根据这些特征,从多个候选终点中确定多个预定终点,多个预定终点相较于多个候选终点中的其余候选终点,成为预估运动轨迹的目标终点的可能性更高;根据多个预定终点,确定障碍物的目标终点,其中,目标终点包括历史轨迹终点及未来达到终点;根据目标终点,确定障碍物的从历史轨迹终点到未来达到终点的预估运动轨迹。如此以方便开发人员理解。
Description
技术领域
本申请涉及自动驾驶技术领域,尤其涉及一种障碍物轨迹预测方法、系统和计算机可读存储介质。
背景技术
随着自动驾驶技术的日渐成熟,自动驾驶车辆得以广泛应用。为了可以使得自动驾驶车辆在城市道路、封闭园区、高速公路等复杂场景中行驶,自动驾驶车辆需要对周围车辆、行人、自行车等障碍物进行轨迹预测,以便预知风险,避免发生事故。
相关技术的方法中将障碍物相关的地图信息与障碍物历史轨迹信息经过预处理后,输入神经网络,从而确定障碍物的目标轨迹。但是,相关技术的方法为黑盒模型,其内部工作机制,很难被开发人员理解,这样不利于方法的后期优化,也不方便及时掌握预估运动轨迹的确定过程。
发明内容
本申请提供一种障碍物轨迹预测方法、系统和计算机可读存储介质,方法方便开发人员理解。
本申请提供一种障碍物轨迹预测方法,所述障碍物轨迹预测方法包括:
获取障碍物的信息及所述障碍物预估运动的地图信息;
根据所述地图信息,确定所述障碍物的多个候选终点;
根据多个所述候选终点提取多个所述候选终点的特征,根据所述地图信息提取地图特征,并根据所述障碍物的信息提取所述障碍物特征;
根据所述候选终点的特征、所述地图特征及所述障碍物特征,从多个所述候选终点中确定多个预定终点,多个所述预定终点相较于多个所述候选终点中的其余候选终点,成为预估运动轨迹的目标终点的可能性更高;
根据多个所述预定终点,确定所述障碍物的目标终点,其中,所述目标终点包括历史轨迹终点及未来达到终点;及,
根据所述目标终点,确定所述障碍物的从所述历史轨迹终点到所述未来达到终点的预估运动轨迹。
可选的,所述障碍物的信息包括障碍物的历史位置信息;
所述地图信息包括车道线信息,所述车道线信息包括车道线邻接关系及车道线连接关系;
所述根据所述地图信息,确定所述障碍物的多个候选终点,包括:
根据所述历史位置信息,确定与所述障碍物实际运动方向相匹配的基础车道;
根据所述基础车道的车道线邻接关系及所述基础车道的车道线连接关系,在所述基础车道周围拓展多条候选车道;
根据多条所述候选车道,确定多个所述候选终点。
可选的,所述根据多个所述候选终点提取多个所述候选终点的特征,包括:根据多个所述候选终点,采用多层感知机,确定多个所述候选终点的特征。
可选的,所述根据多条所述候选车道,确定多个所述候选终点,包括:
以预定间隔均匀地在每条所述候选车道上选择多个点,作为多个所述候选终点。
可选的,所述以预定间隔均匀地在每条所述候选车道上选择多个点,作为多个所述候选终点,包括:沿所述候选车道的车道线方向,以预定间隔均匀地在每条所述候选车道的车道中心线上选择多个点,作为多个所述候选终点;
和/或,
所述以预定间隔均匀地在每条所述候选车道上选择多个点,作为多个所述候选终点,包括:沿所述候选车道的车道线方向以及垂直于所述车道线方向的方向,以预定间隔均匀地在每条所述候选车道上选择多个点,作为多个所述候选终点。
可选的,所述障碍物的信息包括障碍物的历史轨迹信息;所述根据所述障碍物的信息提取所述障碍物特征,包括:根据所述历史轨迹信息,采用卷积神经网络,提取所述障碍物特征,所述障碍物运动的时间特征和空间特征;
和/或,
所述地图信息包括车道线信息、可行驶区域信息及语义信息;
所述根据所述地图信息提取地图特征,包括:根据所述车道线信息、所述可行驶区域信息及所述语义信息,采用图神经网络,提取所述地图特征。
可选的,所述从多个所述候选终点中确定多个预定终点,包括:逐个判断多个所述候选终点是否会成为所述目标终点;将可能成为目标终点的多个候选终点,确定为多个预定终点;
和/或,
所述从多个所述候选终点中确定多个预定终点,包括:确定所有候选终点成为所述目标终点的概率,选择可能性最大的预定终点,作为所述目标终点;
和/或,
所述根据多个所述预定终点,确定所述障碍物的目标终点,包括:使用深度神经网络,提取所述预定终点的特征;根据所述预定终点的特征所述地图特征及所述障碍物特征,优化所述预定终点,确定所述目标终点。
可选的,所述根据所述目标终点,确定所述障碍物的从所述历史轨迹终点到所述未来达到终点的预估运动轨迹,包括:根据所述目标终点,使用优化算法,确定预估运动轨迹,以使所述预估运动轨迹平滑且符合障碍物运动学特性;
和/或,
所述根据所述目标终点,确定所述障碍物的从所述历史轨迹终点到所述未来达到终点的预估运动轨迹,包括:根据所述目标终点,提取所述目标终点的特征;将所述目标终点的特征,所述地图特征及所述障碍物特征输入至深度神经网络,以输出所述障碍物的预估运动轨迹。
本申请的提供一种障碍物轨迹预测系统,包括一个或多个处理器,用于实现如上任一项所述的方法。
本申请的提供一种计算机可读存储介质,其上存储有程序,该程序被处理器执行时,实现如上任一项所述的方法。
在一些实施例中,本申请的障碍物轨迹预测方法,获取的障碍物的信息及障碍物预估运动的地图信息,是明确的;提取的多个候选终点的特征、地图特征及障碍物特征,是明确的,并且,根据候选终点的特征、地图特征及障碍物特征,从多个候选终点中确定多个预定终点,预定终点也是明确的,最后根据目标终点,可以确定障碍物的从历史轨迹终点到未来达到终点的预估运动轨迹。如此方法可以先确定目标终点进行估计,再根据历史轨迹终点及未来达到终点确定预估运动轨迹,此估预估运动轨迹是完整的,这样目标终点的估计过程是开发人员更容易理解的,易于根据目标终点对最终的预估运动轨迹做出解释,避免完全黑箱式的预测结果,有利于后期优化,方便及时掌握预估运动轨迹的确定过程。
附图说明
图1所示为本申请提供的障碍物轨迹预测方法的一实施例的流程示意图;
图2所示为图1所示的障碍物轨迹预测方法中的步骤120的一实施例的流程示意图;
图3所示为本申请提供的障碍物轨迹预测系统的一实施例的模块框图。
具体实施方式
这里将详细地对示例性实施例进行说明,其示例表示在附图中。下面的描述涉及附图时,除非另有表示,不同附图中的相同数字表示相同或相似的要素。以下示例性实施例中所描述的实施例并不代表与本说明书一个或多个实施例相一致的所有实施例。相反,它们仅是与如所附权利要求书中所详述的、本说明书一个或多个实施例的一些方面相一致的装置和方法的例子。
需要说明的是:在其他实施例中并不一定按照本说明书示出和描述的顺序来执行相应方法的步骤。在一些其他实施例中,其方法所包括的步骤可以比本说明书所描述的更多或更少。此外,本说明书中所描述的单个步骤,在其他实施例中可能被分解为多个步骤进行描述;而本说明书中所描述的多个步骤,在其他实施例中也可能被合并为单个步骤进行描述。
相关技术的方法为黑盒模型,其内部工作机制,很难被开发人员理解,这样不利于方法的后期优化,也不方便及时掌握预估运动轨迹的确定过程,为了解决这一技术问题,本申请实施例提供的一种障碍物轨迹预测方法,获取的障碍物的信息及障碍物预估运动的地图信息,是明确的;提取的多个候选终点的特征、地图特征及障碍物特征,是明确的,并且,根据候选终点的特征、地图特征及障碍物特征,从多个候选终点中确定多个预定终点,预定终点也是明确的,最后根据目标终点,可以确定障碍物的从历史轨迹终点到未来达到终点的预估运动轨迹。如此方法可以先确定目标终点进行估计,再根据历史轨迹终点及未来达到终点确定预估运动轨迹,此估预估运动轨迹是完整的,这样目标终点的估计过程是开发人员更容易理解的,易于根据目标终点对最终的预估运动轨迹做出解释,避免完全黑箱式的预测结果,也方便其他开发人员理解,有利于后期优化,方便及时掌握预估运动轨迹的确定过程。
下面首先对本申请实施例提供的障碍物轨迹预测方法进行介绍。
本申请实施例提供的一种障碍物轨迹预测方法中的障碍物可以包括移动物。其中移动物比如包括携带有移动设备的人,非机动车辆、机动车辆中的一种或多种。移动设备可以包括具有信息收集功能的手机和/或电话手表。在此并不做限定。
此障碍物轨迹预测方法可以应用于终端设备。此终端设备可以包括车辆,车辆可以包括至少一辆自动驾驶车辆。至少一辆自动驾驶车辆可以包括当前车辆以及除当前车辆以外的其他车辆中的一辆或多辆。如果至少一辆自动驾驶车辆可以包括至少一辆其他车辆,以当前车辆为基准,当前车辆使用该障碍物轨迹预测方法,在当前车辆移动过程中可能会遇到包含至少一辆其他车辆的障碍物,可以预测障碍物的轨迹,当前车辆可以更好的避让或者规划行驶路线。当前车辆可以通过当前车辆的信息用来反映当前车辆的自身情况,其包括当前车辆的位置信息及当前车辆的运动状态信息。如此可以更好的反映当前车辆的位置状态。
图1所示为本申请提供的障碍物轨迹预测方法的一实施例的流程示意图。
如图1所示,本申请实施例所提供的障碍物轨迹预测方法,可以包括如下步骤110~步骤160:
步骤110,获取障碍物的信息及障碍物预估运动的地图信息。
本步骤110中的障碍物的信息用来反映障碍物的自身情况,其包括障碍物的历史位置信息及障碍物的历史运动状态信息。障碍物的历史位置信息可以包括障碍物的历史全球定位系统(Global Positioning System,简称GPS)坐标、障碍物相对当前车辆的历史位置中的一种或多种。障碍物的历史运动状态信息可以包括历史速度、历史加速度、历史姿态角、历史角速度、历史角加速度中的一种或多种。障碍物的历史位置信息及障碍物的历史运动状态信息分别与当前车辆的信息在于时间长不同,障碍物的历史位置信息及障碍物的历史运动状态信息是当前时间之前已记录的,当前车辆的信息是实时获取的。
步骤120,根据地图信息,确定障碍物的多个候选终点。
地图信息用于反映障碍物可以所经的地图信息,其包括车道线信息、可行驶区域信息及语义信息中的一种或多种。车道线信息可以包括车道线位置与形状、车道线邻接关系、车道线连接关系、车道线类型中的一种或多种。车道线邻接关系可以是指左右相邻的关系,车道线连接关系可以是指同一车道前后延伸的车道的关系。车道线类型可以是指直行和/或转弯中的一种或多种。其中,车道可以是由车道中心线、车道左边线、车道右边线构成的。在理想条件下,当车辆直线行驶时,车辆中心的轨迹与车道中心线较为接近。当车辆在车道左边线和车道右边线的中间构成的区域内行驶时,可以称车辆属于此车道。可行驶区域可以包括机动车道区域、非机动车道区域、道路边界中的一种或多种。语义信息可以包括十字路口区域、人行横道区域、交通限制信息中的一种或多种。交通限制信息用于表示障碍物遵守交通规则,如此可以通过障碍物遵守交通规则,准确地预测障碍物的轨迹。交通限制信息可以包括交通灯信息、限速信息及限行信息中的一种或多种。
图2所示为图1所示的障碍物轨迹预测方法中的步骤120的一实施例的流程示意图。如图2所示,步骤120包括如下步骤121~步骤123:
步骤121,根据历史位置信息,确定与障碍物实际运动方向相匹配的基础车道。
在十字路口区域等车道数量多且互相交错时,如此可以障碍物可能会经过多个车道,根据历史位置信息,确定与障碍物实际运动方向相匹配的车道,作为基础车道,这样可以确定障碍物所属的车道。
步骤122,根据基础车道的车道线邻接关系及基础车道的车道线连接关系,在基础车道周围拓展多条候选车道。从障碍物的基础车道开始,可以拓展出多条更长、更完整的候选车道,以覆盖障碍物的变道、转向、直行等一种或多种运动需求。例如障碍物处于在十字路口区域前的基础车道,障碍物既可以直行也可以右转,将拓展出两条候选车道,一条候选车道可以为沿基础车道继续直行的车道,另一条候选车道可以为沿基础车道继续右转的车道。
步骤123,根据多条候选车道,确定多个候选终点。
本步骤123的一实施例可以包括以预定间隔均匀地在每条候选车道上选择多个点,作为多个候选终点,预定间隔可以根据用户需求的预估运动轨迹的精度确定,预估运动轨迹的精度越大,则预定间隔越小,预估运动轨迹的精度越小,则预定间隔越大,在此并不做限定。如此,均匀地在每条候选车道上选择多个点,确定出的候选车道更准确地反映整个候选车道的情况,提高多个候选终点的准确性。进一步的,本步骤123中,针对多个候选车道中的每个候选车道,可以将该条候选车道分段,得到分段车道;依次对一个分段车道以预定间隔均匀地在每条候选车道上选择多个点,作为多个候选终点。这样对一个分段车道的计算量小于整段候选车道的计算量,提高处理效率。
上述以预定间隔均匀地在每条候选车道选择多个点,作为多个候选终点的实施例有多种,在一种实施例中,沿候选车道的车道线方向,以预定间隔均匀地在每条候选车道的车道中心线上选择多个点,作为多个候选终点,如此以中心线为基准选择候选终点,可以在控制计算量大小的情况下,获取较好的预估运动轨迹的预测效果。在另一种实施例中,沿候选车道的车道线方向以及垂直于车道线方向的方向,以预定间隔均匀地在每条候选车道上选择多个点,作为多个候选终点。如此在候选车道内密集选点,会一定程度上增加计算量,但可以获得更为完善、准确的预测结果。其中,候选车道的车道线方向以及垂直于车道线方向的方向选择的多个点的分布,可以是阵列方式或者网格方式,如此不仅选点不仅密集,而且比较有规则,使得选取的候选终点更合理,进而得到的预估运动轨迹更合理。
步骤130,根据多个候选终点提取多个候选终点的特征,根据地图信息提取地图特征,并根据障碍物的信息提取障碍物特征。
其中,本步骤130中的根据多个候选终点提取多个候选终点的特征,可以包括根据多个候选终点,采用多层感知机,确定多个候选终点的特征。如此可以独立使用多层感知机,确定多个候选终点的特征,这样可以更好的挖掘出多个候选终点的特征,以便更好地提取目标终点的特征。
本步骤130中的根据地图信息提取地图特征可以包括根据车道线信息、可行驶区域信息及语义信息,采用图神经网络,提取地图特征,其中地图特征可以包括多条候选车道之间的拓扑特征、位置特征及语义特征。如此可以独立使用图神经网络,可视化地确定地图特征,方便理解地图特征,这样可以更好的挖掘出地图特征。
本步骤130中的根据障碍物的信息提取障碍物特征,包括:根据历史轨迹信息,采用卷积神经网络,提取障碍物运动的时间特征和空间特征。如此可以独立的采用卷积神经网络,提取障碍物运动的时间特征和空间特征,这样可以更好的挖掘障碍物运动的时间特征和空间特征,以有利于目标终点的确定。进一步的,在本步骤130还可以包括对多个所述候选终点、地图信息及障碍物的信息的预处理操作,其中,预处理操作包括坐标转换及信息编码。这样方便去除一些与特征相关的噪声,提高特征提取的准确性,之后再执行提取多个候选终点的特征、地图特征及障碍物特征。
步骤140,根据候选终点的特征、地图特征及障碍物特征,从多个候选终点中确定多个预定终点,多个预定终点相较于多个候选终点中的其余候选终点,成为预估运动轨迹的目标终点的可能性更高。预定终点可以是指初次确定的终点,还需要通过执行步骤150再次确定预定终点是否可以成为最终的目标终点。
本步骤140可以采用多种实施例实现,在一些实施例中,逐个判断多个候选终点是否会成为目标终点;将可能成为目标终点的多个候选终点,确定为多个预定终点。如此设置多个预定终点,可以预测出多条预估运动轨迹,覆盖更完善的轨迹空间,也能减少预估运动轨迹的突变,保证稳定性,同时,逐个确定候选终点,可以提高候选终点确定的准确性。具体的,使用可以多层感知机和/或注意力算法逐个多个候选终点是否会成为目标终点。
在另一些实施例中,确定所有候选终点成为目标终点的概率,选择可能性最大的预定终点,作为目标终点。如此通过概率可以快速确定目标终点,速度更快。具体的,使用可以多层感知机和/或注意力算法,确定所有候选终点成为目标终点的概率。
步骤150,根据多个预定终点,确定障碍物的目标终点,其中,目标终点包括历史轨迹终点及未来达到终点。如此对预定终点进行优化,调整预定终点的位置,使得预定终点的坐标点作为预估运动轨迹的终点更准确。
在本步骤150的一实施例可以包括:可以使用深度神经网络,提取预定终点的特征;根据预定终点的特征地图特征及障碍物特征,优化预定终点,确定目标终点。通过调整终点的设置方式即可控制预测轨迹的生成,保证终点的有效性,可以保证预估运动轨迹的可靠性。随后可以对目标终点进行检查,确保预估运动轨迹符合车辆运动学规律、符合交通规则、没有碰撞等。
步骤160,根据目标终点,确定障碍物的从历史轨迹终点到未来达到终点的预估运动轨迹。
本步骤160有多种实现的实施例,在一种实施例中,根据目标终点,使用优化算法,确定预估运动轨迹,以使预估运动轨迹平滑且符合障碍物运动学特性。如此使用优化算法,可以检测预估运动轨迹,得到平滑且符合障碍物运动学特性的预估运动轨迹,可以保证预估运动轨迹的合理性,进而确保当前车辆的安全性,减小意外事故发生的可能性。在另一种实施例中,根据目标终点,提取目标终点的特征;将目标终点的特征,地图特征及障碍物特征输入至深度神经网络,以输出障碍物的预估运动轨迹。如此利用深度神经网络较强的函数拟合能力,同时避免人为设计复杂的优化算法约束条件。
图3所示为本申请提供的障碍物轨迹预测系统300的一实施例的模块框图。障碍物轨迹预测系统300包括一个或多个处理器301,用于实现如上所述的障碍物轨迹预测方法。
在一些实施例中,障碍物轨迹预测系统300可以包括计算机可读存储介质309,计算机可读存储介质309可以存储有可被处理器301调用的程序,可以包括非易失性存储介质。在一些实施例中,障碍物轨迹预测系统300可以包括内存308和接口307。在一些实施例中,障碍物轨迹预测系统300还可以根据实际应用包括其他硬件。
本申请实施例的计算机可读存储介质309,其上存储有程序,该程序被处理器301执行时,用于实现如上描述的障碍物轨迹预测方法。
本申请可采用在一个或多个其中包含有程序代码的计算机可读存储介质309(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。计算机可读存储介质309包括永久性和非永久性、可移动和非可移动媒体,可以由任何方法或技术来实现信息存储。信息可以是计算机可读指令、数据结构、程序的模块或其他数据。计算机可读存储介质309的例子包括但不限于:相变内存(PRAM)、静态随机存取存储器(SRAM)、动态随机存取存储器(DRAM)、其他类型的随机存取存储器(RAM)、只读存储器(ROM)、电可擦除可编程只读存储器(EEPROM)、快闪记忆体或其他内存技术、只读光盘只读存储器(CD-ROM)、数字多功能光盘(DVD)或其他光学存储、磁盒式磁带,磁带磁磁盘存储或其他磁性存储设备或任何其他非传输介质,可用于存储可以被计算设备访问的信息。
以上所述仅为本说明书的较佳实施例而已,并不用以限制本说明书,凡在本说明书的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本说明书保护的范围之内。
还需要说明的是,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、商品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、商品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、商品或者设备中还存在另外的相同要素。
Claims (10)
1.一种障碍物轨迹预测方法,其特征在于,包括:
获取障碍物的信息及所述障碍物预估运动的地图信息;所述障碍物的信息包括障碍物的历史位置信息;
根据所述历史位置信息,确定与所述障碍物实际运动方向相匹配的基础车道;
根据所述基础车道的车道线邻接关系及所述基础车道的车道线连接关系,在所述基础车道周围拓展多条候选车道;
根据多条所述候选车道,确定多个候选终点;
根据多个所述候选终点,采用多层感知机,确定多个所述候选终点的特征;根据所述地图信息提取地图特征,并根据所述障碍物的信息提取所述障碍物特征;
根据所述候选终点的特征、所述地图特征及所述障碍物特征,从多个所述候选终点中确定多个预定终点,多个所述预定终点相较于多个所述候选终点中的其余候选终点,成为预估运动轨迹的目标终点的可能性更高;
根据多个所述预定终点,确定所述障碍物的目标终点;其中,所述目标终点包括历史轨迹终点及未来达到终点;及,
根据所述目标终点,确定所述障碍物的从所述历史轨迹终点到所述未来达到终点的预估运动轨迹。
2.如权利要求1所述的轨迹预测方法,其特征在于,所述根据多条所述候选车道,确定多个所述候选终点,包括:
以预定间隔均匀地在每条所述候选车道上选择多个点,作为多个所述候选终点。
3.如权利要求2所述的轨迹预测方法,其特征在于,所述以预定间隔均匀地在每条所述候选车道上选择多个点,作为多个所述候选终点,包括:沿所述候选车道的车道线方向,以预定间隔均匀地在每条所述候选车道的车道中心线上选择多个点,作为多个所述候选终点;
和/或,
所述以预定间隔均匀地在每条所述候选车道上选择多个点,作为多个所述候选终点,包括:沿所述候选车道的车道线方向以及垂直于所述车道线方向的方向,以预定间隔均匀地在每条所述候选车道上选择多个点,作为多个所述候选终点。
4.如权利要求1所述的轨迹预测方法,其特征在于,所述障碍物的信息包括障碍物的历史轨迹信息;所述根据所述障碍物的信息提取所述障碍物特征,包括:根据所述历史轨迹信息,采用卷积神经网络,提取所述障碍物特征,所述障碍物运动的时间特征和空间特征;
和/或,
所述地图信息包括车道线信息、可行驶区域信息及语义信息;
所述根据所述地图信息提取地图特征,包括:根据所述车道线信息、所述可行驶区域信息及所述语义信息,采用图神经网络,提取所述地图特征。
5.如权利要求1所述的轨迹预测方法,其特征在于,所述从多个所述候选终点中确定多个预定终点,包括:逐个判断多个所述候选终点是否会成为所述目标终点;将可能成为目标终点的多个候选终点,确定为多个预定终点。
6.如权利要求1所述的轨迹预测方法,其特征在于,所述从多个所述候选终点中确定多个预定终点,包括:确定所有候选终点成为所述目标终点的概率,选择可能性最大的预定终点,作为所述目标终点。
7.如权利要求1所述的轨迹预测方法,其特征在于,所述根据多个所述预定终点,确定所述障碍物的目标终点,包括:使用深度神经网络,提取所述预定终点的特征;根据所述预定终点的特征所述地图特征及所述障碍物特征,优化所述预定终点,确定所述目标终点。
8.如权利要求1所述的轨迹预测方法,其特征在于,所述根据所述目标终点,确定所述障碍物的从所述历史轨迹终点到所述未来达到终点的预估运动轨迹,包括:根据所述目标终点,使用优化算法,确定预估运动轨迹,以使所述预估运动轨迹平滑且符合障碍物运动学特性;
和/或,
所述根据所述目标终点,确定所述障碍物的从所述历史轨迹终点到所述未来达到终点的预估运动轨迹,包括:根据所述目标终点,提取所述目标终点的特征;将所述目标终点的特征,所述地图特征及所述障碍物特征输入至深度神经网络,以输出所述障碍物的预估运动轨迹。
9.一种轨迹预测系统,其特征在于,包括一个或多个处理器,用于实现如权利要求1-8中任一项所述的轨迹预测方法。
10.一种计算机可读存储介质,其特征在于,其上存储有程序,该程序被处理器执行时,实现如权利要求1-8中任一项所述的轨迹预测方法。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111486385.3A CN115230688B (zh) | 2021-12-07 | 2021-12-07 | 障碍物轨迹预测方法、系统和计算机可读存储介质 |
PCT/CN2022/071090 WO2023103142A1 (zh) | 2021-12-07 | 2022-01-10 | 障碍物轨迹预测的方法、系统和计算机可读存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111486385.3A CN115230688B (zh) | 2021-12-07 | 2021-12-07 | 障碍物轨迹预测方法、系统和计算机可读存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115230688A CN115230688A (zh) | 2022-10-25 |
CN115230688B true CN115230688B (zh) | 2023-08-25 |
Family
ID=83666014
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111486385.3A Active CN115230688B (zh) | 2021-12-07 | 2021-12-07 | 障碍物轨迹预测方法、系统和计算机可读存储介质 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN115230688B (zh) |
WO (1) | WO2023103142A1 (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115790606B (zh) * | 2023-01-09 | 2023-06-27 | 深圳鹏行智能研究有限公司 | 轨迹预测方法、装置、机器人及存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110389581A (zh) * | 2018-04-17 | 2019-10-29 | 百度(美国)有限责任公司 | 用于为自动驾驶车辆生成障碍物的预测轨迹的方法 |
CN112241166A (zh) * | 2019-07-01 | 2021-01-19 | 百度(美国)有限责任公司 | 利用车道汇总的用于自动驾驶期间的移动对象的车道选择预测的神经网络 |
US10928820B1 (en) * | 2019-11-12 | 2021-02-23 | Baidu Usa Llc | Confidence levels along the same predicted trajectory of an obstacle |
CN112839855A (zh) * | 2020-12-31 | 2021-05-25 | 华为技术有限公司 | 一种轨迹预测方法与装置 |
CN113335276A (zh) * | 2021-07-20 | 2021-09-03 | 中国第一汽车股份有限公司 | 障碍物的轨迹预测方法、装置、电子设备及存储介质 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6558393B2 (ja) * | 2017-04-06 | 2019-08-14 | トヨタ自動車株式会社 | 進路設定装置及び進路設定方法 |
US10996679B2 (en) * | 2018-04-17 | 2021-05-04 | Baidu Usa Llc | Method to evaluate trajectory candidates for autonomous driving vehicles (ADVs) |
CN109855641B (zh) * | 2019-02-20 | 2021-06-11 | 百度在线网络技术(北京)有限公司 | 预测运动轨迹的方法、装置、存储介质和终端设备 |
CN111523643B (zh) * | 2020-04-10 | 2024-01-05 | 商汤集团有限公司 | 轨迹预测方法、装置、设备及存储介质 |
CN113568416B (zh) * | 2021-09-26 | 2021-12-24 | 智道网联科技(北京)有限公司 | 无人车轨迹规划方法、装置和计算机可读存储介质 |
-
2021
- 2021-12-07 CN CN202111486385.3A patent/CN115230688B/zh active Active
-
2022
- 2022-01-10 WO PCT/CN2022/071090 patent/WO2023103142A1/zh unknown
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110389581A (zh) * | 2018-04-17 | 2019-10-29 | 百度(美国)有限责任公司 | 用于为自动驾驶车辆生成障碍物的预测轨迹的方法 |
CN112241166A (zh) * | 2019-07-01 | 2021-01-19 | 百度(美国)有限责任公司 | 利用车道汇总的用于自动驾驶期间的移动对象的车道选择预测的神经网络 |
US10928820B1 (en) * | 2019-11-12 | 2021-02-23 | Baidu Usa Llc | Confidence levels along the same predicted trajectory of an obstacle |
CN112839855A (zh) * | 2020-12-31 | 2021-05-25 | 华为技术有限公司 | 一种轨迹预测方法与装置 |
CN113335276A (zh) * | 2021-07-20 | 2021-09-03 | 中国第一汽车股份有限公司 | 障碍物的轨迹预测方法、装置、电子设备及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
WO2023103142A1 (zh) | 2023-06-15 |
CN115230688A (zh) | 2022-10-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111857160B (zh) | 一种无人车路径规划方法和装置 | |
US11126187B2 (en) | Systems and methods for controlling the operation of a vehicle | |
US11554785B2 (en) | Driving scenario machine learning network and driving environment simulation | |
CN110081894B (zh) | 一种基于道路结构权值融合的无人车轨迹实时规划方法 | |
US10775801B2 (en) | Determining speeds along a path for autonomous driving vehicles | |
US10802492B2 (en) | Vehicle path identification | |
CN112212874B (zh) | 车辆轨迹预测方法、装置、电子设备及计算机可读介质 | |
Brubaker et al. | Lost! leveraging the crowd for probabilistic visual self-localization | |
CN112444263B (zh) | 全局路径规划方法及装置 | |
CN111552284A (zh) | 无人驾驶车辆的局部路径规划方法、装置、设备及介质 | |
US11834077B2 (en) | Systems, methods, and media for occlusion-aware motion planning | |
CN114005280A (zh) | 一种基于不确定性估计的车辆轨迹预测方法 | |
US20220153296A1 (en) | Trajectory planning with obstacle avoidance for autonomous driving vehicles | |
RU2757234C2 (ru) | Способ и система для вычисления данных для управления работой беспилотного автомобиля | |
WO2023097874A1 (zh) | 用于行驶轨迹规划的方法和装置 | |
KR20210118995A (ko) | 딥러닝 기반 자율주행차량의 유턴 경로 생성 방법 및 장치 | |
CN113984080A (zh) | 一种适用于大型复杂场景下的分层局部路径规划方法 | |
CN118235180A (zh) | 预测可行驶车道的方法和装置 | |
KR20200063039A (ko) | 자율주행을 위한 이중 경로 계획 및 도로 판단 영역 결정 장치 및 그 방법 | |
CN115230688B (zh) | 障碍物轨迹预测方法、系统和计算机可读存储介质 | |
CN116513171A (zh) | 一种基于车道信息的自动驾驶碰撞风险检测方法、系统及介质 | |
US10043130B2 (en) | Method and apparatus for ascertaining at least one exit probability from a land area identifiable in a digital map as open terrain | |
CN116653963B (zh) | 车辆变道控制方法、系统和智能驾驶域控制器 | |
CN115892076A (zh) | 车道障碍物筛选方法、装置和域控制器 | |
CN115246416B (zh) | 轨迹预测方法、装置、设备及计算机可读存储介质 |
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 |