一种室内移动机器人增强地图学路径规划方法

摘要

本发明公开了一种室内移动机器人增强地图学路径规划方法，其步骤为：(1)获取周围环境信息，建立障碍概率密度模型；(2)利用贪心算法和增强地图学方法进行路径规划；(3)室内移动机器人路径选择及自适应速度调整策略。采用的增强地图学路径规划能够根据室内移动机器人的当前状况和机器人固有的非完整约束，实时规划当前最佳路径，同时自适应的速度调整策略可以兼顾室内移动机器人的越障能力，目标点收敛能力和规划效率，使室内移动机器人能够安全有效的到达指定位置。

主权项

一种室内移动机器人增强地图学习路径规划方法，其特征在于，包括以下几个步骤：步骤1：建立已探测区域受障碍物影响的概率模型；首先，通过室内移动机器人自身携带的声呐传感器，获得室内移动机器人的周围环境信息；其次，将室内移动机器人所经过的区域作为已探测区域，依据所述的周围环境信息建立已探测区域受障碍物影响的概率模型，并依据声呐传感器实时采集的周围环境信息实时更新已探测区域受障碍物影响的概率模型；所述已探测区域受障碍物影响的概率模型如下：$F(X,Y)=1-\underset{i=1}{\overset{M}{\Pi }}[1-f_i(X,Y)]$其中，室内移动机器人工作空间信息集合为所述空间信息包括所有目标位置及所有障碍物位置；当前探测范围内工作空间信息集合为已探测出的工作空间信息集合为{(X,Y)}为已探测区域，在的地图上探测到有M个障碍物，f_i(X,Y)为第i个障碍物的对室内移动机器人路径选择的影响函数，采用正态分布表示如下：$f_i(X,Y)=\frac{1}{\sqrt{2\pi }{\sigma }_i}{e}^{(-\frac{{D_i}^2}{{2\sigma }_i})}$其中，σ_i为第i个障碍物的影响范围系数，取值范围为[0,1]；D_i为第i个障碍物到已探测区域内所有位置的距离矩阵，矩阵大小与地图大小一致为N*N；步骤2：基于贪心算法和增强学习迭代策略，在设定的最大迭代次数k_max内，迭代更新当前位置p_now(t)与目标位置p_goal之间的路径代价函数，以达到收敛的路径代价函数对应的路径作为当前时刻的最佳路径，具体过程如下：步骤2.1：令k＝1，k表示迭代次数；步骤2.2：判断当前迭代次数是否已超过设定的最大迭代次数，若超过，则返回步骤2.1，；否则，进入步骤2.3；步骤2.3：从获得的周围环境信息对应的已知地图中，随机选择一个位置p_k插入室内移动机器人所在当前位置p_now(t)与目标位置p_goal，其中，p_k满足条件{p_r}为之前迭代最佳路径代价函数下的路径点集合，为室内移动机器人工作空间信息集合；按以下公式计算第k次迭代得到的路径代价函数其中，第k‑1次迭代得到的路径代价函数，且为已知地图上当前位置p_now(t)与所选位置p_k之间的连接权值，为采用贪心算法获得的在第k次迭代完成后获得的从位置p_k到目标位置p_goal的最佳路径代价函数：$G_p^k=\left\{\begin{array}{cc}{R}_{p_k,p_{\mathrm{goal}}}+G_{p_{\mathrm{goal}}}& k=1\\ \min \{R_{p_k,p_{\mathrm{goal}}}+G_{p_{\mathrm{goal}}},R_{p_k,p_{k-1}}+G_p^{k-1}\}& k\ne 1\end{array}\right.$其中，为目标位置p_goal的代价函数，且为已知地图上在第k次所选位置点p_k和第k‑1次所选位置p_k‑1之间的连接权值；在已知地图中任意两位置p_a和p_b之间的连接权值由两位置之间的直线距离和该直线上穿过的障碍物影响概率构成：$R_{p_a,p_b}=d_{p_a,p_b}+\max \left(\underset{C_{p_a,p_b}}{\int }F(X,Y)\mathrm{ds}\right)$其中，为位置p_a到位置p_b两点之间的物理位置距离；为位置p_a到位置p_b的路径点集合，ds为路径积分单元；max()为最大值求函数；步骤2.4：判断迭代后得到的路径代价函数是否已经达到收敛，如果收敛，则退出迭代过程，将已收敛的路径代价函数对应的路径作为最佳路径进入步骤3；否则，将迭代次数k加1，返回步骤2.2；步骤3：以步骤2得到的最佳路径作为室内移动机器人当前的预选择路径，依据预选择路径和室内移动机器人的位置和速度矢量判断室内移动机器人的偏转角φ_t是否满足轮式机器人不能侧向滑动的非完整约束，确定室内移动机器人是否按照预选择路径方向移动：若不满足，则返回步骤2；若满足则以设定的室内移动机器人移动速度沿当前时刻规划出的最佳路径方向移动，进入下一时刻的路径规划，t＝t+1，返回步骤1，直到室内移动机器人移动到目标位置，完成路径规划；所述室内移动机器人的偏转角φ_t是否满足轮式机器人不能侧向滑动的非完整约束是指：φ_t∈[0,60°]∪[120°,180°]；其中，p_t和p_t‑1分别为室内移动机器人当前位置和上一时刻所在位置，为在t时刻，室内移动机器人由规划得到的最佳路径中第一个路径点，即室内移动机器人在t+1时刻的预抵达位置；p_t‑1由p_t‑1＝p_t‑vt得到，v为设定的室内移动机器人移动速度。