EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法

0 摘要

基于梯度的规划器广泛用于四旋翼的局部路径规划,其中欧几里德距离场 (ESDF) 对于评估梯度大小和方向至关重要。然而,计算这样一个字段有很多冗余,因为轨迹优化过程只覆盖了 ESDF 更新范围的非常有限的子空间。在本文中,提出了一种基于无 ESDF 梯度的规划框架,显著减少了计算时间。主要改进是惩罚函数中的碰撞项是通过将碰撞轨迹与无碰撞引导路径进行比较来制定的。只有当轨迹碰到新的障碍物时,才会存储生成的障碍物信息,使规划器只提取必要的障碍物信息。然后,如果违反动态可行性,我们会延长时间分配引入各向异性曲线拟合算法,在保持原始形状的同时调整轨迹的高阶导数

1 概览

1.1 传统方法

  • 传统方法一般是采用基于梯度的规划器,但是会依靠预先构建的 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 图来评估梯度的大小和方向,并使用数值优化来生成局部最优解。但是,就是构建 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 图很困难,EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 计算占用了执行本地规划的总时间的EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,所以说,构建 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 成为了基于梯度的规划器的瓶颈。

1.2 如何构建 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法

  • 方法可以分为增量式的全部更新,以及批量的局部计算,然而这两种方法都没有关注轨迹本身。因此,过多的计算花费在计算对规划没有贡献的 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 值上。换句话说,当前基于 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的方法不能单独和直接地为轨迹优化服务。如下图所示,对于一般的自主导航场景,期望无人机在本地避免碰撞,轨迹仅覆盖 ESDF 更新范围的有限空间。在实践中,虽然一些手工规则可以决定一个很小的 ESDF 范围,但它们缺乏理论上的合理性,并且仍然会导致不必要的计算

在这里插入图片描述

  • 如图,优化过程中的轨迹只覆盖了 ESDF 更新范围的非常有限的空间

  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 更新的空间就是被粉色墙面包围的空间

  • 但是轨迹优化期间覆盖的空间(如上图紫色的部分)

  • 所以轨迹仅覆盖 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 更新范围的有限空间,在实践中,虽然一些手工规则可以决定一个很小的 ESDF 范围,但它们缺乏理论上的合理性,并且仍然会导致不必要的计算

1.3 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 介绍

  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 是一个无 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的基于梯度的局部路径规划框架
  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 由基于梯度的样条优化器和后细化程序组成

1.3.1 方法步骤

  • 首先使用平滑度,碰撞以及动态可行性优化轨迹
  • 与预先计算的 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的传统方法不同,通过将障碍物内的轨迹与引导的无碰撞轨迹进行比较对比,来对碰撞成本进行建模
  • 之后将力投射到碰撞轨迹上并生成估计的梯度以将轨迹包裹在障碍物之外
  • 在优化过程中,轨迹会在附近的障碍物之间反弹几次最终终止于安全区域
  • 这样,我们只在必要时计算梯度,避免在与局部轨迹无关的区域计算EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
  • 如果生成的轨迹违反动态限制,这通常是由不合理的时间分配引起的,则激活细化过程
  • 在细化期间,当超出限制时重新分配轨迹时间。随着时间分配的扩大,生成了一种新的EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法样条,它在平衡可行性和拟合精度的同时,拟合了之前的动态不可行
  • 为了提高鲁棒性,拟合精度采用各向异性建模,在轴向和径向上有不同的惩罚

2 相关工作

2.1 基于梯度的运动规划

  • 基于梯度的运动规划是无人机局部轨迹生成的主流,这是一种无约束的非线性优化
  • 许多框架利用其丰富的梯度信息,直接优化配置空间的轨迹
  • 还有一种连续时间多项式的轨迹优化方法,但是,势函数积分导致了很大的计算代价
  • 还有就是老朋友 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法的参数化,利用其凸包特性
  • 通过寻找无碰撞路径(通常可由采样的路径规划找出,比如EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法),将无碰撞的初始路径作为前端,成功率显著提高
  • 当初始无碰撞路径的生成考虑动力学约束的同时,性能会进一步提高
  • 结合感知意识,鲁棒性提升明显
  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 在评估与附近障碍物的梯度大小和方向的距离方面起着至关重要的作用

