一种扫地机全覆盖路径规划方法技术

本发明专利技术涉及一种扫地机全覆盖路径规划方法。本方法的具体操作步骤为：1）地图构建，2）多角度扫线分割，3）贪婪初始化，和4）自适应遗传算法处理。本发明专利技术寻找扫地机转弯次数最少的分割角度，使扫地机具有更高的清扫效率。本发明专利技术优化了各子区域间的遍历路线，缩短了清扫时间，从而进一步提高其清扫效率。

A Full Coverage Path Planning Method for Sweeper

The invention relates to a sweeper full coverage path planning method. The specific operation steps of this method are: 1) map building, 2) multi-angle sweep line segmentation, 3) greedy initialization, and 4) adaptive genetic algorithm processing. The invention seeks for the cutting angle with the least turning times of the sweeper, so that the sweeper has higher sweeping efficiency. The invention optimizes the traversing route among the sub-regions, shortens the cleaning time, and further improves the cleaning efficiency.

【技术实现步骤摘要】
一种扫地机全覆盖路径规划方法
本专利技术涉及机器人的自主定位与未知环境的地图构建和路径规划领域，具体涉及一种扫地机全覆盖路径规划方法。
技术介绍
全覆盖路径规划算法是移动机器人智能导航中的重要分支，所谓全覆盖指的是要求机器人去寻找一条能够遍历当前环境中所有区域的路径。全覆盖路径规划算法在军事、农业等多个领域都有着广泛的应用。研究扫地机全覆盖路径规划的目的就是要使扫地机更加高效的遍历清扫目标区域内所有空白区域，同时尽可能避免在已遍历区域重复行走。从而使得扫地机总的清扫路径最优，消耗能源最少。这对一个稳定高效的扫地机清扫系统来说意义重大。而现有的扫地机在实际清扫时存在着在某些区域重复行走的问题，降低了清扫效率。
技术实现思路
本专利技术的目的在于针对已有的技术的不足，提供一种能提高清扫效率的扫地机全覆盖路径规划方法。为达到上述目的，本专利技术所采用的技术方案为：一种扫地机全覆盖路径规划方法，具体操作步骤如下：1)地图构建：扫地机在未知室内环境行走，行走的同时获取扫地机附近的局部二维栅格地图my(1≤y≤n)，扫地机在室内行走一遍后将已获取的局部二维栅格地图m1,m2,…mn组合成为整个室内环境的二维栅格地图M；2)多角度扫线分割：扫地机通过不同角度扫线将二维栅格地图M分割成有限个子区域M1,M2,…Ma；3)贪婪初始化：对分割后的子区域M1,M2,…Ma进行贪婪初始化排序；4)自适应遗传算法处理：将初始化后的各子区域模拟成旅行商模型，利用自适应遗传算法求取扫地机遍历各子区域的最优连接路径。作为一种优选方案，所述步骤1)地图构建：扫地机利用深度相机传感器数据z1:t＝z1,z2…zt和里程计数据u1:t＝u1,u2…ut,通过联合概率分布：p(x1:t,my|z1:t,u1:t)＝p(my|x1:t,z1:t)*p(x1:t|z1:t,u1:t)来计算机器人的运行轨迹x1:t＝x1,x2…xt和局部二维栅格地图my(1≤y≤n),最后将所有二维局部栅格地图m1,m2,…mn组合成为整个室内环境的二维栅格地图M。作为一种优选方案，所述步骤1)地图构建中在获得局部二维栅格地图my(1≤y≤n)后，可通过深度相机的三维传感器数据，取其在竖直方向上的最小深度数据Zmin＝min(Z1,Z2…Zt)并将其映射到当前局部二维栅格地图my(1≤y≤n)当中，并利用牛顿迭代法对扫地机位姿约束进行优化处理，从而提高局部二维栅格地图my(1≤y≤n)与实际室内环境的一致性。作为一种优选方案，所述步骤2)多角度扫线分割：扫地机以倾斜角为θ的扫线将二维栅格地图M分割成有限个子区域M1,M2,…Ma，对于二维栅格地图M，S(θ)为各子区域在θ+Π/2方向上的转弯次数总和，当S(θ)取得最小值时，此时的θ即为目标区域的分割方向。作为一种优选方案，所述步骤3)贪婪初始化：对于分割完毕的各子区域，首先选择距离机器人当前位置最近的子区域Mcurrent并加入到种群中，对其他各个子区域进行搜索，找到距离Mcurrent最近的子区域Mnext，将其添加到自适应遗传算法中，将其作为计算的初始值，由此循环，继续寻找并添加下一个最近子区域，直到所有子区域都搜寻完毕并加入到了自适应遗传算法中作为初始值。作为一种优选方案，所述步骤4)自适应遗传算法处理：交叉概率Pj实现了种群的迭代和更新，设置Pj的自适应机制如下：式中Pji为个体i的交叉概率，初始时刻交叉概率较高，迭代后期则较小趋于稳定，Pjmin取值为0.5，fi为个体i的适应度，fmax为当前个体中最大的适应度，为种群的平均适应度，Pjmax的取值随着迭代次数的变化而变化，如下所示：式中G为最大迭代次数，g为当前迭代次数。本专利技术与现有技术相比较，具有如下显而易见的突出实质性特点和显著技术进步：由于采用多角度扫线分割方式，充分考虑了各种切割方向，从而寻找到了使得扫地机转弯次数最少的分割角度，使扫地机具有更高的清扫效率。由于采用了贪婪初始化与自适应遗传算法对各个子区域的联通问题进行求解，优化了各个子区域间的遍历路线，缩短了清扫时间，从而进一步提高扫地机的清扫效率。由于在步骤a)中获得了局部二维栅格地图my(1≤y≤n)后，通过深度相机的三维传感器在竖直方向上的最小深度数据zmin＝min(z1,z2…zt)并将其映射到当前局部二维栅格地图my(1≤y≤n)当中，并利用牛顿迭代法对扫地机位姿约束进行优化处理，提高了局部二维栅格地图my(1≤y≤n)与实际室内环境的一致性，从而提高了整个室内环境的二维栅格地图M的精确度。附图说明图1是本专利技术的流程框图。具体实施方式下面结合附图，详细描述本专利技术的优选实施例。实施例一：参见图1本扫地机全，一种扫地机全覆盖路径规划方法，具体操作步骤如下：1)地图构建：扫地机在未知室内环境行走，行走的同时获取扫地机附近的局部二维栅格地图my(1≤y≤n)，扫地机在室内行走一遍后将已获取的局部二维栅格地图m1,m2,…mn组合成为整个室内环境的二维栅格地图M；2)多角度扫线分割：扫地机通过不同角度扫线将二维栅格地图M分割成有限个子区域M1,M2,…Ma；3)贪婪初始化：对分割后的子区域M1,M2,…Ma进行贪婪初始化排序；4)自适应遗传算法处理：将初始化后的各子区域模拟成旅行商模型，利用自适应遗传算法求取扫地机遍历各子区域的最优连接路径。实施例二：本实施例与实施例一基本相同，特别之处如下：1.所述步骤1)地图构建：扫地机利用深度相机传感器数据z1:t＝z1,z2…zt和里程计数据u1:t＝u1,u2…ut,通过联合概率分布：p(x1:t,my|z1:t,u1:t)＝p(my|x1:t,z1:t)*p(x1:t|z1:t,u1:t)来计算机器人的运行轨迹x1:t＝x1,x2…xt和局部二维栅格地图my(1≤y≤n),最后通过所有局部二维栅格地图m1,m2,…mn组合成为整个室内环境的二维栅格地图M。2.所述步骤1)地图构建中在获得局部二维栅格地图my(1≤y≤n)后，可通过深度相机的三维传感器数据，取其在竖直方向上的最小深度数据zmin＝min(z1,z2…zt)并将其映射到当前局部二维栅格地图my(1≤y≤n)当中，并利用牛顿迭代法对扫地机位姿约束进行优化处理，从而提高局部二维栅格地图my(1≤y≤n)与实际室内环境的一致性。3.所述步骤2)多角度扫线分割：扫地机以倾斜角为θ的扫线将二维栅格地图M分割成有限个子区域M1,M2,…Ma，对于二维栅格地图M，S(θ)为各子区域在θ+П/2方向上的转弯次数总和，当S(θ)取得最小值时，此时的θ即为分割角度。4.所述步骤3)贪婪初始化：对于分割完毕的各子区域，首先选择距离机器人当前位置最近的子区域Mcurrent并加入到种群中，对其他各个子区域进行搜索，找到距离Mcurrent最近的子区域Mnext，将其添加到自适应遗传算法中，将其作为计算的初始值，由此循环，继续寻找并添加下一个最近子区域，直到所有子区域都搜寻完毕并加入到了自适应遗传算法中作为初始值。5.所述步骤4)自适应遗传算法处理：交叉概率Pj实现了种群的迭代和更新，设置Pj的自适应机制如下：式中Pji为个体i的交叉概率，初始时刻交叉概率较高，迭代后期则较小趋于稳定，Pjmin取值为0.5本文档来自技高网...

