来源丨古月居

点击进入—>3D视觉工坊学习交流群

1. 最佳优先搜索(Best-First Search)

最佳优先搜索(BFS),又称A算法,是一种启发式搜索算法(Heuristic Algorithm)。[不是广度优先搜索算法( Breadth First Search , BFS )]

BFS算法在广度优先搜索的基础上,用启发估价函数对将要被遍历到的点进行估价,然后选择代价小的进行遍历,直到找到目标节点或者遍历完所有点,算法结束。

要实现最佳优先搜索我们必须使用一个优先队列(priority queue)来实现,通常采用一个open优先队列和一个closed集,open优先队列用来储存还没有遍历将要遍历的节点,而closed集用来储存已经被遍历过的节点。

1.1 最佳优先搜索的过程

最佳优先搜索的过程可以被描述为:

1、将根节点放入优先队列open中。

2、从优先队列中取出优先级最高的节点X。

3、根据节点X生成子节点Y:

X的子节点Y不在open队列或者closed中,由估价函数计算出估价值,放入open队列中。

X的子节点Y在open队列中,且估价值优于open队列中的子节点Y,将open队列中的子节点Y的估价值替换成新的估价值并按优先值排序。

X的子节点Y在closed集中,且估价值优于closed集中的子节点Y,将closed集中的子节点Y移除,并将子节点Y加入open优先队列。

4、将节点X放入closed集中。

5、重复过程2,3,4直到目标节点找到,或者open为空,程序结束。

BFS不能保证找到一条最短路径。然而,它比Dijkstra算法快的多,因为它用了一个启发式函数(heuristic function)快速地导向目标结点。

这篇博客对BFS进行了详细的介绍用的是罗马尼亚度假问题

https://blog.csdn.net/weixin_46582817/article/details/115217489

2. A-Star算法

1968年发明的A*算法就是把启发式方法(heuristic approaches)如BFS,和常规方如Dijsktra算法结合在一起的算法。

A-Star算法是一种静态路网中求解最短路径最有效的直接搜索方法,也是解决许多搜索问题的有效算法。

• 和Dijkstra一样,A*能用于搜索最短路径。

• 和BFS一样,A*能用启发式函数引导它自己。

左图为Astar算法效果图,右图为Dijkstra算法效果图

Astar算法与Dijkstra算法的效果差不多,但Astar算法访问的节点数明显比Dijkstra算法少得多,说明其速度更快,运行时间更短。

2.1 Astar算法所属分类

A*算法在最短路径搜索算法中分类为:

• 直接搜索算法:直接在实际地图上进行搜索,不经过任何预处理;

• 启发式算法:通过启发函数引导算法的搜索方向;

• 静态图搜索算法:被搜索的图的权值不随时间变化(后被证明同样可以适用于动态图的搜索 )

2.2 Astar算法基本概念

A*算法启发函数表示为:f(n)=g(n)+h(n)

•f(n) 是从初始状态经由状态n到目标状态的代价估计

•g(n) 是在状态空间中从初始状态到状态n的实际代价

•h(n) 是从状态n到目标状态的最佳路径的估计代价

(对于路径搜索问题,状态就是图中的节点,代价就是距离)

Astar算法是启发式搜索算法,启发式搜索是在状态空间中对每一个搜索的位置进行评估,得到最好的位置,再从这个位置进行搜索直到目标。

这样可以省略大量无谓的搜索路径,提高效率。在启发式搜索中,对位置的估价是十分重要的。采用了不同的估价可以有不同的效果。

启发函数(Heuristics Function)(估价函数): H为启发函数,也被认为是一种试探。

由于在找到唯一路径前,不确定在前面会出现什么障碍物,计算H的算法(例如,H可采用传统的曼哈顿距离)具体根据实际场景决定

父节点(parent): 在路径规划中用于回溯的节点。

搜索区域(The Search Area): 前面图中的搜索区域被划分为了简单的二维数组,数组每个元素对应一个小方格,也可以将区域等分成是五角星,矩形等,通常将一个单位的中心点称之为搜索区域节点(Node)。 

开放列表(Open List):将路径规划过程中待检测的节点存放于Open List中。

