狭窄空间的多层次场景重建和快速分割方法、系统及装置

摘要

本发明属于机器人场景重建领域，具体涉及了一种狭窄空间的多层次场景重建和快速分割方法、系统及装置，旨在解决狭窄空间下机器人场景重建及分割无法兼顾重建精度与计算实时性的问题。本发明包括：取彩色图像、深度图像、相机标定数据及机器人空间位置和姿态信息；通过坐标变换将传感器数据转换为单帧点云；对单帧点云进行尺度划分，分别进行光线追踪和概率更新，得到尺度融合后的多层次场景地图；对场景地图执行两次降采样和一次升采样，借助尺度进行无损变换，并基于空间分割结果建立多个子八叉树地图，实现多层次场景重建和快速分割。本发明在不损失场景必要细节的前提下，实现了稠密重建及算法加速，更有利于实际工程场合的应用。