路径规划算法初步认识

简介:

上面那个论文把uav的路径规划分为以下5类:

  • sampling-based algorithms

  • node-based algorithms

  • mathematical model based algorithms

  • Bio-inspired algorithms

  • multi-fusion based algorithms

知乎移动机器人路径规划

  • 完备的(complete)(有解是可以求出来的),主要应用于二维三维的grid,多维的计算量就大了

  • 基于采样的(sampling-based)又称为概率完备的,(有解不一定能求出来的,可能经过足够多的采样可以得到解,是概率上的可能能得到解)

路径规划算法发展的历程

542140-20170604231007086-267952544.png

公开课

宾夕法尼亚大学的运动规划

542140-20170604231023649-2029618153.png

RRT(快速随机搜索树)

RRT算法是RRT算法的变种算法,算法可以收敛到最优解,不仅可以实现二维环境下的路径规划,多维度的环境也可以使用RRT算法,而且由于算法是均匀采样,并不会出现局部最小的情况。

RPM 要先构建roadmap,因此可以多次使用的,graph中的node还可以相互连接的

RRT是直接从start node延增出去的,每个node只有一个parent的,

RRT wiki

伪代码

- add start node to tree

- repeat n times
    
    - generate a random configuration x
    - if x is a freespace using the `CollisionCheck` function 
        
        find y ,the cloest node in the tree to the random configuraion x        if (`Dist(x,y) > delta`) -- check if x too far from y
            find a configuration z that is along the path from x to y such that Dist(z,y) <= delta
            x = z        if (`LocalPlanner(x,y)`) -- check if you can get from x to y .Add x to the tree with y as patent

Artifical potential fields

构造一个函数 = an attractive potential field + a repulsive potential field

= 一个离目标点越近能量越低的函数 + 一个离障碍物越远能量越低的函数

下面第一张图是黑色障碍物,第二张图是attractive potential field ,第三张图是 repulsive potential field,最后一张是上面两个的相加得到的最终构造的函数

542140-20170604231042805-559247091.png

542140-20170604231054008-2024538840.png
542140-20170604231110993-478057434.png

542140-20170604231125977-1085854582.png

可能会陷入到local minimum

nbvplanner

github

ethz 开源的一个路径规划算法库

需要的是里程计tf坐标变换和3d点云数据,计算下个位置的gain,这个gain也考虑了octomap中格子的概率,考虑的是看到还没有mapped的格子
,尽可能寻找相应多的格子进行路径规划,

代码中的mesh_structure.h,对我们的作用不是很大,主要是用于导入CAD图纸,不用在线输入点云数据,这时候寻找的是看到的surface最多的下一个目标点

tool

2d路径规划可视工具

工具显示的第三个维度是概率的大小,可视化,针对的是moveit这个开源工具,没有试过别的可不可以









      本文转自zsdnr  51CTO博客,原文链接:http://blog.51cto.com/12942149/1932771,如需转载请自行联系原作者



相关文章
|
2月前
|
传感器 算法 自动驾驶
混合A*运动规划算法:路径规划和路径跟踪-MPC-LQR-PID算法
混合A*运动规划算法:路径规划和路径跟踪-MPC-LQR-PID算法
76 0
混合A*运动规划算法:路径规划和路径跟踪-MPC-LQR-PID算法
|
2月前
|
人工智能 算法 数据可视化
路径规划最全综述+代码+可视化绘图(Dijkstra算法+A*算法+RRT算法等)-2
路径规划最全综述+代码+可视化绘图(Dijkstra算法+A*算法+RRT算法等)-2
212 0
|
8月前
|
机器学习/深度学习 算法 机器人
路径规划算法:基于蜉蝣优化的机器人路径规划算法- 附matlab代码
路径规划算法:基于蜉蝣优化的机器人路径规划算法- 附matlab代码
路径规划算法:基于蜉蝣优化的机器人路径规划算法- 附matlab代码
|
2月前
|
存储 人工智能 算法
路径规划最全综述+代码+可视化绘图(Dijkstra算法+A*算法+RRT算法等)-1
路径规划最全综述+代码+可视化绘图(Dijkstra算法+A*算法+RRT算法等)-1
70 0
|
6月前
|
机器学习/深度学习 算法 自动驾驶
基于Qlearning强化学习的路径规划算法matlab仿真
基于Qlearning强化学习的路径规划算法matlab仿真
|
8月前
|
机器学习/深度学习 算法 机器人
路径规划算法:基于被囊群优化的机器人路径规划算法- 附matlab代码
路径规划算法:基于被囊群优化的机器人路径规划算法- 附matlab代码
|
8月前
|
机器学习/深度学习 算法 机器人
路径规划算法:基于蜻蜓分布优化的机器人路径规划算法- 附matlab代码
路径规划算法:基于蜻蜓分布优化的机器人路径规划算法- 附matlab代码
|
5月前
|
机器学习/深度学习 供应链 算法
滴滴出行 路径规划算法工程师 面经
滴滴出行 路径规划算法工程师 面经
42 0
|
7月前
|
机器学习/深度学习 传感器 算法
基于粒子群算法求解带时间窗的+带容量的车辆路径规划问题(惩罚成本)附Matlab代码
基于粒子群算法求解带时间窗的+带容量的车辆路径规划问题(惩罚成本)附Matlab代码
|
8月前
|
机器学习/深度学习 传感器 算法
【无人机路径规划】基于天牛须算法BAS实现三维路径规划附matlab代码
【无人机路径规划】基于天牛须算法BAS实现三维路径规划附matlab代码