【论文荐读】基于几何线索提取和圆分解的多机器人复杂场景探索

文摘   科技   2024-03-14 08:33   江苏  


标题:Multi-Robot Multi-Room Exploration With Geometric Cue Extraction and Circular Decomposition

来源:IEEE Robotics and Automation Letters. 2024, 9(2): 1190-1197.
作者:Seungchan Kim, Micah Corah, John Keller, Graeme Best and Sebastian Scherer
单位:Robotics Institute, Carnegie Mellon University, Pittsburgh, PA, USA;School of Mechanical and Mechatroninc Engineering, University of Technology Sydney, Ultimo, NSW, Australia

1、研究背景:

目前,鉴于DARPA地下挑战,多机器人系统在具有现实通信约束、传感器覆盖和计算条件有限的情况下探索大型地下和室内环境越来越受到关注。本文旨在开发一种用于室内环境运行,利用建筑物结构几何特性的多机器人探索算法。
具体而言,本文的目标是为多个机器人在由多个房间组成的建筑内构建探索算法,这些房间的位置和大小事先未知。与基于边界的方法不同,本文明确地对房间的几何形状进行建模,以实现对结构环境的系统探索,使机器人能够逐一探索房间。同时,多机器人团队之间的协调行为,以避免多个机器人进行冗余探索

2、论文创新点:

1)本文扩展了之前的工作,以协调多机器人在由多个房间组成的建筑中进行探索。

(2)合并了两个用于多机器人多房间探索的新模块:1)从3D激光雷达点云数据中检测门和房间位置的几何线索提取方法;2)用于房间表示、目标分配和通信的空间圆分解

3、研究方法:

多机器人多房间(MRMR)探索算法概述如下图1所示,图(a)为由多个房间组成的室内环境,图(b)为机器人根据3D点云数据生成3D占用体素网格图,图(c)为3D体素网格图展平为2D二进制图,图(d)机器人将2D二进制图生成2D距离变换图,图(e) 是从距离变换图中计算鞍点(红色)和局部最大值(黄色),图(f)为自由空间被分解成圆形表示,图(g) 为两个机器人行进的轨迹用不同的颜色进行可视化:
图1 MRMR算法流程图

MRMR探索算法的第一个组成部分:通过几何线索提取来检测门和房间。提取算法如下图2所示:

2 几何线索提取算法示意图

首先,通过机器人机载雷达构建3D点云地图,再将点云地图转换为3D体素地图。其次,如果高度z[zlowzhigh]范围内的任何体素被占用,则通过将2D地图中的点设置为被占用,3D体素网格地图O被平坦化为2D二进制地图B。之后,机器人将中值滤波应用于二进制地图B,然后将B转换为2D距离变换地图M。机器人获得距离图的二阶偏导数矩阵或Hessian矩阵,用于计算获得鞍点和局部最大值。这里的鞍点就是门的位置,局部最大值m就是一个点,与其他相邻像素相比,该点到墙的距离δ最高。在后续自由空间分解中,(m, δ)对将被用作圆的中心和半径。

MRMR探索算法的第二个组成部分:将房间内的自由空间用圆分解表示。分解示意图如下图3所示

图3 自由空间圆分解示意图

对于图(a)和图(b),探测范围为λ的相机和半径为r且与墙壁相切的圆,如果r>λ,即使机器人走到中心,也有观察遗漏。因此本文设置圆分解的半径阈值rthresh=2.5m(r≤rthresh),相机传感器范围λ=5.0m。对于图(c)较大房间,算法1的提取算法通常输出较长的距离δ>λ,需将圆分割成一组半径r较小的圆,并让机器人一个接一个地到达较小圆的中心。自由空间的圆分解并不是静态的,而是机器人根据增量构建的地图来动态分解(如发现一堵新的墙)。如图(d)所示,机器人更新圆的大小,使其与新观察到的墙相邻,如果圆明显重叠,则合并圆,如果圆的半径高于阈值rthresh,则拆分圆,最终实现自由空间用一组相邻圆表示。具体分解圆算法如下图4所示:

图4 自由空间圆分解算法流程图
MRMR探索算法的第三个组成部分:多机器人通信与目标分配。具体通信和分配算法如下图5所示:

图5 多机器人通信和目标分配算法

需要声明的是,本文的多机器人共享世界坐标系。首先对于Communication()函数,多个机器人之间的分布式目标分配,本文利用门和圆作为共享信息。机器人与其他机器人相互共享自己到过的门和圆,这样就把整体环境用鞍点和圆进行紧凑表示,从而实现机器人之间的高效通信。对于TargetDoor()和TargetCircle()函数,当瞄准新的门或圆时,机器人不仅排除了自己到达的门和圆,也排除其他机器人到过的门和圆,避免冗余探索。

最后,MRMR探索算法总体流程如下图6所示,在每个固定时间步长0.1s内,机器人提取几何线索(鞍点、局部最大值和到墙的距离),并更新空间的圆分解。然后,机器人瞄准一扇门,移动到门前并瞄准组成房间的圆。到达第一个圆的圆心后,根据算法选取下一个目标圆,依次完成房间内所有圆的探索,即完成房间的整体探索:

图6 MRMR探索算法总体流程图

本文仿真实验设置了8个不同困难程度的环境,如下图7所示:

图7 设置的8个仿真环境示意图

对比作者之间基于边界的基线方法,采用观察到的体素百分比(占房间总体素的百分比)和房间数量(占房间总数的百分比)两个评价指标,实验结果如下图8所示,MRMR在体素和房间数量方面都优于基线方法:

图8 两种方法实验对比图

实验运行结果图如下图9所示。基于边界的基线方法通过直线移动来快速行进走廊以增加覆盖区域,而不转向门或房间。而MRMR方法快速转向到达门并进入房间,并且能使机器人没有冗余的情况下唯一地访问每个房间:

9 种方法运行结果示意图

最后,在真实实验中,MRMR方法总体上依然比基线方法表现出色。

图10 真实实验结果图

4、结论:

本文提出了一种多机器人多房间自主探索算法(MRMR),该算法系统地探索建筑物中的房间并协调机器人的行为。为此,本文提出了一种几何线索提取方法,该方法从点云中检测门和房间的位置,并对空间进行圆分解以进行目标分配,避免机器人团队冗余探索。

同时,MRMR算法的局限性在于,由于3D体素被平坦化为2D距离变换,该方法仅适用于单层建筑



智能自主无人系统课题组
智能自主无人系统(IAUS)课题组坚持“面向国家重大科技需求,引领行业技术进步”的思路,专注于人工智能技术在自主无人系统、机器人、智能工程装备领域的基础和应用研究,分享和发布最新科研动态及研究成果。
 最新文章