路径规划方法及计算机可读介质

文档序号:190981 发布日期:2021-11-02 浏览:21次 >En<

阅读说明:本技术 路径规划方法及计算机可读介质 (Path planning method and computer readable medium ) 是由 蔡孟庭 孙晓 于 2021-03-11 设计创作,主要内容包括:一种路径规划的示例方法,包括以下中的至少一者:确定初始位置和至少一个车辆约束条件;预先确定到新位置的距离;基于至少一个车辆约束条件确定最小转弯半径;选择至少与最小转弯半径一样大的车辆转弯半径;基于至少一个车辆约束条件和车辆转弯半径来确定候选位置;验证候选位置相对于新位置是否有效;以及将新位置转换为候选位置。(An example method of path planning, comprising at least one of: determining an initial position and at least one vehicle constraint; predetermining a distance to the new location; determining a minimum turning radius based on at least one vehicle constraint; selecting a vehicle turning radius at least as large as the minimum turning radius; determining a candidate location based on at least one vehicle constraint and a vehicle turning radius; verifying whether the candidate location is valid with respect to the new location; and converting the new location to a candidate location.)

路径规划方法及计算机可读介质

技术领域

本公开涉及人工神经网络,并且具体地,涉及提供具有物理约束条件的、在三维上融合 的广度优先搜索、深度优先搜索以及快速探索随机树搜索。

背景技术

当前,基于快速探索随机树(RRT)的搜索会随机生成新状态,并且如果新状态与树上 最接近的状态之间的转换是有效的,则扩展树。这是一种低效的搜索方法。在解决方案的及 时性很重要的情况下,寻求一种更有效的解决方案。本公开描述了一种融合了广度优先搜索 (BFS)、深度优先搜索(DFS)和快速探索随机树(RRT)搜索的方法。与当前随机地生成 新状态的方法相反,所描述的方法从具有有利状态的生长的树中随机选择状态,并基于车辆 的物理约束条件(constraint)来扩展树。该方法可提供一种解决方案,以加快产生从一个点 到另一个点的路线。

发明内容

一种路径规划的示例方法,包括:确定初始位置和至少一个车辆约束条件;预先确定到 新位置的距离;基于至少一个车辆约束条件来确定最小转弯半径;选择至少与最小转弯半径 一样大的车辆转弯半径;基于至少一个车辆约束条件和车辆转弯半径来确定候选位置;验证 候选位置相对于新位置是否有效;以及将新位置转换为候选位置。

一种示例的非暂时性计算机可读介质,包括指令,当指令被处理器执行时,使得处理器 执行:确定初始位置和至少一个车辆约束条件;预先确定到新位置的距离;基于至少一个车 辆约束条件确定最小转弯半径;选择至少与最小转弯半径一样大的车辆转弯半径;基于至少 一个车辆约束条件和车辆转弯半径来确定候选位置;验证候选位置相对于新位置是否有效; 以及将新位置转换为候选位置。

附图说明

在附图中:

图1是根据本公开的一个实施例的第一示例系统;

图2是根据本公开的一个实施例的第二示例系统;

图3是根据本公开的一个实施例的示例概览;以及

图4是根据本公开的一个实施例的示例方法。

具体实施方式

以下列出的实施例仅是为了说明对本设备和方法的应用而进行的撰写,并不限制范围。 对这种设备和方法的等同的修改形式应归入权利要求的范围内。

在整个以下描述和权利要求书中,使用某些术语来指代特定系统部件。如本领域技术人 员将领会的,不同的团体可用不同的名称来指代部件和/或方法。本文档不意在区分名称不同 但功能相同的组件和/或方法。

在以下论述和权利要求书中,术语“包括”和“包含”以开放式方式使用,因此可被解 释为表示“包括但不限于……”。此外,术语“耦合”或“耦接”意在表示间接或直接连接。因此,如果第一装置连接到第二装置,则该连接可以是直接连接或经由其他装置和连接的间 接连接。

图1描绘了示例混合计算系统100,该混合计算系统100可用于实现与过程600的一个 或多个部分或步骤的操作相关联的神经网络。在该示例中,与混合系统相关联的处理器包括 现场可编程门阵列(FPGA)122、图形处理器单元(GPU)120和中央处理器(CPU)118。

CPU 118、GPU 120和FPGA 122具有提供神经网络的能力。CPU是可执行许多不同功能的通用处理器,CPU的通用性导致了用以执行多种不同任务的能力。然而,CPU对多个数据流的处理受到限制,并且CPU相对于神经网络的功能受到限制。GPU是图形处理器,具 有能够按顺序处理并行任务的许多小型处理核心。FPGA是一种现场可编程装置,FPGA具有 被重新配置并且以硬连线电路的方式执行可被编程到CPU或GPU中的任意功能的能力。由 于以电路形式对FPGA进行编程,因此其速度比CPU快许多倍,并且明显快于GPU。

