
【5-4-2】全局路径探索&规划
文章平均质量分 91
本专栏会持续更新,结合本人在机器人、自动驾驶行业的研发经验,研究全局路径生成方法,不限于基于曲线拟合生成、基于定位录制生成、基于地图生成、基于图搜索类算法生成、基于采样生成急相关动态规划,探讨全局路径规划的原理和项目实践。
RoboticsTechLab
一枚爱琢磨、愿意深耕的研发攻城狮,现从事于机器人、自动驾驶行业,不定期分享机器人、自动驾驶及工作经验相关内容,感谢关注!
展开
-
机器人全局路线规划导读
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对全局路线规划导读做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容。原创 2024-04-25 08:45:52 · 966 阅读 · 0 评论 -
【到点导航避障】保证局部执行路径和障碍物保持一定的距离,避免绕障距离时近时远,实现贴边导航方案
2、方式二:修改astar的启发函数类型,不仅仅考虑导航点欧氏距离启发函数类型,还要考虑距离覆盖作业航线垂线距离启发函数类型【这个需要同时整定占据代价,目标点距离代价和偏离作业航线代价,参数是不好整定的】【兼容】若路径规划的起点或目标点在指数下降膨胀区范围内代价比较大的位置,二值化后有可能被占据,此时就要根据路径和障碍物保持的距离参数,动态调整路径规划的起点或目标点。1、方式一:根据设定的路径和障碍物保持的一定距离参数值,去设定地图的指数下降膨胀区大小。(3)保证不偏离作业航线(全局路径)的偏离代价函数。原创 2025-05-15 21:21:30 · 58 阅读 · 0 评论 -
【全局路径规划模块算法】全局路径探索的介绍
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对全局路径探索的介绍做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容(1)介绍:全局路径规划算法难度不算复杂,一般根据高精度地图、栅格地图或者其他感知结果,【防盗标记–盒子君hzj】从出发点到目标点之间的纯几何路径规划,无关时间序列,无关车辆动力学(位置速度加速度),得到一条可通行的路径。由于其只考虑了环境几何信息,往往忽略了无人机本身的运动学与动力学模型。原创 2023-07-08 15:12:00 · 669 阅读 · 0 评论 -
【全局路径规划模块录制算法】基于定位的全局航线的录制方法
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对**【全局路径规划】基于定位的全局航线的录制方法**做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容。原创 2023-07-08 15:15:08 · 350 阅读 · 0 评论 -
【全局路径规划模块曲线算法】Dubins与Reeds-Shepp曲线拟合(附C++代码)
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对**【全局路径规划】曲线拟合的方法**做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容/*** @brief 依据始点、末点位置和最小转弯半径生成一条Dubin路径* 原理:输入dubins曲线的起点和目标点,计算好弧线的半径。其次是循环调用dubins曲线的六种类型的实现,看看哪种实现的结果最好,代价最低就原则该种类型的曲线实现。原创 2023-07-08 15:18:52 · 1139 阅读 · 0 评论 -
【全局路径规划模块图搜索算法】图搜索基础知识介绍&图搜索基础算法举例
系列文章目录提示:这里可以添加系列文章的所有文章的目录,目录需要自己手动添加TODO:写完再整理文章目录系列文章目录前言图搜索的方法0、基础知识介绍1)图的概念2)规划配置空间(C-space)的概念3)障碍物在配置空间中的表示4)图搜索算法的前提--建立这一张搜索图5)图搜索算法的核心思想1.DFS\BFS\DFS-ID搜索算法(1)深度优先搜索Depth-First-Searching(DFS)1.适合的路径规划应用场景2.维护容器3.搜索过程图例4.伪代码(2)广度优先搜索Breadth-Fi原创 2023-07-08 15:23:04 · 3074 阅读 · 0 评论 -
【全局路径规划模块图搜索算法】DFS、BFS、DFS-ID路径搜索算法(附C++代码)
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对DFS\BFS\DFS-ID路径搜索算法做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容(1)DFS\BFS\DFS-ID搜索算法对比1)算法工作原理1、深度优先搜索:1->2->3 1->2->4->5 1->6->7 1->6->82、广度优先搜索:1->2 1->6 1->2->3 1->2->4 1->6->7 1->6->8 1->2->4->5。原创 2024-04-28 20:06:50 · 338 阅读 · 0 评论 -
【全局路径规划模块图搜索算法】greedy best frist search贪心算法
这个代码实现了一个基本的贪婪最佳优先搜索算法,用于在一个给定的网格中找到从起点到终点的路径。注意,这个实现仅适用于整数网格,并且假设网格中的数字表示高度。总的来说,贪婪最佳优先搜索通过优先考虑那些最有可能导向目标的节点,从而高效地找到最短路径。然而,这种方法并不保证总是找到绝对的最短路径,特别是在存在障碍物或其他复杂情况的地图中。这个函数通常基于一些已知的信息,比如实际距离、地形难度等,来估计到达目标的代价。(1)启发式的搜索会指导一个靠近目标点的正确方向【防盗标记–盒子君hzj】原创 2025-04-07 08:44:28 · 575 阅读 · 0 评论 -
【全局路径规划模块图搜索算法】Dijkstra算法
在开集中,若是当前节点的邻节点将会被更新代价,若不是当前节点的邻节点其代价为无穷大。第二步:2.收录节点后遍历该节点的邻接节点,【防盗标记–盒子君hzj】更新计算n节点的所有临近节点m的代价值g(m)【防盗标记–盒子君hzj】第一步:从未访问的节点选择距离(代价)最小的节点收录,【防盗标记–盒子君hzj】g(n)表示从起点开始到当前节点的代价累加值(基于贪心思想)1、定义一个节点类,包含当前节点的位置、父节点、g值(从起点到当前节点的实际距离)和h值(从当前节点到目标节点的估计距离)。原创 2025-04-07 08:43:58 · 555 阅读 · 0 评论 -
【全局路径规划模块图搜索算法】A*算法
(1)地图:在代价地图上进行路径探索(规划用到的地图格式和ros的格式不一样,是mat类型的(可以理解为一个二维数组,输入xy,判断对应的节点是以下那个状态nodetype【openlist、closelist、free、obstacle】))(2)节点信息储存的列表:openlist、closelist(3)节点信息:node【point、f_cost、g_cost、h_cost、parent_node】astar算法的理解。原创 2025-04-07 08:43:30 · 584 阅读 · 0 评论 -
【全局路径规划模块图搜索算法】贪心算法、Dijkstra和A*类路径搜索算法(附C++代码)
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对****做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对贪心算法、Dijkstra和A*类路径搜索算法做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容。原创 2024-04-28 20:09:05 · 1471 阅读 · 0 评论 -
【全局路径规划模块图搜索算法】jump point search(JPS)跳点搜索算法(附C++代码)
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对** jump point search(JPS)跳点搜索算法**做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容如果节点n是x的邻居,并且节点n的邻居有阻挡(不可行走的格子),并且从parent(x)、x、n的路径长度比其他任何从parent(x)到n且不经过x的路径短,其中parent(x)为路径中x的前一个点,则n为x的强迫邻居,x为n的跳点。原创 2024-04-28 20:24:31 · 757 阅读 · 0 评论 -
【全局路径规划模块运动学算法】hybird A*算法(附C++代码)
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对hybird A算法、Kinodynamic A算法做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容规划用hybrid a 星(改成了rs曲线),hybrid A*的启发函数有两个,通过切换更好的引导启发效果!(1)hybrid a*算法探索出来的是圆弧和直线连接的局部路径,后端经过轨迹优化后更加平滑了算法是在A。原创 2024-04-28 20:29:15 · 1443 阅读 · 0 评论 -
【全局路径规划模块运动学算法】无人机Kinodynamic A*算法、Kinodynamic RRT*算法(附C++代码)
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对Kinodynamic A*算法做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容啃这个Kinodynamic A_star算法,建议先啃一啃高飞fast_planner那篇论文,把理论打好,如果还是比较迷,就先看Dijksta、再看A_star、再看hybrid A_star 三个的流程,因为往上资料比较多,再看这个Kinodynamic A_star算法,流程已经很相像了。如果。原创 2024-05-29 19:52:29 · 2031 阅读 · 0 评论 -
【全局路径规划模块采样算法】构建一张图(graph)思想&采样基础算法举例
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对基于采样的方法–RRT类算法、PRM算法、Lattice planner等做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容采样方式:采样可以分为全局采样和局部采样,全局采样一般如PRM,局部采样一般还分为基于状态空间采样与基于控制空间采样(1)优点快速随机树算法是一种较为迅捷搜索的方式,增量式的构建树其优点明显,主要体现在针对性的找一条从起点到终点的路径其较强较快的搜索能力。原创 2023-07-08 15:25:57 · 1038 阅读 · 0 评论 -
【全局路径规划模块采样算法】Rapidly exploring Random Trees(RRT)类算法(附C++代码)
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对Rapidly exploring Random Trees(RRT)类算法做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容(1)优点快速随机树算法是一种较为迅捷搜索的方式,增量式的构建树其优点明显,主要体现在针对性的找一条从起点到终点的路径其较强较快的搜索能力,【防盗标记–盒子君hzj】并且运用快速拓展随机树的路径规划对路径运行环境没有限制要求。(2)缺点。原创 2024-04-28 20:34:10 · 885 阅读 · 0 评论 -
【全局路径规划模块采样算法】概率路线图probabilistic Roadmap搜索(附C++代码)
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!原创 2024-04-28 20:35:12 · 1492 阅读 · 0 评论 -
【局部规划模块路径采样算法】lattice planner格子规划算法(附C++代码)
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对**regular state lattice in unstructured environment(结合了全局采样和图搜索的思想)**做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容regular state lattice的每个采样网格中都是用曲线连接起来的,改进了RRT的折线问题,规划出来的path更加平滑。原创 2024-04-28 20:36:25 · 1243 阅读 · 0 评论 -
【全局路径规划模块智能体算法】动态规划DP算法
如上图所示,多阶段的决策过程又7个阶段,每个阶段又包含若干个状态(ABCDEFG),整体决策就是在每个阶段决策哪一种状态,把各个阶段的最优状态连接起来就是最优的决策序列一个问题难以划分为多个阶段,且每个阶段的状态不是先验的,而是需要约束体哦阿健实时计算出来的这就意味着动态规划DP算法常用于全局规划,再先验的全局地图中进行规划,当然动态规划DP算法也九二一用在局部规划中,百度apollo中的em_planner也有用到DP的思想进行局部路径的搜索,再用QP的方式进行轨迹平滑。原创 2025-04-05 11:22:47 · 55 阅读 · 0 评论 -
【全局路径规划模块地图算法】基于-vector_map地图的路径规划方法
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对基于地图的方法–vector_map、Voronoi_map做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容。原创 2023-07-08 15:31:36 · 899 阅读 · 0 评论 -
【全局路径规划地图算法】Voronoi路径规划探索(附C++代码)
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对Voronoi路径规划探索做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容。原创 2024-05-16 10:32:16 · 1606 阅读 · 0 评论 -
【全局路径规划模块智能体算法】蚁群算法
感性分析蚂蚁走多了就有经验了!不断参考前车之鉴的思想进行迭代–是多只的蚂蚁去走【第一个循环】,走很多次【第二个循环】!蚁群算法常被用在全局路径探索,一方面是因为探索出来的路径比较粗糙,在复杂提点的场景一般不能直接用于执行。另一方面是只有在大地图(全局地图)中,蚁群算法的优势才能被显现出来。原创 2025-04-07 08:43:02 · 574 阅读 · 0 评论 -
【全局路径规划模块智能体算法】智能算法的方法--蚁群算法、动态规划DP(附C++代码)
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对智能算法的方法–蚁群算法、动态规划DP等做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容感性分析蚂蚁走多了就有经验了!不断参考前车之鉴的思想进行迭代–是多只的蚂蚁去走【第一个循环】,走很多次【第二个循环】!蚁群算法常被用在全局路径探索,一方面是因为探索出来的路径比较粗糙,在复杂提点的场景一般不能直接用于执行。原创 2023-07-08 15:33:30 · 637 阅读 · 0 评论 -
【全局路径规划模块全覆盖算法】覆盖式路径规划
【路径探索篇】(5)全局路径规划原创 2022-11-06 23:21:42 · 3029 阅读 · 0 评论 -
【全局路径规划模块全覆盖算法】静态/动态全覆盖路径规划相关技术研究
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对静态/动态全覆盖路径规划相关技术研究做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容。原创 2024-10-27 15:49:05 · 346 阅读 · 0 评论 -
【全局路径规划模块全覆盖算法】覆盖路径规划十大经典demo
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对****做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容。原创 2024-10-27 15:22:44 · 685 阅读 · 0 评论 -
【全局路径规划模块全覆盖算法】相关Coverage Path Planning的论文整理
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对相关Coverage Path Planning的论文整理做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容以下是一些2016年至2021年的研究论文,按时间顺序排列。原创 2024-10-27 15:33:53 · 194 阅读 · 0 评论 -
【全局路径规划模块全覆盖算法】(一)代码实现:Boustrophedon Cellular Decomposition Path Planning整体代码框架
系列文章目录提示:这里可以添加系列文章的所有文章的目录,目录需要自己手动添加TODO:写完再整理文章目录系列文章目录前言测试用例可视化测试辅助函数路径规划功能函数前言认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对Boustrophedon Cellular Decomposition Path Planning整体代码框架做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容测试用例/** 地图默认是空闲区域为原创 2024-09-21 15:10:01 · 1195 阅读 · 0 评论 -
【全局路径规划模块全覆盖算法】(二)代码实现:Boustrophedon Cellular Decomposition Path Planning区域分解
移动机器人规划控制合集(这个比较全面):https://blog.csdn.net/qq_35635374/article/details/142830798本文先对Boustrophedon Cellular Decomposition Path Planning区域分解做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容1、构造珊格地图2、计算in、out、middle事件3、计算slice4、进行区域分解原创 2024-09-21 15:09:51 · 1188 阅读 · 0 评论 -
【全局路径规划模块全覆盖算法】(三)代码实现:Boustrophedon Cellular Decomposition Path Planning用珊格地图生成每个cell的覆盖路径
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对Boustrophedon Cellular Decomposition Path Planning用珊格地图生成每个cell的覆盖路径做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容。原创 2024-09-21 15:09:40 · 1299 阅读 · 0 评论 -
【全局路径规划模块全覆盖算法】活力值栅格地图的全覆盖路径规划
系列文章目录提示:这里可以添加系列文章的所有文章的目录,目录需要自己手动添加TODO:写完再整理文章目录系列文章目录前言实现方法全覆盖路径规划开源项目Clean-robot-turtlebot3解析(1)PathPlanningNode集成全覆盖路径规划和运动规划控制(2)CleaningPathPlanner全覆盖路径规划(3)next_goal运动规划控制(4)参考工程(5)参考链接前言认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对活力值栅格地图的全覆原创 2024-09-21 15:32:42 · 2228 阅读 · 0 评论 -
【全局路径规划模块全覆盖算法】梯形区域分解实现避障路径规划&全覆盖路径规划
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对梯形区域分解实现避障路径规划&全覆盖路径规划做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容。原创 2024-09-21 16:01:03 · 1610 阅读 · 0 评论 -
【全局路径规划模块全覆盖算法】Trapezoidal Decomposition(TCD)梯形分解算法
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对**Trapezoidal Decomposition梯形分解算法(TCD)**做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容。原创 2024-09-21 15:49:02 · 2131 阅读 · 0 评论 -
【全局路径规划模块全覆盖算法】Boustrophedon Cellular Decomposition(BCD)原理及实现
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对****做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容。原创 2024-09-21 17:16:45 · 2065 阅读 · 0 评论 -
【全局路径规划模块全覆盖算法】栅格地图实现布氏单元分解算法+栅格地图实现牛耕Boustrophedon Cellular Decomposition Path Planning
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对**【栅格地图实现布氏单元分解算法+栅格地图实现牛耕】Boustrophedon Cellular Decomposition Path Planning**做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容。原创 2024-09-21 15:12:20 · 1998 阅读 · 0 评论 -
【全局路径规划模块全覆盖算法】通过图形学实现在凸多边形内生成覆盖路径
认知有限,望大家多多包涵,有什么问题也希望能够与大家多交流,共同成长!本文先对通过图形学实现在凸多边形内生成覆盖路径做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容。原创 2024-09-21 15:54:58 · 1217 阅读 · 0 评论