RRT* + Minimum Snap轨迹优化

RRT* + Minimum Snap 轨迹优化

1. 简介

  • 前端:路径生成采用RRT*算法,生成离散的路径点

  • 后端:轨迹优化采用minimum snap算法,构造QP问题,使用OSQP求解器求解

  • Github 代码: uav/motion-planning 期待你的🌟🌟🌟

2. 前端路径生成

(1) 算法:RRT*

  • 原理图
    在这里插入图片描述
  • 伪代码
    在这里插入图片描述

2. 后端轨迹优化

(1) 算法:Minimum Snap

  • 原理:根据RRT*获得的离散路径点构建二次规划QP问题,代码实现为minimum jerk
    在这里插入图片描述
  • 约束条件:
    • 初始条件与末端条件
    • 经过中间路径点
    • 中间路径点的位置、速度、加速度连续
  • 求解

​ 开源QP求解器OSQP,求解器原理基于ADMM,能够快速求解QP问题,具体实现见github:uav/motion-planning 期待你的🌟🌟🌟

  • 仿真效果

    • 红色路径:RRT*所得到的离散路径点
    • 紫色轨迹:经过优化后的minimum jerk轨迹
      在这里插入图片描述
  • 5
    点赞
  • 1
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
动态RRT* DWA(融合APF)是一种针对动态环境中路径规划问题的算法。该算法结合了动态窗口方法(Dynamic Window Approach,DWA)和可收敛的快速探索树算法(Rapidly-exploring Random Trees*,RRT*),同时利用了人工势场(Artificial Potential Field,APF)来引导路径搜索。 DWA是一种基于机器人动力学模型的运动规划算法,通过在机器人运动空间中生成一系列可能的速度动作,并根据预测结果评估每个动作的适应度,从而选择最佳动作。它的核心思想是通过动态窗口的方式限制机器人的速度和转向范围,以适应当前环境中的动态障碍物。 RRT*是一种高效的无模型路径搜索算法,通过随机采样并生成一系列路径来探索机器人工作空间。它使用一棵树结构来表示路径探索过程中的所有候选路径,并通过优化机制不断更新和改进当前的最佳路径。 为了更好地应对动态环境中的路径规划问题,动态RRT* DWA结合了DWA的速度规划和RRT*的路径搜索,并引入了APF的力场导航思想。APF可以通过将机器人与障碍物之间的引力和机器人之间的斥力相结合,为路径搜索提供额外的导引。动态RRT* DWA首先利用DWA生成一系列可能的动作,并通过APF计算每个动作的适应度。然后,RRT*将根据这些适应度值进行路径搜索,并使用APF的导引力场来引导搜索过程。 综上所述,动态RRT* DWA(融合APF)是一种综合利用DWA速度规划、RRT*路径搜索和APF力场导引的路径规划算法,通过动态窗口限制机器人运动范围、随机探索路径并引导路径搜索,以应对动态环境中的路径规划问题。
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值