关闭列表(Close List): 将路径规划过程中已经检查过的节点放在Close List。

2.3 启发函数单调性的推导

单调性:单调性是Astar算法非常重要的一个性质,它决定了在用Astar算法进行路径搜索时,一定能找到一条最优路径。

设父节点的坐标为(x0,y0),它的任意一个子节点的坐标为(xi,yi),所以对两者之间的h(x),就一定满足

在Astar算法的运行过程中,后继的f(x)值时大于当前f(x)的值,即f(x)在之后对子节点的搜索扩展是单调递增的,不会像人工势场法一样出现局部极小值,因此使用Astar算法规划出的路径一定是最优路径.

2.4 设计代价函数时所需注意的点

在使用A*算法的过程中,启发代价的值必须尽量接近于真实值(尽量选取能取到的最大值,这样可以提升搜索效率),以保证规划出的路径尽可能地与实际地图环境相符合。

根据所需的模型选择不同的启发代价的计算方法时,同样必须保证启发代价所得的估计值小于真实值。

2.5 代价函数的选择

2.5.1 曼哈顿距离

曼哈顿距离函数在标准坐标系中,表示起始和目标两节点的绝对值总和,其估计值就是从当前点做水平和垂直运动,到达目标点的成本的估计,因此,曼哈顿距离函数中,两点的距离如下

K——相邻两节点之间的距离,即单位距离;
(x1,y1)——起始节点的坐标;
(x2,y2)——目标节点的坐标;

2.5.2 欧几里得距离

欧几里得距离又称为欧式距离,它是衡量两点之间距离远近的最常用的方法之一。欧几里得距离函数的值可以直接看作起始节点和目标节点,在欧式空间中的直线距离,其表达式如下所示

K——相邻两节点之间的距离,即单位距离;
(xi,yi)——当前节点的坐标;
(xk,yk)——目标节点的坐标;

欧几里德距离函数作为启发代价的计算方法时,虽然寻径时搜索空间增加从而导致搜索效率的降低,但其所得的估计值最小;

而在使用曼哈顿距离函数时,虽然寻径需要遍历的栅格空间少于欧几里得距离函数,搜索效率较高,但这种方法得到的估计值与欧几里得距离函数相比,距离真实值更远。

2.6 确定最终路径

已经确定了目标节点的坐标为,根据此目标节点的位置,和先前设置的方向存储函数之中的方向,从目标节点利用方向反推至起始节点。具体实现的示意图如下

2.7 路径平滑

我们需要对规划出的路径进行平滑处理,将路径的转折处转化为平滑的曲线,使之更加符合无人车的实际运动路径。

主要有基于B样条曲线的路径优化方法,基于Dubins圆的路径优化方法,和基于Clothoid曲线的路径优化方法,基于贝塞尔曲线的路径平滑算法。

红色为未平滑路径,绿色方块为最终路径,黄色为贝塞尔曲线拟合得到,蓝色为spcrv函数平滑得到。

2.8 Astar算法的优缺点

优点:

相对于需要将所有节点展开搜寻的算法,A*算法最大的优点就是引入了启发信息作为向目标点移动的决策辅助,所以不再需要遍历整个地图,降低了计算复杂度,减少了时间损耗少。

缺点:

基于栅格法来分割地图,精度越高,栅格分的就越小,就会使工作量几何式的增长。

估价函数选取的不合理也有可能导致无法规划出最优路径。

距离估计与实际值越接近,估价函数取得就越好。估价函数f(n)在g(n)一定的情况下,会或多或少的受距离估计值h(n)的制约,节点距目标点近,h值小,f值相对就小,能保证最短路的搜索向终点的方向进行,明显优于Dijkstra算法的毫无方向的向四周搜索。

2.9 Astar算法流程

如下图所示,绿色是起点A,红色是终点B,一系列蓝色是障碍物,从A移动到B,绕过障碍。

1、用方格(三角形、五角形)划分空间,简化搜索区域。空间被划分为二维数组,数组中每个元素代表空间中的一个方格,可被标记为可行或不可行。未来的路径就是一系列可行方块的集合。Nodes的概念涵盖了一系列可行方块(或其它方块)

2、将起点A放到Openlist中,Openlist存放着一系列需要检查的节点(方块)