系统还可包含其他类型的处理器,诸如加速处理单元(APU)和数字信号处理器(DSP), APU包括具有片上GPU元件的CPU,DSP被设计为用于执行高速数字数据处理。专用集成 电路(ASIC)也可执行FPGA的硬连线功能。然而,用以设计和生产ASIC的前置时间(leadtime)大约为一年的若干个季度,而不是在对FPGA进行编程中可用的快速周转实施时间。

连接有图形处理器单元120、中央处理器118和现场可编程门阵列122,并且图形处理器 单元120、中央处理器118和现场可编程门阵列122连接到存储器接口和控制器112。FPGA 通过连接至PLC到存储器互连130的可编程逻辑电路连接到存储器接口。利用该额外的装置 是因为FPGA在非常大的带宽下运行并且为了使FPGA用以执行存储任务所利用的电路最小 化。存储器接口和控制器112另外地连接到永久性存储器盘110、系统存储器114和只读存 储器(ROM)116。

图1的系统可用于对FPGA进行编程和训练。GPU与非结构化数据一起很好地运行,并 且可用于训练,一旦训练了数据,就可找到确定性的推理模型,并且CPU可利用由GPU确定的模型数据对FPGA进行编程。

存储器接口和控制器连接到中央互连124,中央互连另外连接到GPU 120、CPU 118和 FPGA 122。中央互连124另外连接到输入和输出接口128和网络接口126。

图2描绘了第二示例混合计算系统200,该混合计算系统200可用于实现与过程600的 一个或多个部分或步骤的操作相关的神经网络。在该示例中,与混合系统相关的处理器包括 现场可编程门阵列(FPGA)210和中央处理器(CPU)220。

FPGA电连接到FPGA控制器212,FPGA控制器212与直接存储器存取(DMA)218相 连接。DMA连接到输入缓冲器214和输出缓冲器216,输入缓冲器214和输出缓冲器216耦 合到FPGA以分别将数据缓冲到FPGA中以及将数据从FPGA缓冲出。DMA 218包括两个先 进先出(FIFO)缓冲器,一个用于主CPU,另一个用于FPGA。DMA允许数据被写入适当 的缓冲器以及从适当的缓冲器读取数据。

在DMA的CPU侧的是主开关228,主开关228将数据和命令往返传送到DMA。DMA 还连接到SDRAM控制器224,该SDRAM控制器224允许将数据从CPU 220传送到FPGA 并且允许数据从FPGA传送到CPU 220。SDRAM控制器还连接到外部SDRAM 226和CPU 220。主开关228连接到外围设备接口230。闪存控制器222控制持久性存储器,并连接到 CPU 220。

相比先前的方法,所提出的方法可以以更快和更有效的方式提供结果,部分是因为不是 随机生成新状态并且不是包括无效状态的选择,而是从已知有效状态的生长的树中选择状态。 所描述的方法是灵活的,并且可根据车辆的运动学约束条件进行配置。该方法利用车辆的配 置来生长仅具有有效状态的树。所描述的方法高效,且快至足以由车辆内的处理器来执行, 因为该方法考虑了汽车的动力学约束条件。路径输出仅从有效状态中选择,并且可由车辆内 的处理器来执行。

与随机地扩展树的传统的RRT搜索方法不同,所公开的方法利用BFS-DFS混合方法来 扩展树。从生长的树中随机选择状态,并且通过该状态,基于车辆约束条件来确定新状态。

由于该方法生成新的有效状态,因此该类似于BFS的功能帮助RRT以更有效的方式进 行探索。

目标状态可用作新生成的状态,并且可确定新状态与树中的最接近状态之间的转换是否 有效。如果状态有效,则树将从该状态扩展到目标状态,这意味着找到了路径。

可从生长的树中选择一种状态,并确定该状态与目标状态之间的转换是否有效。如果状 态有效,则可将树从该状态扩展到目标状态,表明已找到路径。

如果预先确定了可能的路线,则可将其用作对RRT搜索的引导。以此方式,扩展树是从 用作新状态的路径点随机选择的状态。如果新状态与树中的最接近状态之间的转换有效,则 偏差在引导方向上扩展树。