2.2 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法

  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 长期以来一直被用于从嘈杂的传感器数据构建对象,有学者提出了一种包络算法,将 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 构造的时间复杂度降低到 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法;其中 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 表示为体素数。该算法不适用于 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的增量构建,而四旋翼飞行过程中经常需要动态更新场。为了解决这个问题,EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 提出了增量 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 生成方法,即 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法。尽管这些方法在动态更新情况下非常有效,但生成的 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 几乎总是包含可能根本不会在规划过程中使用的冗余信息。如上图所示,该轨迹仅扫过整个 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 更新范围的非常有限的子空间。因此,设计一种更智能、更轻量级的方法,而不是维护整个领域是有价值的。

2.3 碰撞避免

  • 决策变量是 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 样条曲线的控制点 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法。每个 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 都独立地拥有自己的环境信息。一开始,生成了一条满足约束但是不考虑障碍物的 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 样条曲线 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,接下来,对于在迭代中检测到的每个碰撞段,用一些算法(比如A*,RRT*等全局规划算法)生成一条无碰撞路径EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法。对于发生碰撞的线段的每个控制点EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,都会生成一个在障碍物表面的定位点EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,且对应一个排斥方向向量EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法与向量EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法同向,这里不应该是相等,因为这个EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法只是一个单位方向向量,看下方图中的红色虚线与实线即可。每一对EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法都对应一个特定的控制点EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,这点也能从图中看出来,如下图所示。

在这里插入图片描述

  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 表示控制点的索引, EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 表示 { EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法} 对的索引。请注意,每个 { EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法} 对只属于一个特定的控制点。为简洁起见,省略了下标 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 而不会引起歧义。则从 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 到第 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 个障碍物的障碍物距离定义为
  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法是怎么生成的?
  • 穿过障碍物的轨迹 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 为控制点 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 生成几个 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 是障碍物表面上的点(前面说了EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法是由控制点EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法生成的),EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 是从控制点EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法指向 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的单位向量)
  • 垂直于切向量 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法这个切向量,仔细看,就是之前用 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 生成的那条的不考虑碰撞的曲线的切线)的平面 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法是那一条无碰撞路径)相交,形成一条线 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,从中确定 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 对。 距离场定义 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的切片可视化。颜色表示距离,箭头是等于 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的相同梯度。 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 在平面上(障碍物表面上的点,如图 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 )。
    在这里插入图片描述

2.3.1 算法1:EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法

在这里插入图片描述

伪代码解析:

  1. EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 找到与控制点 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 发生碰撞的障碍物,并判断其是否存在
  2. EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法提取出与控制点 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 发生碰撞的障碍物
  3. EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法将障碍物添加入障碍物集合 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
  4. EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法针对障碍物生成一个无碰撞的路径
  5. EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法就是根据控制点与无碰撞路径确定匹配的EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 到第 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 个障碍物的距离如下,需要注意单位向量 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 在第一次生成后就不会再次发生改变,所以 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的值是分正负的,EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
  • 通过以上的那个公式,我们就可以利用其来判断这个控制点 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
  • 因为之前说了,在老障碍物当中 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 与向量 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 同向,那么向量 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 就是 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,是这个与 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 同向,而 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 肯定就是与 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 反向了,如果不是新发现的障碍物,那么 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 算出来肯定是 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法两者反向),而对于新发现的障碍物,肯定就是 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,算出来为 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法

综上,为了防止轨迹被拉出当前障碍物前,为了避免在前几次迭代过程中轨迹从当前障碍物逃逸之前产生重复的 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 对,迭代过程中反复生成 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 对,判断是否为新障碍物的标准是:如果控制点EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 处于障碍物中时,并且对于当前得到的所有障碍物 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 满足 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 ,则该障碍物为新发现的障碍物,从而只计算影响轨迹的障碍物信息,减少运行时间。