3、给Openlist中每个节点赋值F=G+H (起点为0,横向和纵向的移动代价为 10 ,对角线的移动代价为 14)

4、检查Openlist,选取F值最小的节点(此处为A点)。

5、将A点从Openlist中删除,放入Closelist中(Closelist中存放不可寻点,即已被访问过的点),把A点临近节点放入Openlist中,并将A点设为临近节点的父节点。

6、给Openlist中每个节点赋值,选取F值最小的节点设为当前节点Node,(若当前节点Node为终点,则寻路结束,若Openlist中没有可寻节点,则寻路失败)

7、检查当前节点Node周围临近节点。忽略Closelist中的节点和不可行节点(障碍),如果临近节点在Openlist中,则对比一下是否从当前节点到临近节点的G值比原G值(直接到临近节点的实际代价值)小,若是,把当前节点作为父节点。否,不做改动。如果临近节点不在Openlist中,将其加入到Openlist中,将当前节点设为它的父节点。

8、若上步骤中新节点未造成任何改动,将新节点作为当前节点,重复6,7)中的步骤,直到找到目标节点。

寻找到目标节点

9、从目标节点回溯可以找到初始点,从而确定路径

上述描述路径的图片有些错误,具体步骤如下图所示。

3. 其他Astar算法

3.1 Astar——三维地图规划

3.1.1 3D-Astar原理

三维栅格地图,顾名思义不是简单的二维平面,它必须得有三维方向,也就是高度方向上的拓展。栅格地图在XY水平面上的栅格的投影颜色不尽相同,栅格黄色程度越高,表明此处的高度越高。

为了使启发代价的值应该尽量接近于真实值,三维栅格地图中仍然选用欧几里得距离作为估价函数计算启发代价的计算方法。

但本次实验所处的环境为三维避障空间,因此相较于二维空间的路径规划,我们将公式做三维化推广,具体形式如下:

h(n)——当前节点到目标节点的启发代价值;

g(n-1)——当前节点到它的父节点之间的路径代价;

D(n-1, n)——当前节点与它的子节点之间的代价值。

g(n-1)与二维规划中的距离代价计算方法一致,但D(n-1, n)在计算时用父节点与子节点之间的距离值除以三维避障环境中设定的栅格可通行程度,h(n)也是用当前节点到目标节点的启发代价值除以地图环境中预先设定的栅格可通行程度。

3.1.2 基于MATLAB实现3D-Astar

这里是代码的GitHub地址:

https://github.com/ybmasmiling/Astar_3D

3.2 距离与能量复合Astar算法

经典Astar算法路径规划是取两节点间曼哈顿距离作为距离估计为最优原则搜索路径,从而得到最短路径。

搜索路径的过程中并没有考虑实际道路坡度和道路滚动阻力系数对行驶车辆最短路径搜索的影响,也没有考虑在道路上行驶的能量损耗问题,即经典Astar算法搜索的最短路径并非符合实际车辆行驶的最优路径。

3.2.1 最短路径启发函数

最短路径启发函数:

最终得到的最短路径启发函数如下式:

3.2.2 最短道路损耗功启发函数

道路损耗功启发函数:

最终得到的最短道路损耗功启发函数如下式:

3.2.3 综合启发函数

综合启发函数:

综合式启发函数统一最短路径启发函数和最小道路额外功函数,不同的权重大小决定最短路径启发函数和最小道路额外功函数在综合式启发函数中所占不同的比重。

3.3 双向Astar算法

传统A算法在大环境中搜索,存在着搜索效率低的问题。

传统A算法是从起点开始向终点搜索,直到寻到可行路径停止搜索,在搜索路径的前期阶段远g(n)小于h(n),搜索时横向搜索范围窄,纵向搜索范围宽,搜索速度快,在搜索的后期阶段g(n)远大于h(n),搜索时纵向搜索范围窄,横向搜索范围宽,搜索速度慢;**而改进后的双向A搜索算法分别从起点和终点开始搜索,当搜索到相同的当前节点时,搜索结束。

**相比于传统A算法,双向A*搜索算法都处于g(n)远小于h(n)阶段,一定程度上提高了算法的搜索效率,缩短搜索时间。

