Far planner代码系列(31)is_covered

本文深入探讨了自动驾驶路径规划中UpdateNavGraph函数中is_covered属性的判断过程,通过IsNodeFullyCovered函数分析如何确定节点是否被覆盖。讲解了在距离、边缘投票和方向向量比较的基础上,如何利用单位向量和角度噪声来判断覆盖情况,并结合CONVEX节点类型进行了详细解释。
摘要由CSDN通过智能技术生成

        今天讲的是UpdateNavGraph函数里的分析每个node的is_covered属性和is_frontier属性。

我们看代码,代码里把near_nav_nodes里的点挨个都取出来判断该node是不是is_covered,通过IsNodeFullyCovered函数来判断。

        

         IsNodeFullyCoveredIsNodeFullyCovered函数首先判断输入的node是不是odom或者navpoint或者该node的is_covered属性本身就为true。如果是的话,直接返回true

        我们建立一个check_odom_list去接收internav_near_nodes_,并且把odom本身也push进去,即check_odom_list = [internav_near_nodes_ , odom_node_ptr_]

        开始循环提取check_odom_list的点,取叫ne

  • 1
    点赞
  • 1
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 1
    评论
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

打赏作者

LZZ and MYY

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

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

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

打赏作者

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

抵扣说明:

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

余额充值