对示例方法的描述可包括:从生长的树中随机选择一个状态,在该状态中,该随机选择 具有有利于更深的状态(即,远离起始状态的状态)的偏差。以此方式,更深的状态具有更 高的选择概率。利用该类似于DFS的功能,该方法着重于将树扩展到未知区域,而不是反复 探索接近起始状态的区域。

在从基于车辆约束条件所选择的状态中确定新状态的一个示例方法中,该方法确定在包 括(x,y,姿势)的三维(3D)状态中规划的路径。给定汽车动力学约束条件,诸如加速度、 速度和转弯半径,可确定新状态。在该路径规划的示例方法中,路径从初始状态开始。3D状 态包括位置(x,y)和航向(z)。为了确定新状态,在图3的新状态(分别为图3的车辆314的新状态316、车辆318的新状态320和车辆322的新状态324)与图3的车辆310的初 始状态之间选择预定距离,车辆310的初始状态由图3的虚线圆圈312来表示。如果假设车 辆以最大速度v行驶,则可确定车辆的最小转弯半径。当知道了最小转弯半径r时,将设定 从r到无穷大的有效转弯半径。给定对有效转弯半径的该设定,可在r与无穷大之间进行随 机选择,这用于确定图3的伪随机选择316、320和324之间的截距。

伪随机选择的相交由图3中的圆圈316、320和324给出,并且图3的虚线圆圈312可用 于确定新状态(x’,y’,z’),并高度确信该状态是汽车要执行的有效状态。

如果没有有效的新状态,则该示例方法将利用车辆加速度约束条件来减速并计算新的速 度v’,并再次重复该方法,因为越慢的速度对应于越小的转弯半径。因此,一旦被提供了车 辆参数,诸如最大速度、加速度极限以及当前行驶速度和最小转弯半径的函数等,该方法将 产生有效的新状态。

该方法结合了BFS、DFS和RRT搜索的优点。该方法利用类似RRT的功能朝着随机方向探索,利用类似BFS的功能扩展探索区域,并利用类似DFS的功能深入未知区域。通过将空间探索方法融合,发现了以有效方式输出正确结果的新方法。

图4描绘了一种示例性方法,该方法包括:确定410初始位置和至少一个车辆约束条件; 预先确定412到新位置的距离;以及基于至少一个车辆约束条件来确定414最小转弯半径。 该方法还包括:选择416至少与最小转弯半径一样大的车辆转弯半径;基于至少一个车辆约 束条件和车辆转弯半径来确定418候选位置;验证420该候选位置相对于新位置是否有效; 以及将新位置转换422为候选位置。

该方法还可包括:如果新位置未被验证为有效,则减少至少一个车辆约束条件。该至少 一个车辆约束条件可以是车辆速度,并且其中最小转弯半径基于车辆速度,并且至少一个车 辆约束条件包括最大速度和加速度极限中的至少一者。对车辆转弯半径的选择可以是伪随机 的,并且将车辆转弯半径选择为朝着较大的转弯半径加权。

该方法还可包括:如果候选位置无效,则减小车辆加速度以减小车辆速度;基于减小后 的车辆速度来确定新的候选位置;验证新的候选位置相对于该新位置是否有效;以及将新位 置转换为新的候选位置。

示例非暂时性计算机可读介质包括指令,该指令在由处理器读取时使处理器执行:确定 初始位置和至少一个车辆约束条件;预先确定到新位置的距离;以及基于至少一个车辆约束 条件来确定最小转弯半径。处理器还执行:选择至少与最小转弯半径一样大的车辆转弯半径; 基于至少一个车辆约束条件和车辆转弯半径来确定候选位置;验证该候选位置相对于新位置 是否有效;以及将新位置转换为候选位置。

如果新位置未被验证为有效,则处理器还减少至少一个车辆约束条件。该至少一个车辆 约束条件可以是车辆速度,并且其中最小转弯半径基于车辆速度,并且至少一个车辆约束条 件包括最大速度和加速度极限中的至少一者。对车辆转弯半径的选择可以是伪随机的,并且 将车辆转弯半径的选择朝着较大的转弯半径加权。

如果候选位置无效,则处理器还减小车辆加速度以减小车辆速度、基于减小后的车辆速 度确定新的候选位置、验证新的候选位置相对于该新位置是否有效以及将新位置转换为新的 候选位置。

本领域技术人员将领会的是,本文所描述的各种说明性块、模块、元件、部件、方法和 算法可被实现为电子硬件、计算机软件或两者的组合。为了说明硬件和软件的这种可互换性, 以上已经根据其功能大体上描述了各种说明性的块、模块、元件、组件、方法和算法。将这 样的功能实现为硬件还是软件取决于具体的应用和施加在整个系统上的设计约束条件。技术 人员可针对每个具体的应用以不同方式来实现所描述的功能。在均不背离本主题技术的范围 的情况下,各种部件和块可被不同地布置(例如,以不同的顺序布置或以不同的方式划分)。