2.3.2 碰撞力估计小结

为了将必要的*环境意识融入当地的规划中,需要明确地构建一个目标函数(设计基于梯度的轨迹优化器),使轨道远离障碍。EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 提供了这种至关重要的碰撞信息,但代价是沉重的计算负担。此外,如图 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 所示,由于 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 反馈的错误信息不足,基于 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的规划者很容易陷入局部最小值,无法逃脱障碍。为了避免这种情况,额外的前端总是需要提供一个无碰撞的初始轨迹。由于明确设计的斥力对于不同的任务和环境都是相当有效的,所以上述方法在提供避免碰撞的重要信息方面优于 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法

在这里插入图片描述

3 基于梯度的轨迹优化器

3.1 建模

  • 本文使用均匀 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 样条曲线 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 来表示轨迹,其阶数为 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,均匀 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 样条曲线的每个节点有相同的时间间隔 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,每个节点与其父节点之间的时间间隔相同,为:EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 样条曲线的第一个性质也即凸包性质表明,某段曲线只与 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 个连续的控制点(EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法)有关,并且曲线被包含在这些点构成的凸包内,例如 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 样条的 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 内的跨度位于由 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 形成的凸包内
  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 样条曲线的第二个性质表面,EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 样条曲线的 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 阶导数仍然是 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 样条曲线,由于时间间隔 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 是相同的,轨迹 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的一阶(EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法)、二阶(EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法)、三阶(EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法)导数的控制点分别为:EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
  • 其实大体上的框架还是 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法的框架,EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法还是牛的哇
  • 再根据 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的微分平坦特性,需要降低要规划的变量,优化问题被重新定义为:EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法

微分平坦特性,在做轨迹规划的过程中不可能对 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 维的全维度空间进行规划,这是非常复杂的,但可以找到一个平坦输出的空间,这个空间只有四个维度的变量,位置EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法和偏航角 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法剩下所有的状态都能用这四个变量和其有限阶导数的代数组合所表示,因此在做无人机轨迹规划的时候只需要对这四个变量进行规划就可以了。

  • 是不是很熟悉?这其实就是在贝塞尔曲线那里的三个惩罚项函数
  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法光滑项惩罚,EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法碰撞项惩罚,EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法动力学可行项惩罚, EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法惩罚项的权值

3.1.1 光滑项惩罚

  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 轨迹优化当中被提出,可以看看我之前的 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 ,有提到过。光滑性惩罚被公式化为轨迹参数(加速度、加加速度等)的平方导数上的时间积分。由于 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 样条曲线的凸包性质,只要最小化轨迹 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的二阶和三阶控制点的平方和就能够有效地减小加速度和加加速度的平方和(类似 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 ,这东西真是经典,哪里都用到了),公式如下:EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法

3.1.2 碰撞项惩罚

  • 碰撞惩罚使控制点远离障碍物,这是通过采用安全间隙和惩罚控制点 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 来实现的。为了进一步优化,构造了一个二次连续可微惩罚函数,并随着 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的减小而抑制其斜率,从而得到分段函数:EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
    EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
  • 对所有控制点的惩罚求和得到总的碰撞项惩罚:EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
  • 相比于传统用三线性插值的方法求碰撞项的梯度,直接计算二次连续可微惩罚函数EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的导数来得到梯度:EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法

3.1.3 可行项惩罚

  • 通过限制轨迹在每一维上的高阶导数来保证其可行性。由于凸包的性质,对控制点的导数进行约束足以约束整个 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 样条。EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 为为每个维度(速度加速度EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法)的高阶导数构造的惩罚函数:EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
    EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
    EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法

可以看出问题建模中应用的惩罚函数全部是多项式和,这有利于降低求解最优化问题的复杂度。(轻量化算法)

