[发明专利]基于多模态信息特征树的机器人实时运动规划方法

摘要

本发明公开了一种基于多模态信息特征树的机器人实时运动规划方法，包括获取环境地图，实时提取机器人的位姿信息，判断特征点对该环境地图的表征度是否已经完备，如果还未完备则使用角速度和距离融合对机器人的节点位姿进行特征初步提取，直到特征点的表征度完备获得最优特征点，得到最终特征点集，更新特征地图；如果已经完备则使用欧式距离对环境地图更新，得到特征地图；然后根据特征点集得到特征矩阵，根据起点、终点以及特征矩阵生成特征点的多模态信息特征树，得到启发式路径。本发明通过构建多模态信息特征树和实时提取特征点的方式快速找出可行区域的候选节点来优化基于随机采样的路径规划，解决陷阱空间、提高移动机器人的智能化。