Far planner 代码系列（28）

已于 2022-04-14 10:37:06 修改
阅读量1k 收藏 5
点赞数
分类专栏： Far planner 文章标签： c++ 人工智能 路径规划 自动驾驶 ros
于 2022-04-13 21:45:51 首次发布
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/weixin_39977764/article/details/124157658
版权

        今天我们讲的是首次运行时候的情况梳理。篇幅可能有点长，但是看完肯定会有收获的。我们把之前讲过的东西都串起来，形成一个完整的过程。

        far_planner一开始进入到loop的时候，它是先更新odom的位置信息，如下：

         它会把机器人的odom加入到globalGraphNodes_ 里（这个很重要哦！是全局地图），程序接着往下走：

        通过BuildTerrainImgAndExtractContour函数，我们可以得到一个由激光映射到平面几何的图形顶点容器realworld_contour_。

        通过UpdateContourGraph函数，我们填充realworld_contour_里面的点的属性，把他们变成ctnode，并且组成contour_graph_(我们可以认为这个contour_graph是一个local层面的࿰

了解本专栏 订阅专栏 解锁全文 超级会员免费看
LZZ and MYY
关注
  • 0
    点赞
  • 踩
  • 5
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 3
    评论
专栏目录
订阅专栏
Far planner 部署真实小车 & 树莓派部署lego_loam
weixin_39977764的博客
07-12 2539
今天开一贴Far planner的部署，也算是lego loam的部署吧 因为state_estimation用的是lego loam小车底盘： 轮趣的mini差速底盘外加多一层钢板，中间层用来放velodyne的电池（小的电池还没到，大的电池塞不进去目前）和velodyne信号盒子。前面还可以加一个相机。底层用来放小车的电池和马达等设备了，底层不用动。最上面一层用来安装velodyne16线雷达，需要额外钻孔（如果买轮趣的话可以找老板钻个孔？我也不确定，我自己钻的）。 雷达固定螺丝用的是 1/4-20*3
导航局部路径规划eb算法的详细代码注释
03-25
导航局部路径规划eb算法的详细代码注释，里面包括自己的见解和debug测试结果，特别适合初学者进行研究学习。
far_planner学习笔记
qq_51185963的博客
08-28 728
FAR Planner 使用动态更新的可见度图来快速重新规划。规划器用多边形建立环境模型，并在导航的同时建立全局可见度图。规划器能够处理已知和未知环境。在已知环境中，路径是根据先前的地图规划的。在未知环境中，则会根据导航过程中观察到的环境尝试多条路径，引导车辆到达目标。当存在动态障碍物时，FAR Planner 会断开被动态障碍物阻挡的可见性边缘，并在恢复可见性后重新连接。软件实现使用两个 CPU 线程，一个用于动态更新可见性图，使用约 20% 的线程，另一个用于路径搜索。
Autonomous Exploration Development Environment and the Planning Algorithms
qq_59657502的博客
04-14 1372
Autonomous Exploration Development Environment and the Planning Algorithms论文翻译
视觉学习笔记5——FAR Planner全局路径规划算法学习研究
qq_45848817的博客
04-18 4689
FAR Planner项目旨在建立一种可在现实环境中实时提取环境几何特征并动态建立Visibility Graph进行路径规划及导航的算法，同时该算法支持在没有已知地图的环境下根据实时传感器输入对路径图以及导航路径进行实时动态调整， 可在1-2ms实现对300m环境内的全局路径规划及动态调整。FAR Planner项目所提算法是Team Explorer, CMU&OSU参加DARPA地下挑战赛 (Subterran
（学习笔记）机器人自主导航从零开始第六步——FAR Planner全局路径规划算法
qq_59475883的博客
02-21 6989
本文参考资料： GitHub - MichaelFyang/far_planner：在已知和未知环境中导航的快速，可尝试的路线规划器https://github.com/michaelfyang/far_planner【泡泡前沿专栏•重磅】全网首发，系列(四)：CMU团队开发的全套开源自主导航算法——FAR Planner全局路径规划算法 (qq.com)https://mp.weixin.qq.com/s?__biz=MzI5MTM1MTQwMw==&mid=2247525152&idx
far-planner源码阅读笔记
weixin_47766832的博客
03-05 1269
CSDN上的系列文章主要按照文件架构对进行解析，逐文件介绍各函数的功能。优点是内容详。本篇文章按照代码运行顺序，介绍各回调函数、核心逻辑模块的主要功能并按照调用栈介绍各被调用子函数逻辑。同时穿插介绍了涉及到的C++语法、库函数、数学相关知识。
CMU - FarPlanning 代码速读
luoshi006的博客
05-24 867
【代码】CMU - FarPlanning 代码速读。
Far planner代码系列（5）
weixin_39977764的博客
03-14 943
goalpoint_rviz_plugin（1） 我们今天来看far planner里的第二个插件goalpoint_rviz_plugin。先来看它的头文件： #ifndef GOALPOINT_RVIZ_PLUGIN_WAYPOINT_TOOL_H #define GOALPOINT_RVIZ_PLUGIN_WAYPOINT_TOOL_H #include <sstream> #include <ros/ros.h> #include <QObje...
Far planner 代码系列（22）
weixin_39977764的博客
04-04 713
DynamicGraph::UpdateGlobalNearNodes( ) （二） 经过之前的过程，我们得到了extend_match_nodes_、wide_near_nodes_、near_nav_nodes_、internav_near_nodes_、surround_internav_nodes_和margin_near_nodes_ 我们要接着完善 wide_near_nodes_，这里也很好理解，把odom里连接到的每个node都取出来，如果这个node中的...
Mission Planner 安卓版apk安装包
05-14
Mission Planner 安卓版apk安装包，2022年5月12日更新
项目管理软件Planner 0.14.6源代码
05-06
Planner 是一款开源、易用、跨平台的项目管理软件，能够帮助用户很好的对身边的琐事项目进行一个非常不错的管理，由于是开源的，有技术的朋友还可以对该软件进行一点点不错的修改，从而更方便的使用该软件！...
ego-planner-swarm 注释版
06-04
对于想了解egoplanner源码的朋友，可以下载，并研究
无人机MissionPlanner-master控制软件开源源码
09-21
无人机MissionPlanner-master控制软件开源源码
Mission Planner.apk
09-14
Mission Planner安卓版
数据结构与算法学习笔记七--二叉树(C++)
最新发布
我叫柱子哥
04-23 585
在计算机科学中，树（Tree）是一种抽象数据类型，用于模拟具有树状结构特征的数据集合。树是由一组节点（Nodes）和连接这些节点的边（Edges）组成的，其中一个节点被指定为根节点（Root），其余节点分层组织成子树（Subtrees）。树的每个节点除了根节点外，都恰好连接到一条来自另一个节点的边，这个节点被称为其父节点（Parent Node）。每个节点可以连接到零个或多个子节点，子节点的节点被称为父节点的孩子节点（Child Node）。根节点（Root）：树中的唯一顶层节点，没有父节点。
【C】 初识C语言
努力学习C/C++
04-21 724
从本篇开始，带你从不会C语言到精通C语言。这篇是让大家对C语言有个初步的了解。下面的内容会拆分不同篇幅单独进行详细讲叙。数据类型变量、常量字符串转义字符注释选择语句循环语句函数数组操作符常见关键字define定义常量和宏指针结构体1.什么是C语言？C语言是一门面向过程的计算机编程语言，与C++、C#、Java等面向对象编程语言有所不同。C语言的设计目标是提供一种能以简易的方式编译、处理低级存储器、仅产生少量的机器码以及不需要任何运行环境支持便能运行的编程语言。
C++ WebServer的细节理解
我的博客
04-22 567
在非阻塞模式下，如果 I/O 操作不能立即完成（例如，因为没有数据可读 或 写缓冲区满），系统不会让调用进程阻塞等待，而是立即返回一个错误（通常为 EAGAIN 或 EWOULDBLOCK）。先查询文件描述符 fd 当前的标志，然后将 O_NONBLOCK 标志加入其中，并通过 F_SETFL 来更新文件描述符，最终实现将该文件描述符切换为非阻塞模式。这意味着，如果没有待处理的连接请求（即没有客户端尝试连接到服务器），accept() 会一直阻塞，直到有新的连接请求到达或发生其他特定条件（如超时）为止。
【动态规划】C++ dp子数组问题（最大/最长：环形/子数组和、乘积最大/为正数、单词拆分、子串）
卜及中的博客
04-22 744
文章介绍了子数组类的dp问题，并通过一系列算法题加深对该类问题的解法理解。
far planner代码系列(2)
09-01
Far planner代码系列（2）是一个用于规划远期计划的代码系列。在代码系列（1）中，我们介绍了如何定义和初始化计划，并实现了基本的计划管理功能。在本系列的第二部分中，我们将继续完善和优化代码。 首先，我们将增加一些新的功能，如删除计划、编辑计划内容、查找计划等。通过这些功能，用户可以更灵活地管理和操作计划。我们将为每个功能设计相应的函数，并在主程序中调用这些函数。 其次，我们将增加用户界面来提高用户体验。使用用户界面，用户可以直观地查看和操作计划。我们可以使用Python的GUI模块，如Tkinter，来实现用户界面。我们将设计一个简单而直观的界面，使用户能够轻松地添加、删除和编辑计划。 此外，我们还将为计划添加更多的信息字段，如优先级、所需资源、开始时间和截止时间等。通过这些信息字段，用户可以更清楚地了解每个计划的重要性和执行条件。我们可以在计划类中添加这些字段，并相应地修改和优化代码。 最后，我们将优化代码的运行效率和性能。一方面，我们可以使用数据结构和算法来优化计划的查找和排序。例如，我们可以将计划存储在一个有序列表中，使用二分查找来快速查找指定计划。另一方面，我们还可以使用线程和进程来并行执行多个计划，提高代码的运行效率。 通过这些改进和优化，Far planner代码系列（2）将成为一个功能完善且性能优良的远期计划管理工具。用户可以方便地创建、查看和操作计划，并在需要时进行调整和更新。这将极大地提高用户的工作效率和时间管理能力。

“相关推荐”对你有帮助么？

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 3
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

LZZ and MYY

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付：¥1
获取中
扫码支付

您的余额不足，请更换扫码支付或充值

打赏作者

实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

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

余额充值