【技术保护点】
1.一种扫地机全覆盖路径规划方法，其特征在于：具体操作步骤如下：1)地图构建：扫地机在未知室内环境行走，行走的同时获取扫地机附近的局部二维栅格地图my(1≤y≤n)，扫地机在室内行走一遍后将已获取的局部二维栅格地图m1,m2,…mn组合成为整个室内环境的二维栅格地图M；2)多角度扫线分割：扫地机通过不同角度扫线将二维栅格地图M分割成有限个子区域M1,M2,…Ma；3)贪婪初始化：对分割后的子区域M1,M2,…Ma进行贪婪初始化排序；4)自适应遗传算法处理：将初始化后的各子区域模拟成旅行商模型，利用自适应遗传算法求取扫地机遍历各子区域的最优连接路径。

【技术特征摘要】
1.一种扫地机全覆盖路径规划方法，其特征在于：具体操作步骤如下：1)地图构建：扫地机在未知室内环境行走，行走的同时获取扫地机附近的局部二维栅格地图my(1≤y≤n)，扫地机在室内行走一遍后将已获取的局部二维栅格地图m1,m2,…mn组合成为整个室内环境的二维栅格地图M；2)多角度扫线分割：扫地机通过不同角度扫线将二维栅格地图M分割成有限个子区域M1,M2,…Ma；3)贪婪初始化：对分割后的子区域M1,M2,…Ma进行贪婪初始化排序；4)自适应遗传算法处理：将初始化后的各子区域模拟成旅行商模型，利用自适应遗传算法求取扫地机遍历各子区域的最优连接路径。2.根据权利要求1所述的一种扫地机全覆盖路径规划方法，其特征在于：所述步骤1)地图构建：扫地机利用深度相机传感器数据z1:t＝z1,z2…zt和里程计数据u1:t＝u1,u2…ut,通过联合概率分布：p(x1:t,my|z1:t,u1:t)＝p(my|x1:t,z1:t)*p(x1:t|z1:t,u1:t)来计算机器人的运行轨迹x1:t＝x1,x2…xt和局部二维栅格地图my(1≤y≤n)，最后通过所有局部二维栅格地图m1,m2,…mn组合成为整个室内环境的二维栅格地图M。3.根据权利要求2所述的一种扫地机全覆盖路径规划方法，其特征在于：所述步骤1)地图构建中在获得局部二维栅格地图my(1≤y≤n)后，可通过深度相机的三维传感器数据，取其在竖直方向上的最小深度数据zmin＝min(z1,z2…zt)并将其映射到当前...

【专利技术属性】
技术研发人员：胡越黎，燕明，刘思齐，
申请(专利权)人：上海大学，
类型：发明
国别省市：上海,31