4. MATLAB实现Astar算法

4.1 defColorMap.m

用于初始化地图参数

function [field,cmap] = defColorMap(rows, cols)
cmap = [1 1 1; ...       % 1-白色-空地0 0 0; ...           % 2-黑色-静态障碍1 0 0; ...           % 3-红色-动态障碍1 1 0;...            % 4-黄色-起始点 1 0 1;...            % 5-品红-目标点0 1 0; ...           % 6-绿色-到目标点的规划路径   0 1 1];              % 7-青色-动态规划的路径% 构建颜色MAP图
colormap(cmap);% 定义栅格地图全域,并初始化空白区域
field = ones(rows, cols);% 障碍物区域
obsRate = 0.3;
obsNum = floor(rows*cols*obsRate);
obsIndex = randi([1,rows*cols],obsNum,1);
field(obsIndex) = 2;

4.2 getChildNode.m

用于获取子节点信息

function childNodes = getChildNode(field,closeList, parentNode)
% 选取父节点周边8个节点作为备选子节点,线性化坐标
% 排除超过边界之外的、位于障碍区的、位于closeList中的[rows, cols] = size(field);
[row_parentNode, col_parentNode] = ind2sub([rows, cols], parentNode);
childNodes = [];
closeList = closeList(:,1);% 第1个子节点(右节点)
childNode = [row_parentNode, col_parentNode+1];
if ~(childNode(1) < 1 || childNode(1) > rows ||...childNode(2) < 1 || childNode(2) > cols)if field(childNode(1), childNode(2)) ~= 2childNode_LineIdx = sub2ind([rows, cols], childNode(1), childNode(2));if ~ismember(childNode_LineIdx, closeList)childNodes(end+1) = childNode_LineIdx;endend
end% 第2个子节点(右上节点)
childNode = [row_parentNode-1, col_parentNode+1];
child_brother_node_sub1 = [row_parentNode-1, col_parentNode];
child_brother_node_sub2 = [row_parentNode, col_parentNode+1];
if ~(childNode(1) < 1 || childNode(1) > rows ||...childNode(2) < 1 || childNode(2) > cols)if field(childNode(1), childNode(2)) ~= 2if  ~(field(child_brother_node_sub1(1), child_brother_node_sub1(2)) == 2 & field(child_brother_node_sub2(1), child_brother_node_sub2(2)) == 2)childNode_LineIdx = sub2ind([rows, cols], childNode(1), childNode(2));if ~ismember(childNode_LineIdx, closeList)childNodes(end+1) = childNode_LineIdx;endend   end
end% 第3个子节点(上节点)
childNode = [row_parentNode-1, col_parentNode];
if ~(childNode(1) < 1 || childNode(1) > rows ||...childNode(2) < 1 || childNode(2) > cols)if field(childNode(1), childNode(2)) ~= 2childNode_LineIdx = sub2ind([rows, cols], childNode(1), childNode(2));if ~ismember(childNode_LineIdx, closeList)childNodes(end+1) = childNode_LineIdx;endend
end% 第4个子节点(左上)
childNode = [row_parentNode-1, col_parentNode-1];
child_brother_node_sub1 = [row_parentNode-1, col_parentNode];
child_brother_node_sub2 = [row_parentNode, col_parentNode-1];
if ~(childNode(1) < 1 || childNode(1) > rows ||...childNode(2) < 1 || childNode(2) > cols)if field(childNode(1), childNode(2)) ~= 2if  ~(field(child_brother_node_sub1(1), child_brother_node_sub1(2)) == 2 & field(child_brother_node_sub2(1), child_brother_node_sub2(2)) == 2)childNode_LineIdx = sub2ind([rows, cols], childNode(1), childNode(2));if ~ismember(childNode_LineIdx, closeList)childNodes(end+1) = childNode_LineIdx;endend  end
end% 第5个子节点(左节点)
childNode = [row_parentNode, col_parentNode-1];
if ~(childNode(1) < 1 || childNode(1) > rows ||...childNode(2) < 1 || childNode(2) > cols)if field(childNode(1), childNode(2)) ~= 2childNode_LineIdx = sub2ind([rows, cols], childNode(1), childNode(2));if ~ismember(childNode_LineIdx, closeList)childNodes(end+1) = childNode_LineIdx;endend
end% 第6个子节点(左下)
childNode = [row_parentNode+1, col_parentNode-1];child_brother_node_sub1 = [row_parentNode, col_parentNode-1];child_brother_node_sub2 = [row_parentNode+1, col_parentNode];
if ~(childNode(1) < 1 || childNode(1) > rows ||...childNode(2) < 1 || childNode(2) > cols)if field(childNode(1), childNode(2)) ~= 2if  ~(field(child_brother_node_sub1(1), child_brother_node_sub1(2)) == 2 & field(child_brother_node_sub2(1), child_brother_node_sub2(2)) == 2)childNode_LineIdx = sub2ind([rows, cols], childNode(1), childNode(2));if ~ismember(childNode_LineIdx, closeList)childNodes(end+1) = childNode_LineIdx;endend end
end% 第7个子节点(下)
childNode = [row_parentNode+1, col_parentNode];
if ~(childNode(1) < 1 || childNode(1) > rows ||...childNode(2) < 1 || childNode(2) > cols)if field(childNode(1), childNode(2)) ~= 2childNode_LineIdx = sub2ind([rows, cols], childNode(1), childNode(2));if ~ismember(childNode_LineIdx, closeList)childNodes(end+1) = childNode_LineIdx;endend
end% 第8个子节点(右下)
childNode = [row_parentNode+1, col_parentNode+1];child_brother_node_sub1 = [row_parentNode, col_parentNode+1];child_brother_node_sub2 = [row_parentNode+1, col_parentNode];
if ~(childNode(1) < 1 || childNode(1) > rows ||...childNode(2) < 1 || childNode(2) > cols)if field(childNode(1), childNode(2)) ~= 2  if  ~(field(child_brother_node_sub1(1), child_brother_node_sub1(2)) == 2 & field(child_brother_node_sub2(1), child_brother_node_sub2(2)) == 2)childNode_LineIdx = sub2ind([rows, cols], childNode(1), childNode(2)); if ~ismember(childNode_LineIdx, closeList)childNodes(end+1) = childNode_LineIdx;endendend
end

