[发明专利]一种基于启发式偏置采样的室内环境机器人探索方法

权利要求书

1.基于启发式偏置采样的室内环境机器人探索方法，其特征在于，包括：

A、初始化；

B、进行定位和建图；

C、在地图的空闲区域生长两棵快速搜索随机树，利用所述两棵快速生长随机树进行边界点的提取，记为RRT边界点；进行启发式物体的识别并获取启发式物体的位置信息，以启发式物体的位置构造先验区域，在所述先验区域内通过偏置采样快速搜索随机树算法提取边界点，记为房间边界点；剔除RRT边界点和房间边界点中的无效边界点；

D、当房间边界点存在时，机器人优先选择收益值最大的房间边界点作为目标点进行探索，并在所有房间边界点探索完成后对RRT边界点进行探索，且优先选择收益值最大的RRT边界点作为目标点进行探索；

E、引导机器人向目标点导航并更新地图；

F、当先验区域内检测不到边界点时，销毁先验区域；

G、循环步骤A-F，直至完成整个环境探索；

在所述先验区域内通过偏置采样快速搜索随机树算法提取边界点，记为房间边界点；具体包括：

C21、将启发式物体的位置添加到树结构中作为根节点；

C22、偏置采样快速搜索随机树算法每次使用一个随机函数来决定采用哪一种采样方式；所述采样方式包括均匀随机采样和偏置采样；

C23、遍历树结构上的所有已有的节点，选取距离候选点最近的节点作为最邻近点，最邻近点到候选节点的连线作为生长方向；如果最邻近点与候选节点的距离超过预先设定的步长，则由最邻近点沿着生长方向生长一个步长，到达的点作为生长点；如果距离不超过步长，则该候选点作为生长点；

C24、将生长点和候选节点的连线在地图上做碰撞检测，碰撞测试通过则进入步骤C25，否则返回步骤C22；

C25、判断通过碰撞测试的生长点是否为边界点，并改变部分边界点的栅格状态；

C26、根据当前时刻的边界点数目与总边界点数目之比计算覆盖率。

2.如权利要求1所述的基于启发式偏置采样的室内环境机器人探索方法，其特征在于，步骤B具体包括：通过SLAM模块接收传感器数据，更新部分地图为已知的区域，同时通过SLAM模块构建的地图反过来修正机器人的位姿。

3.如权利要求1所述的基于启发式偏置采样的室内环境机器人探索方法，其特征在于，所述两棵快速搜索随机树分为全局树和局部树，全局树和局部树均通过以下步骤进行RRT边界点的提取；具体包括：

C11、将起点添加到树结构中作为根节点，两棵快速搜索随机树的起点都是人为在地图的空闲区域内设定的；

C12、在地图区域内随机撒点作为候选点；

C13、若该候选点在已知区域内，则遍历树结构上的所有已有的节点，选取距离候选点最近的节点作为最邻近点，以最邻近点到候选节点的连线作为生长方向；如果最邻近点与候选节点的距离超过预先设定的步长，则由最邻近点沿着生长方向生长一个步长，到达的点作为生长点；如果距离不超过步长，则该候选点作为生长点；

若候选点在未知区域内，则先找到该候选点的最邻近节点，最邻近点到候选点的连线作为生长方向，然后由最邻近点沿着生长方向向前生长，到达边界的地方作为边界点；

C14、将生长点和候选节点的连线在地图上做碰撞检测，通过遍历这条直线上所有的栅格点，然后判断该栅格点的栅格状态，如果该栅格点的状态是被障碍物占据的，则碰撞检测不通过，返回步骤C12重新进行采样；如果连线没有碰到障碍物，就将该候选点、生长点和候选节点的连线添加到树结构中；

其中，当局部树探测到边界点后，局部树会被清除并在机器人当前位置重新生长。

4.如权利要求1所述的基于启发式偏置采样的室内环境机器人探索方法，其特征在于，步骤C24具体包括：遍历生长点和候选节点的连线所在直线上的所有的栅格点，然后判断该栅格点的栅格状态，如果该栅格点的状态是被占据的或者是未知的，则碰撞检测不通过，返回步骤C22重新进行采样；如果连线没有碰到障碍物和未知区域，则将该候选点、生长点和候选节点的连线添加到树结构中。