基于点云处理的仿人机器人楼梯障碍物识别与剔除方法

Obstacle recognition and elimination method for humanoid robots based on point cloud processing

  • 摘要: 环境感知对于仿人机器人自主导航和运动规划具有重要研究意义,是实现仿人机器人在复杂环境中进行自主移动进而完成特定任务的基础. 在特殊的楼梯场景中仿人机器人环境感知过程面临诸多挑战,楼梯障碍物会破坏阶梯平面特征,导致仿人机器人获取不准确的楼梯参数而出现踏空、摔跤等问题. 本文结合区域生长和平面构造方法识别和剔除楼梯障碍物点云,基于剔除障碍物后的楼梯进行三维参数估计. 首先利用相邻点的投影之和最小原理准确完成对楼梯水平面的提取;其次根据区域生长算法判定楼梯障碍物聚类情况,构造平面并分析平面内点数以完成对障碍物点云的快速识别与剔除工作;最后对有障碍物楼梯与剔除障碍物楼梯进行楼梯三维感知实验. 实验结果表明,本文剔除楼梯障碍物的平均精度为92.43%,且剔除后的楼梯参数感知误差仅为有障碍物时的0.5倍. 总体表明所提算法能提高机器人在复杂楼梯环境中的楼梯参数估计精度,能够有效提高仿人机器人在复杂楼梯环境下的感知能力.

     

    Abstract: Understanding environmental perception is crucial for the autonomous navigation and motion planning of humanoid robots, especially in complex environments. Staircases pose a significant challenge as obstacles on them can disrupt planar features, leading to inaccurate parameter acquisition and potential missteps or falls. This study employs a methodology that integrates region growing and plane construction techniques. Initially, a depth camera captures the point clouds. Improved voxel filtering and straight pass filtering are applied to effectively eliminate noise, reduce data volume, and improve algorithm processing speed. The KD-Tree algorithm is then used to establish point cloud topology. By minimizing the sum of projections of neighboring points, the algorithm estimates normal vectors and accurately extracts staircase levels based on plane normal vector constraints. The region-growing clustering algorithm with adaptive parameters recognizes stair obstacles by defining cluster boundaries using statistical properties and principles. Individually clustered obstacles are then eliminated by assessing the region’s minimum points, whereas non-individually clustered obstacles are identified based on the maximum number of points in the region. Subsequently, the plane is constructed, and obstacles are eliminated by analyzing point mutations within the plane. In this study, obstacle elimination experiments were conducted using data from various obstacle-impaired staircases of inaccessible types. The data and experimental results were recorded and analyzed. Additionally, experiments were conducted to estimate staircase parameters with and without obstacle rejection. The elimination experiments demonstrate that the average correct rate for removing individually clustered obstacle point clouds is 92.13%, whereas non-individually clustered obstacles are removed with a 92.72% accuracy, leading to an overall elimination accuracy of 92.43%. These findings indicate the effectiveness of the proposed method in precisely identifying and eliminating various obstacles in staircase environments. In stair parameter estimation experiments, obstacles significantly hinder the humanoid robot’s ability to accurately measure step height and depth. The experimental results demonstrate that the maximum height error in stair parameter estimation when obstacles were present reached 30.55%, with the overall average relative error being 16%. However, once obstacles were removed, the errors in three-dimensional height measurements decreased to 8.53%, and the overall perception error dropped to approximately 7%. The average relative error in height is reduced to approximately 25% of that when obstacles are present, whereas the overall perception error decreases to about 50% of the error observed with obstacles. These findings highlight the profound impact obstacles have on stair perception and demonstrate that removing them substantially enhances the accuracy of stair parameter estimation.

     

/

返回文章
返回