4.3 Astar.m

主程序

% 基于栅格地图的机器人路径规划算法
% A*算法
clc
clear
close all%% 栅格界面、场景定义
% 行数和列数
rows = 20;
cols = 20;
[field,cmap] = defColorMap(rows, cols);% 起点、终点、障碍物区域
startPos = 2;
goalPos = rows*cols-2;
field(startPos) = 4;
field(goalPos) = 5;%% 预处理% 初始化closeList
parentNode = startPos;
closeList = [startPos,0];% 初始化openList
openList = struct;
childNodes = getChildNode(field,closeList,parentNode);
for i = 1:length(childNodes)[row_startPos,col_startPos] = ind2sub([rows, cols],startPos);[row_goalPos,col_goalPos] = ind2sub([rows, cols],goalPos);   [row,col] = ind2sub([rows, cols],childNodes(i));% 存入openList结构体openList(i).node = childNodes(i);openList(i).g = norm([row_startPos,col_startPos] - [row,col]);  % 实际代价采用欧式距离openList(i).h = abs(row_goalPos - row) + abs(col_goalPos - col);  % 估计代价采用曼哈顿距离openList(i).f = openList(i).g + openList(i).h;
end% 初始化path
for i = 1:rows*colspath{i,1} = i;  % 线性索引值
end
for i = 1:length(openList)node = openList(i).node;path{node,2} = [startPos,node];
end %% 开始搜索
% 从openList开始搜索移动代价最小的节点
[~, idx_min] = min([openList.f]);
parentNode = openList(idx_min).node;% 进入循环
while true  % 找出父节点的8个子节点,障碍物节点用inf,childNodes = getChildNode(field, closeList,parentNode);% 判断这些子节点是否在openList中,若在,则比较更新;没在则追加到openList中for i = 1:length(childNodes)% 需要判断的子节点childNode = childNodes(i);[in_flag,idx] = ismember(childNode, [openList.node]);% 计算代价函数[row_parentNode,col_parentNode] = ind2sub([rows, cols], parentNode);[row_childNode,col_childNode] = ind2sub([rows, cols], childNode);[row_goalPos,col_goalPos] = ind2sub([rows, cols],goalPos);g = openList(idx_min).g + norm( [row_parentNode,col_parentNode] -...[row_childNode,col_childNode]);h = abs(row_goalPos - row_childNode) + abs(col_goalPos - col_childNode); % 采用曼哈顿距离进行代价估计f = g + h;if in_flag   % 若在,比较更新g和f        if f < openList(idx).fopenList(idx).g = g;openList(idx).h = h;openList(idx).f = f;path{childNode,2} = [path{parentNode,2}, childNode];endelse         % 若不在,追加到openListopenList(end+1).node = childNode;openList(end).g = g;openList(end).h = h;openList(end).f = f;path{childNode,2} = [path{parentNode,2}, childNode];endend% 从openList移出移动代价最小的节点到closeListcloseList(end+1,: ) = [openList(idx_min).node, openList(idx_min).f];openList(idx_min)= [];% 重新搜索:从openList搜索移动代价最小的节点[~, idx_min] = min([openList.f]);parentNode = openList(idx_min).node;% 判断是否搜索到终点if parentNode == goalPoscloseList(end+1,: ) = [openList(idx_min).node, openList(idx_min).f];breakend
end%% 画路径
% 找出目标最优路径
path_target = path{goalPos,2};
for i = 1:rows*colsif ~isempty(path{i,2}) field((path{i,1})) = 7;end
end
field(startPos) = 4;
field(goalPos) = 5;
field(path_target(2:end-1)) = 6;% 画栅格图
image(1.5,1.5,field);
grid on;
set(gca,'gridline','-','gridcolor','k','linewidth',2,'GridAlpha',0.5);
set(gca,'xtick',1:cols+1,'ytick',1:rows+1);
axis image;
hold on;
[y0,x0] = ind2sub([rows,cols], path_target);
y = y0 + 0.5;
x = x0 + 0.5;
plot(x,y,'-','Color','r','LineWidth',2.5);
hold on;
points = [x',y'];
M = 10;
[x1,y1] = bezir_n(points, M);
plot(x1,y1,'-','Color','y','LineWidth',2.5);
hold on;
values = spcrv([[x(1) x x(end)];[y(1) y y(end)]],3);
plot(values(1,:),values(2,:), 'b','LineWidth',2.5);

