一种足式机器人高程估计方法、装置及系统

    公开(公告)号:CN116540206A

    公开(公告)日:2023-08-04

    申请号:CN202310555545.8

    申请日:2023-05-17

    摘要: 本发明提供了一种足式机器人高程估计方法、装置及系统,首先将采集到的激光雷达点云信息进行预处理,然后将点云划分为地面点和非地面点,在非地面点中提取边缘特征点和面特征点,之后通过正态分布变换匹配点云数据,通过计算得到相邻帧间足式机器人的相对位姿变换,将带有高度信息的点云数据映射到高程图中,建立可视化的栅格图。该方法能够在建立三维点云地图、获取以机器人为中心的当前环境定位信息的同时获取机器人周围环境的高度信息,并精细化的反映出局部环境中的高度变化,满足机器人足端落点规划的需求和机器人全局路径规划及实时避障需求。