3.2 最优化解法(数值优化)

  • 目标函数: EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 会随着新障碍物的加入而不断改变,这就要求求解器能够快速重启并求解,并且目标函数主要由二次项组成,所以 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法(黑塞矩阵)信息能够加快收敛速度。但得到精确的 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 消耗大量计算机资源。所以使用拟牛顿法( EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法) 从梯度信息中来近似计算 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
  • 在对比了EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法后发现,EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法表现最好,平衡了重启损失和逆EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 估计的准确性。EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 从以前的目标函数评估近似 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,但需要一系列的迭代,以达到一个相对准确的估计

4 时间重新分配以及轨迹进一步优化

  • 在优化之前进行准确的时间分配是不合理的,因为那时候还不知道关于最终轨迹的信息,所以,一个额外的时间重新分配程序对于确保动态可行性是至关重要的
  • 之前都是将轨迹参数化为非均匀 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 样条线,当某些线段超过导数限制时,迭代地加长节点跨度的子集
  • 但是,一个节点跨度 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 会影响多个控制点,从而导致在接近开始状态时调整节点跨度时上一个轨迹的高阶导数不连续
  • 所以从上节得到的安全轨迹 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 ,经过合理的时间重新分配,重新生成一条均匀的时间分配合理的 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 样条曲线 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,然后使用各向异性曲线拟合的方法(EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法)使 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 在保持形状与 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 几乎相同的导数形状的同时(因为 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 是安全轨迹,所以形状必须差不多相同),能够自由地优化其控制点,以满足高阶导数的约束

4.1 具体步骤

  • 首先像 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 所做的那样,计算极限超标率(超过限制的最大的比例,下标 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 表示限制的最大值):EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 表明相对于 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 来说,EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 需要分配多少时间
  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 分别是与 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的一次、二次、和三次成反比,通过与时间的反比关系可以降低速度及其导数
  • 得到了 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的新时间间隔为:EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
  • 通过求解一个如下的闭式的最小二乘问题,在速度及其导数的约束下初始生成时间跨度为 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的轨迹 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 ,同时保持与 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 相同的形状和控制点数,然后重新计算光滑项惩罚和可行性项惩罚得到新的目标函数:EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 是适应度(拟合)项的权重,EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 被定义为从 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 各向异性位移的积分(EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法),其中 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 为轨迹 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的持续时间
  • 由于拟合的曲线 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 已经是无碰撞的(刚刚说过了 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 是安全轨迹),所以对于两条曲线,用带有低权重的轴向位移 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法放宽光滑调整限制,用高权重的径向位移 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法防止碰撞,如下图所示,

在这里插入图片描述

  • 使用球状度量(好像在老师的某篇文章中也提到过,具体的我忘了)来使在同一球体表面的位移产生相同的惩罚。(关于径向位移和轴向位移应该在具体算法中了解,目前我认为轴向位移为该点的切线方向,而径向方向为该切线的垂线方向,两者计算公式如下:)
    EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法

  • 用于度量 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 惩罚大小的椭圆体是一个以 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 为中心的椭圆,其半长轴长度为 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法、其半短轴长度为 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法。则轴向位移 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 和径向位移 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 为:
    EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法

  • 则拟合项可以表示为:
    EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法

  • 其中 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 分别是椭圆的半长轴和半短轴,径向位移对应的半短轴 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 使径向位移的惩罚权重增大以防止防止碰撞

  • 上式拟合项被离散化为有限个数的点 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法

  • 其中,EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法

5 实验结果

5.1 算法框架

