[发明专利]一种室内导盲机器人在动态环境下的路径规划方法

说明书

一种室内导盲机器人在动态环境下的路径规划方法，通过生成环境的栅格地图、膨胀处理、给定目标点、采集地图信息、规划出一条全局路线、局部路径规划、避障及返回全局路线的方式，完成任意动态环境下的导盲机器人的路线规划及运动；降低了局部避障的随机性，提高了动态环境下避障的可靠性；随机路图法避免局部极小值，考虑规划效率，不会增加计算量；导盲机器人会尽可能的沿着全局路线行走，这样大大的保证了盲人在行进过程中的安全。

(一)技术领域：

本发明属于机器人相关技术领域，是一种导盲机器人路径规划算法的设计，特别是一种室内导盲机器人在动态环境下的路径规划方法。

(二)背景技术：

导盲机器人可以为盲人的出行带来方便，一般用在家庭、商场、医院等场所。在这些场景中，会同时存在静态障碍物和动态障碍物，这对于导盲机器人来说是一个挑战。对于已知的静态障碍物导盲机器人可以很好的躲避，但是当环境中的信息发生了改变，这时候就需要导盲机器人利用局部规划器躲避障碍物了。局部路径是需要实时规划的，这就表示局部规划器对实时信息的依赖性比较大。

人工势场法是根据物理学中力学的原理提出的一种虚拟力法，它的中心思想是让障碍物产生对导盲机器人的斥力场，在目标点周围形成引力场，导盲机器人在这两个场的作用下进行运动。人工势场法具有比较好的实时性，满足局部规划的条件，但是该方法存在局部最优点问题，而且在躲避障碍物的时候存在随机性，这对于导盲机器人来说是需要避免的，减小局部规划中的随机性可以大大提高导盲机器人的安全性。

随机路图法(PRM——Probabilistic Road Maps)在规划空间中随机的选取一些点，然后将这些点进行连接，将穿过障碍物的连线去掉，最终得到一个随机路图供查询路径。随机路图法面对环境中复杂的障碍物时也能很好的解决，它克服了路径规划中易于出现局部极小的缺点。

(三)发明内容：

本发明的目的在于提供一种室内导盲机器人在动态环境下的路径规划方法，针对导盲机器人无法提前检测到的动态区域，采用人工势场法和随机路径图法进行局部规划，使导盲机器人可以安全的避开动态障碍；本发明降低了局部避障的随机性，避免规划的路径陷入局部极小值，尽可能让导盲机器人沿着全局路线行走，是一种简单易行的路径规划方法。

一种室内导盲机器人在动态环境下的路径规划方法，其特征在于它包括以下步骤：

(1)生成导盲机器人工作地点所在环境的栅格地图，并对该地图中的障碍物进行膨胀处理，通过调节inflation_radius障碍物膨胀参数，使最佳路径尽可能远离每侧的障碍物，因此机器人可以在障碍物中间移动；

(2)给定导盲机器人需要到达的目标点，导盲机器人将目标点确定在栅格地图相应的位置上，并根据当前的位置、需要到达的目标点以及提前采集好的栅格地图，利用静态路网中求解最短路径最有效的直接搜索方法，简称A*算法，该算法是一种启发式搜索方法，在搜索中加入了与问题有关的启发性信息，指导搜索朝最有希望的方向进行，用于搜索状态空间的最短路径。通过该算法规划出一条全局路线，使导盲机器人之后的行动始终围绕这条路径进行，此路径是基于事先扫描的静态地图的；

(3)若此时室内摆放的东西位置发生了变化，即障碍物与静态地图上的不同，则导盲机器人要根据障碍物出现的位置进行局部路径规划对障碍物进行躲避；

(4)导盲机器人按照规划路径向目标点移动，当导盲机器人检测到前方有障碍物时，机器人先减速并对障碍物的大小和周围环境进行估计，并向比较容易躲避的方向偏转，然后利用人工势场法将导盲机器人的路径重新规划到躲开障碍物的地方，并可以根据激光雷达反馈的数据得知障碍物后方的具体情况；

(5)当导盲机器人成功的检测到了障碍物后面的实际情况后，根据步骤(1)规划出的全局路径和导盲机器人当前的位置及姿态，在它能够看到障碍物后方的全局路线上寻找一个合适的点作为局部目标点，使导盲机器人能够再次行驶到全局路线上来；同时利用随机路径图法规划导盲机器人当前位置到局部目标点之间的路径。