一种基于最近距离向量场直方图的避障路径规划方法

    公开(公告)号:CN103455034A

    公开(公告)日:2013-12-18

    申请号:CN201310421218.X

    申请日:2013-09-16

    Abstract: 本发明提供一种基于最近距离向量场直方图的避障路径规划方法,包括以下步骤。S1、将机器人当前扫描范围均分为n个扇区,若第k个扇区内的障碍物距离机器人中心点的最近距离向量为NDVk,获取|NDVk-1-NDVk|≤与机器人直径比较,根据比较结果得到机器人当前位置的局部环境中障碍物个数。S2、设定最小避障阈值ns,若NDVk≥ns,则扇区k的角度范围为避障区间,否则为自由行走区间。S3、确定瞬时目标点的搜索范围,并在所述搜索范围中获取瞬时目标点,机器人运动到达所述瞬时目标点后,确定新的瞬时目标点并向新的瞬时目标点运动,直至到达终点。

Patent Agency Ranking