4.4 算法效果

运行总时间

栅格地图大小(20x20)

栅格地图大小(30x30)

栅格地图大小(40x40)

可以看到Astar算法对于栅格地图越大的情况,搜索时间越长,其速度相比Dijkstra有优势(尤其是在地图比较大的时候,优势更明显)。

但其总耗时较长,不适用于实时的路径规划,不适用于局部路径规划,适用于全局路径规划。

5. python实现Astar算法

可以参考这篇文章

https://www.jianshu.com/p/5704e67f40aa

这篇文章介绍了Astar以及后续的变种算法

python 版本的伪代码(来源:https://brilliant.org/wiki/a-star-search/)如下:

make an openlist containing only the starting node
make an empty closed listwhile (the destination node has not been reached):consider the node with the lowest f score in the open listif (this node is our destination node) :we are finished if not:put the current node in the closed list and look at all of its neighborsfor (each neighbor of the current node):if (neighbor has lower g value than current and is in the closed list) :replace the neighbor with the new, lower, g value current node is now the neighbor's parent            else if (current g value is lower and this neighbor is in the open list ) :replace the neighbor with the new, lower, g value change the neighbor's parent to our current nodeelse if this neighbor is not in both lists:add it to the open list and set its g

6. Java实现Astar算法

可以参考这篇文章:

https://www.jianshu.com/p/950233af52df

7. 实践案例—基于ROS实现Astar与DWA算法

本项目以Astar算法作为全局路径规划算法,DWA作为局部路径规划算法,实现效果如下。(具体原理与算法代码解释与说明会在之后的文章附上)

版权声明:本文为CSDN博主「yuan〇」的原创文章,遵循CC 4.0 BY-SA版权协议,转载请附上原文出处链接及本声明。

原文链接:

https://blog.csdn.net/sinat_52032317/article/details/127077625

本文仅做学术分享,如有侵权,请联系删文。

点击进入—>3D视觉工坊学习交流群

干货下载与学习

后台回复:巴塞罗自治大学课件,即可下载国外大学沉淀数年3D Vison精品课件

后台回复:计算机视觉书籍,即可下载3D视觉领域经典书籍pdf

后台回复:3D视觉课程,即可学习3D视觉领域精品课程

3D视觉工坊精品课程官网:3dcver.com

1.面向自动驾驶领域的3D点云目标检测全栈学习路线!(单模态+多模态/数据+代码)
2.彻底搞透视觉三维重建:原理剖析、代码讲解、及优化改进
3.国内首个面向工业级实战的点云处理课程
4.激光-视觉-IMU-GPS融合SLAM算法梳理和代码讲解
5.彻底搞懂视觉-惯性SLAM:基于VINS-Fusion正式开课啦
6.彻底搞懂基于LOAM框架的3D激光SLAM: 源码剖析到算法优化
7.彻底剖析室内、室外激光SLAM关键算法原理、代码和实战(cartographer+LOAM +LIO-SAM)

8.从零搭建一套结构光3D重建系统[理论+源码+实践]

9.单目深度估计方法:算法梳理与代码实现

10.自动驾驶中的深度学习模型部署实战

11.相机模型与标定(单目+双目+鱼眼)

12.重磅!四旋翼飞行器:算法与实战

13.ROS2从入门到精通:理论与实战

14.国内首个3D缺陷检测教程:理论、源码与实战

15.基于Open3D的点云处理入门与实战教程

16.透彻理解视觉ORB-SLAM3:理论基础+代码解析+算法改进

17.机械臂抓取从入门到实战

重磅!粉丝学习交流群已成立

交流群主要有3D视觉、CV&深度学习、SLAM、三维重建、点云后处理、自动驾驶、多传感器融合、CV入门、三维测量、VR/AR、3D人脸识别、医疗影像、缺陷检测、行人重识别、目标跟踪、视觉产品落地、视觉竞赛、车牌识别、硬件选型、ORB-SLAM系列源码交流、深度估计、TOF、求职交流等方向。

扫描以下二维码,添加小助理微信(dddvisiona),一定要备注:研究方向+学校/公司+昵称,例如:”3D视觉 + 上海交大 + 静静“。请按照格式备注,可快速被通过且邀请进群。原创投稿也请联系。

▲长按加微信群或投稿,微信号:dddvisiona

3D视觉从入门到精通知识星球:针对3D视觉领域的视频课(三维重建系列、三维点云系列、结构光系列、手眼标定、相机标定、激光/视觉SLAM、自动驾驶等)源码分享、知识点汇总、入门进阶学习路线、最新paper分享、疑问解答等进行深耕,更有各类大厂的算法工程人员进行技术指导。与此同时,星球将联合知名企业发布3D视觉相关算法开发岗位以及项目对接信息,打造成集技术与就业为一体的铁杆粉丝聚集区,6000+星球成员为创造更好的AI世界共同进步,知识星球入口:

学习3D视觉核心技术,扫描查看,3天内无条件退款

高质量教程资料、答疑解惑、助你高效解决问题

觉得有用,麻烦给个赞和在看~  

自动驾驶路径规划:A*(Astar)算法相关推荐

  1. 自动驾驶路径规划五大常用算法(Dijkstra/人工势场/图搜索等)

    编辑 | 希骥智能网联汽车 点击下方卡片,关注"自动驾驶之心"公众号 ADAS巨卷干货,即可获取 点击进入→自动驾驶之心[规划控制]技术交流群 后台回复[规划控制综述]获取自动驾驶 ...

  2. python 非线性规划_自动驾驶运动规划-Hybird A*算法(续)

    Hybird A*算法保证生成的路径是车辆可实际行驶的,但它仍然包含很多不必要的车辆转向操作,我们可以对其进行进一步的平滑和优化. Objective Function 对于Hybird A*生成的车 ...

  3. 自动驾驶路径规划论文解析(5)

    解析论文:A Sampling-Based Local Trajectory Planner for Autonomous Driving along a Reference Path 文章依然采用了 ...

  4. 自动驾驶路径规划——基于概率采样的路径规划算法(RRT、RRT*)

    目录 1. RRT算法背景 1.1 RRT算法核心思想 1.2 RRT算法优缺点 2. 经典RRT算法 2.1 RRT算法流程 2.2 RRT伪代码 3. 基于目标概率采样 4. RRT*算法 4.1 ...

  5. 自动驾驶路径规划——路径规划入门须知

    目录 前言 1.无人驾驶关键技术 2.路径规划基本概念与分类 2.1 路径规划基本概念 2.1.1 路径规划需要解决的问题 2.1.2 路径规划--现在的研究 2.2路径规划的分类 2.3路径规划的流 ...

  6. 自动驾驶路径规划——基于概率采样的路径规划算法(PRM)

    目录 1. PRM算法流程 1.1 预处理 1.2 搜索 2. PRM算法案例 2.1 构型采样 2.2 邻域计算 2.3 图搜索(A*搜索) 3. 采样数量的影响 4. 采样策略 4.1 基于障碍物 ...

  7. 自动驾驶路径规划——Dijkstra算法

    目录 前言 1. 深度优先(DFS)和广度优先(BFS) 2. 深度优先搜索(DFS) 2.1 算法基本思想 2.2 深度优先搜索算法(C) 3. 广度优先搜索(BFS) 3.1 算法基本思想 3.2 ...

  8. 自动驾驶路径规划技术-高速公路路径规划

    Path Planning - Highway Driving project Github: https://github.com/williamhyin/CarND-Path-Planning E ...

  9. 自动驾驶路径规划概况

    文章目录 前言 介绍 1. 路径规划在自动驾驶系统架构中的位置 2. 全局路径规划的分类 2.1 基础图搜索算法 2.1.1 Dijkstra算法 2.1.2 双向搜索算法 2.1.3 Floyd算法 ...

最新文章

  1. [长流支流]的专栏--《金质打印通》、《WebMIS.NET快速开发平台》,MIS/ERP开发利器...
  2. python钻石数据分析_数据分析该用什么工具?
  3. java ++i、i++、i++ + ++i、i++ + i++原理
  4. mysql中常见的几种索引
  5. html页面改成thymeleaf,【Thymeleaf】Thymeleaf模板对html实时刷新
  6. 【caffe-windows】 caffe-master 之图片转换成lmdb or leveldb
  7. 龙芯2f平台下 Debain 6编译Lighttpd
  8. matplotlib is required for plotting.
  9. 年审是当月还是当天_车辆年审到期是指当月吗?
  10. Web安全深度剖析第三章读书笔记
  11. python问卷星 自动答题_问卷星自动答题神器
  12. 一万一千字!结合代码超详细讲解SQL执行流程(二)!干货到底!建议收藏!
  13. 基于JAVA江西婺源旅游文化推广系统计算机毕业设计源码+数据库+lw文档+系统+部署
  14. Indicator Stickynotes - Ubuntu 桌面便签小工具
  15. iptables匹配multiport
  16. 88steam@88skins CSGO饰品皮肤开箱DOTA2饰品开箱即开即取网站
  17. 超级计算机“看”新冠疫情,进一步观察缓激肽假说
  18. 苹果手机怎么编辑word文档_Word文档编辑转换安卓版下载_Word文档编辑转换app下载...
  19. ubuntu 公网FTP搭建,解决无法连接
  20. 开发框架——横版格斗——6.技能播放的逻辑关系

热门文章

  1. Echars 旭日图 鼠标浮动 显示value值
  2. (超级详细秒懂)带你秒懂web电子账单板块代码
  3. 工程师和他媳妇儿好玩的对话1——20160704
  4. R语言 - RStudio使用Git版本控制
  5. TIA博途_STEP7版本的升级与移植相关难点汇总
  6. S参数模型和 IBIS模型入门
  7. 如何在指定网站搜索内容
  8. 界面控件DevExpress WinForms皮肤编辑器的这个补丁,你了解了吗?
  9. 六月回顾 | 盛夏已至,不负每一次期待
  10. 虚拟串口VSPD安装指南