在这里插入图片描述

  • 代码解析
  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法生成一条满足终端约束但不考虑障碍物的 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 样条曲线 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 对应的控制点,对应初始化步骤
  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法判断控制点是否在环境中是无碰撞的,有碰撞时输出 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,无碰撞时输出 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法检测控制点所在障碍物,并添加障碍物信息(EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法对以及距离场)
  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法根据问题建模构造控制点相应惩罚项 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 以及对应的梯度(这个惩罚项就是那三个惩罚,光滑项惩罚,碰撞项惩罚,可行项惩罚)
  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法求解惩罚项的最小化问题,即最优化求解,从而得到满足惩罚项的最小化的控制点位置,即完成第一步的轨迹优化
  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法判断由控制点 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 决定的轨迹是否可行(主要是速度以及其多阶导数否超过限制最大值)
  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法通过重新分配由控制点 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 决定的轨迹的时间降低速度以及其多阶导数,使其满足各类速度约束
  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法将之前的惩罚中碰撞项替换为曲线拟合项,求解惩罚项最优化问题。使其在满足新时间间隔的前提下,拟合由旧控制点构成的轨迹得到新轨迹,在继承旧轨迹的无碰撞特性的前提下实现约束下可行性

5.2 实施详情

  • 设置B样条曲线的阶数 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,控制点的个数 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法个左右,具体由规划预期距离(大约EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法)和初始的邻近点间距(大约EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法)决定。这些参数根据经验通过平衡了问题的复杂度和自由度而得到

  • 因为根据 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 样条曲线的性质,一个控制点只影响周围的轨迹,所以算法的时间复杂度为 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法

  • EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的复杂性在相同的相对公差上也是线性的(EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法)

  • 在无碰撞路径搜索中,我们采用 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 星(EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法)算法进行轨迹优化,而它生成的轨迹 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 常常贴着障碍物。因此,我们可以直接在 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 星算法生成的轨迹EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 上选择定位点(EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 而不用搜索障碍物的表面(这里才真正解释出了一开始所说采用 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 星算法的作用)。对于图 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 中定义的向量EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,通过均匀 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 样条参数化的性质,可以推导出:
    EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法

  • 这里的EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法是下图中确定 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 对的关键

在这里插入图片描述

读到这里,我们再看看论文中的图EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
第一步:根据生成一条满足终端约束但不考虑障碍物的 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 样条曲线 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,依靠 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 星算法生成的轨迹 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
第二步:根据上述的 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 公式通过 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 样条曲线的控制点计算出向量 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,再做出垂直于 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 的平面 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,平面 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 与依靠 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 星算法生成的轨迹 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 相交于定位点(EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,连接对应的定位点(EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 与控制点 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,才得到直线 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法,而向量 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 是向量 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 对应的由起点控制点 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 到终点定位点 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 对应的单位向量。( EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 可能是生成以后不会再变化的)。到这里才生成了 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法
EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法关于 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 对过程中,为什么将定位点 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 定位到 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 星算法生成的贴着障碍物的轨迹上,而不直接定位在障碍物表面?
EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法首先 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 算法生成的轨迹肯定是安全无碰撞的轨迹,其次直接定位到障碍物表面的话,因为这是仿真,难免会产生误差,使得与现实世界所得结果不符,再者使用 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 算法生成的轨迹定位的算力比直接定位在障碍物表面的要,所以不管是为了留有稳定的裕量还是为了降低计算的算力,还是选择使用 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 算法进行定位。

在这里插入图片描述

6 总结

该方法仍然存在一些缺陷,即 EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法 算法搜索引入的局部最小值和统一时间重新分配引入的保守轨迹。因此,我们将致力于执行拓扑规划,以逃避局部最小值,并重新制定问题,以生成接近最优的轨迹。规划器为静态环境设计,无需处理缓慢移动的障碍物(低于EGO-Planner:一种无需 ESDF(欧几里得距离场) 梯度的局部路径规划方法)。在未来,我们将通过移动对象检测和拓扑规划来研究动态环境导航。

文章出处登录后可见!

已经登录?立即刷新

共计人评分,平均

到目前为止还没有投票!成为第一位评论此文章。

(0)
xiaoxingxing的头像xiaoxingxing管理团队
上一篇 2023年2月25日
下一篇 2023年2月25日

相关推荐