实时检测地下障碍物的方法及装置

摘要

本发明提供一种实时检测地下障碍物的方法及装置，包括：生成点云数据后，对点云数据进行体素化降采样处理，得到处理后的点云数据；将点云分割成若干块地面断层点云，聚类出若干个点云簇作为地面断层点簇；通过所述地面断层点簇，获取每一个点簇的最大深度位置以及宽度信息，利用所述机器车的位姿约束，得到地面断层的地面面积；根据所述地面断层点簇的位置、大小信息以及所述地面断层的地面面积，得到平面点云信息，获取地下障碍物的信息；本发明所述的方法能够实时提高机器车避障功能的准确性、稳定性。