应当理解的是,所公开的过程中步骤的特定顺序或层级是对示例方法的说明。基于设计 偏好,应当理解的是,可重新排列过程中步骤的特定顺序或层级。一些步骤可被同时执行。 随附的方法权利要求以示例顺序呈现了各个步骤的要素,并不意味着受限于所呈现的特定顺 序或层级。

提供先前的描述以使得本领域的任意技术人员能够实践本文所描述的各个方面。先前的 描述提供了本主题技术的各种示例,并且本主题技术不限于这些示例。对这些方面的各种修 改对于本领域技术人员而言将是显而易见的,并且本文中定义的一般原理可应用于其他方面。 因此,不意在将权利要求受限于本文中所示出的各方面,而是意在使全部范围与权利要求的 语言表述相一致,其中以单数形式提及元素并不意在表示“一个且仅一个”,除非明确如此 阐明,否则而是表示“一个或多个”。除非另有明确阐明,否则术语“一些”是指一个或多 个。男性代词(例如,他的)包括女性和中性性别(例如,她及它),反之亦然。标题和副 标题,如果有的话,仅是为了方便起见,并不限制本发明。谓语词“被配置以”、“可操作 以”和“被编程以”并不意味着对对象进行任意具体的有形或无形修改,而是意在将其互换 使用。例如,被配置以监测和控制操作或部件的处理器也可意味着处理器被编程以监测和控 制操作或处理器可被操作以以监测和控制操作。同样地,被配置以执行代码的处理器可被解 释为被编程以执行代码或可被操作以执行代码的处理器。

诸如“方面”的短语并不意味着这样的方面对于本主题技术是必不可少的,也不意味着 这样的方面适用于本主题技术的所有配置。与一个方面有关的公开内容可应用于所有配置, 或者一个或多个配置。一个方面可提供一个或多个示例。诸如方面的短语可指一个或多个方 面,反之亦然。诸如“实施例”的短语并不意味着这样的实施例对于本主题技术是必不可少 的,也不意味着这样的实施例适用于本主题技术的所有配置。与一个实施例有关的公开内容 可适用于所有实施例,或者一个或多个实施例。实施例可提供一个或多个示例。诸如“实施 例”的短语可指一个或多个实施例,反之亦然。诸如“配置”的短语并不意味着这样的配置 对于本主题技术是必不可少的,也不意味着这样的配置适用于本主题技术的所有配置。与一 个配置有关的公开内容可适用于所有配置,或者一个或多个配置。一种配置可提供一个或多 个示例。诸如“配置”的短语可指一个或多个配置,反之亦然。

词语“示例”在本文中用来表示“用作示例或说明”。本文中被描述为“示例”的任意方面或设计不必然被解释为比其他方面或设计更优选或更有利。

对于本领域普通技术人员而言是已知或以后将知道的是,在整个本公开中所描述的各个 方面的元件的所有结构和功能等同物均通过引用明确地并入本文,并且意在被权利要求书所 涵盖。此外,无论在权利要求书中是否明确叙述了这样的公开内容,都不意在将其捐献于公 众。除非使用短语“用于……的手段”明确叙述该要素,或者在方法权利要求的情况下,使 用短语“用于……的步骤”来叙述该元素,否则任何权利要求的要素均不得根据美国专利法 35U.S.C.、§112、第六段的规定进行解释。此外,针对说明书或权利要求书中使用术语“包 括(include)”、“具有(have)”等的程度,这样的术语旨在被包括在术语“包含”的方 式内,类似于当“包括”在权利要求中被用作连接词时,对“包括”的解释那样。

对“一个实施例”、“一实施例”、“一些实施例”、“各种实施例”等的引用指示具 体的要素或特征被包括在本发明的至少一个实施例中。虽然这些短语可出现在各个地方,但是这些短语不一定指的是同一实施例。结合本公开,本领域技术人员将能够设计和结合适用 于实现上述功能的各种机构中的任意一者。

应当理解的是,本公开仅教导了说明性实施例的一个示例,并且本领域技术人员在阅读 了本公开之后可容易地设计出本发明的许多变型,并且本发明的范围将由以下权利要求所确 定。

12页详细技术资料下载
上一篇:一种医用注射器针头装配设备
下一篇:用于车辆建模的系统和方法

网友询问留言

已有0条留言

还没有人留言评论。精彩留言会获得点赞!

精彩留言,会给你点赞!

技术分类