用于移动机器人在非平面环境自主探索的导引点选取方法

摘要

本发明公开了一种用于移动机器人在非平面环境自主探索的导引点选取方法，包括以下步骤：1）按顺序获取3D激光雷达采集的激光帧数据并确定运动轨迹；2）根据激光帧与其对应位姿构建机器人坐标系下的高程地图；3）根据高程地图计算初始导引点集合以及每个栅格的坡度与粗糙度信息；4）对初始导引点集合进行mean‑shift聚类以及计算到聚类点的路径5）根据聚类导引点以及地图几何信息生成最优导引点。本发明的自主导航的导引点选取方法充分考虑了移动机器人的运动特性，导引点的选取充分考虑了时间成本，空间成本以及安全三大要素，可用于移动机器人在非平面环境下的自主快速且安全的探索。