近日,无翼鸟
智能电磁感知团队在机器人领域国际顶级期刊《IEEE Robotics and Automation Letters》发表论文“Path Planning for Mobile Robots Based on Hybrid Sampling and Space-Optimized RRT”,第一作者为硕士研究生胡耀炜,通讯作者为副教授汤萍萍。
该团队在安徽省智能机器人信息融合与控制工程研究中心的支持下自主研发智能导航系统,而路径规划是智能导航系统的核心,当前热门的RRT路径规划方法在智能导航系统的应用存在诸多问题,如路径冗余节点过多、路径平滑度太低、运算时间较长、极易产生局部最优解。为此,本文提出混合采样和空间优化的HB-RRT算法。首先,采用混合采样代替原有的随机采样,混合采样由高斯采样和并行采样构成。混合采样在采样过程中对随机点采样空间进行优化,不断改变采样区域提高采样效率;在扩展过程中基于势场的扩展策略并结合自适应扩展步长减少过度的探索。其次,为克服贪婪双向搜索带来的性能不稳定性,提出一种前后向路径优化方法,修改双向搜索的交换策略,并结合直连策略快速规划出初始路径。最后,为更好地实现智能导航系统的跟踪控制,设计了一种分段B样条路径平滑器。
研究团队在多样的真实环境中验证HB-RRT的有效性,以及与当前热门算法相比的优越性,对比算法包括Bi-RRT、IBi-RRT和RB-RRT。为保证对比公平性,每种算法使用相同的碰撞检测、数据处理等子程序,算法的扩展步长均设置为30。考虑到基于采样的算法的随机性,在每种实验场景下,四种规划算法都执行50组独立实验,规划时间、路径长度、采样次数和路径节点数以平均值的形式表示,以确保实验数据的准确性。从表1可以看出,在任何实验环境下,HB-RRT都以更短的规划时间和更少的采样点得到质量更高的路径,节点利用率最高、标准差最小,算法性能更稳定。

图1 室内和室外实验环境举例
表1 性能比较
Environment | Algorithm | Average time(s) | Standard deviation | Mean samples | Mean length | Mean nodes | Node utilization |
Map1 | Bi-RRT | 2.92 | 0.417 | 152.3 | 1098.4 | 39.2 | 56.4% |
IBi-RRT | 1.65 | 0.352 | 83.4 | 771.9 | 8.4 | 69.6% |
RB-RRT | 1.13 | 0.304 | 61.9 | 765.7 | 7.8 | 74.8% |
HB-RRT | 0.89 | 0.182 | 47.1 | 738.2 | 7.1 | 83.6% |
Map2 | Bi-RRT | 2.67 | 0.296 | 143.6 | 1160.1 | 43.6 | 62.1% |
IBi-RRT | 1.70 | 0.231 | 85.2 | 815.6 | 7.4 | 74.3% |
RB-RRT | 1.22 | 0.218 | 68.5 | 806.3 | 7.3 | 77.6% |
HB-RRT | 0.91 | 0.167 | 49.3 | 781.7 | 6.2 | 85.2% |
Map3 | Bi-RRT | 2.62 | 0.238 | 139.7 | 738.2 | 28.4 | 50.3% |
IBi-RRT | 1.32 | 0.246 | 71.9 | 435.3 | 4.9 | 64.1% |
RB-RRT | 1.13 | 0.201 | 53.0 | 469.7 | 4.7 | 71.2% |
HB-RRT | 0.44 | 0.104 | 18.2 | 428.6 | 4.1 | 80.1% |
Map4 | Bi-RRT | 2.16 | 0.243 | 114.5 | 818.8 | 31.8 | 66.2% |
IBi-RRT | 0.97 | 0.237 | 51.2 | 645.3 | 5.5 | 78.3% |
RB-RRT | 0.68 | 0.189 | 36.7 | 605.7 | 5.1 | 81.6% |
HB-RRT | 0.54 | 0.091 | 25.6 | 581.3 | 4.3 | 88.7% |
Map5 | Bi-RRT | 3.82 | 0.643 | 210.4 | 1240.1 | 46.2 | 41.3% |
IBi-RRT | 2.64 | 0.803 | 132.2 | 997.0 | 15.4 | 52.6% |
RB-RRT | 2.15 | 0.487 | 112.8 | 935.6 | 12.1 | 60.2% |
HB-RRT | 1.68 | 0.356 | 91.5 | 870.8 | 10.3 | 70.3% |