基于遗传算法的移动机器人重定位方法及移动机器人技术

本发明专利技术适用于重定位技术领域，提供了一种基于遗传算法的移动机器人定位方法及移动机器人，包括如下步骤：S1、加载全局地图，将空闲区域作为有效区域；S2、初始化种群；S3、基于最近障碍物距离的似然值来计算初始个体的适应度；S4、选择初始化个体中的最优个体；S5、迭代次数加一，进行迭代操作，即依次进行选择、交叉、变异以及更新最优粒子操作；S6、检测迭代次数是否达到了设定的迭代次数，若检测结果为是，则输出当前的最优个体，对最优个体的浮点数编码进行解码，获取的位姿即最优位姿，基于最优位姿来获取移动机器人在全局地图中的位姿，若检测结果为否，则执行步骤S5。通过遗传算法优越的全局搜索能力，提高重定位系统的鲁棒性、高效性。

Repositioning method and mobile robot based on genetic algorithm

【技术实现步骤摘要】
基于遗传算法的移动机器人重定位方法及移动机器人
本专利技术属于机器人定位
，提供了一种基于遗传算法的移动机器人重定位方法及移动机器人。
技术介绍
定位是移动机器人研究领域最基本的问题之一，已成为移动机器人实现导航、运动规划等自主能力的基础，它是移动机器人借助于传感器确定自身在环境中的位姿。在自动化工厂、智能仓储物流和家用服务等领域，当移动机器人重启或突然被“绑架”到其他位置，机器人会无法定位其位姿，此时需要重新定位机器人当前位置。在现有解决机器人重定位的方案中，有的是在环境中布置辅助设备来实现机器人定位，增加成本的同时也存在较多局限性；有的是采用粒子滤波的定位方法，在解决全局定位和机器人“绑架”问题有较好的表现，但是该方法也存在收敛速度慢，算法容易退化的问题。
技术实现思路
本专利技术实施例提供一种基于遗传算法的移动机器人重定位方法，通过遗传算法优越的全局搜索能力，提高定位系统的鲁棒性、高效性，且无需在环境中布置辅助设备。本专利技术是这样实现的，一种基于遗传算法的移动机器人定位方法，所述方法具体包括如下步骤：S1、加载全局地图，将空闲区域作为有效区域；S2、初始化种群，即设置种群大小、迭代次数、交叉概率、变异概率；S3、基于最近障碍物距离的似然值来计算初始个体的适应度；S4、将初适应度最大值的初始个体作为初始化个体中的最优个体；S5、迭代次数加一，进行迭代操作，即依次进行选择、交叉、变异以及更新最优粒子；S6、选择：计算个体的选择概率，采用轮盘赌的选择法进行概率选择，从种群中选择两个个体作为父方和母方；S7、交叉：检测随机生成概率值是否大于交叉概率，若检测结果为是，则随机把父方和母方的浮点数编码在交叉点进行交换，产生新的个体；S8、变异：检测较随机生成概率是否小于变异概率，若检测结果为是，则进行变异操作，变异操作具体如下：随机选择变异个体，将变异个体的浮点数编码增加或者减少一个小随机数，产生新的个体；S9、更新最优个体：计算各个体的适应度值，将本次迭代中的最大适应度值与上次迭代的最优个体的适应度值进行比较，将适应度值大的个体作为当前的最优个体；S10、检测当前的迭代次数是否达到了设定的迭代次数，若检测结果为是，则输出当前最优个体，对最优个体的浮点数编码进行解码，获取的位姿即最优位姿，基于最优位姿来获取移动机器人在全局地图中的位姿，若检测结果为否，则执行步骤S5。进一步的，个体适应度的计算公式具体如下：式中，F(n)表示第n个个体在当前激光雷达帧中的适应度，dist表示个体与最近障碍物距离，M表示当前激光雷达帧数据中各个体的数量，(x,y)表示最近障碍物在地图中的坐标，(xk,yk)表示个体在地图中的坐标，q(n)表示第n个个体的个体适应度值，zhit、zranddom及zmax分别代表测距误差混合权重的不同部分，分别代表测量噪声、无法解释的随机测量及测量失败，σhit为测量噪声的标准差。本专利技术是这样实现的，一种移动机器人，所述移动机器人包括：激光雷达，激光雷达与处理器连接，处理器与存储器连接，激光雷达扫描环境信息，将扫描到的环境信息发送至处理器，处理器基于权利要求1或权利要求2所述基于遗传算法的移动机器人重定位方法来进行移动机器人的重定位，存储器中存储有全局地图。本专利技术基于遗传算法的来实现移动机器人的重定位，通过遗传算法优越的全局搜索能力，提高定位系统的鲁棒性、高效性，此外，无需在定位区域布置辅助设备，即可实现移动机器人的重定位。附图说明图1为基于遗传算法的移动机器人重定位方法的流程图。具体实施方式为了使本专利技术的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本专利技术进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本专利技术，并不用于限定本专利技术。本专利技术要解决的是机器人出现打滑漂移、人为移动、重启或关机导致的定位失败问题，实现移动机器人的高精度定位。图1为基于遗传算法的移动机器人重定位方法的流程图，该方法具体包括如下步骤：S1、初始化地图：加载全局地图，将空闲区域作为有效区域；全局地图由空闲区域，占用区域及未知区域组成，占用区域即为激光雷达探测存在障碍物的区域，空闲区域即为激光雷达探测不存在障碍物的区域，未知区域即为激光雷达无法探测的区域；S2、初始化种群：设置种群大小、迭代次数、交叉概率、变异概率；S3、计算个体适应度：选择与最近障碍物距离的似然值作为个体的适应度函数，适应度函数表示具体如下：式中，F(n)表示第n个个体在当前激光雷达帧中的适应度，dist表示个体与最近障碍物距离，M表示当前激光雷达帧数据中各个体的数量，(x,y)表示最近障碍物在地图中的坐标，(xk,yk)表示个体在地图中的坐标，q(n)表示第n个个体的个体适应度值，zhit、zranddom及zmax分别代表测距误差混合权重的不同部分，分别代表测量噪声、无法解释的随机测量及测量失败，σhit为测量噪声的标准差。S4、选择粒子中最优个体：将适应度最大值的初始个体作为初始化个体中的最优个体。S5、迭代次数加一，进行迭代计算，即进行选择、交叉、变异以及更新最优粒子操作。S6、选择：计算各个体的选择概率，遵照适应度越高，选择概率越大的原则，采用轮盘赌的选择法进行概率选择，从种群中选择两个个体作为父方和母方，父方和母方用来繁殖后代，每个个体被选择的概率为：式中，n表示种群大小，fi表示第i个个体的适应度。S7、交叉：检测随机生成概率值是否大于交叉概率，若检测结果为是，则随机把父方和母方的浮点数编码在交叉点进行交换，产生新的个体，若检测结果为否，则不进行交叉操作，对个体位姿进行编码，即形成个体的浮点数编码；在本专利技术实施例中，基于随机函数来随机生成的概率称为随机生成概率，浮点编码数值相同数据位即为两浮点编码的交叉点。S8、变异：检测较随机生成概率是否小于变异概率，若检测结果为是，则进行变异操作，若检测结果为否，则比进行变异操作，变异操作具体如下：随机选择变异个体，将变异个体的浮点数编码增加或者减少一个小随机数，产生新的个体。S9、更新最优个体：计算各个体的个体适应度，将本次迭代中的最大适应度值与上次迭代的最优个体的适应度值进行比较，将适应度值大的个体作为当前的最；S10、检测迭代次数是否达到了设定的迭代次数，若检测结果为是，则输出当前最优个体，对最优个体的浮点数编码进行解码，获取的位姿即最优位姿，基于最优位姿来获取移动机器人在全局地图中的位姿，若检测结果为否，则执行步骤S5。本专利技术还提供了一种移动机器人，该移动机器人包括：激光雷达，激光雷达与处理器连接，处理器与存储器连接，激光雷达扫描环境信息，将扫描到的环境信息发送至处理器，处理器基于权利要求1或权利要求2所述基于遗传算法的移动机器人重定位方法来进行移动机器人的重定位，存储器中存本文档来自技高网...

【技术保护点】
1.一种基于遗传算法的移动机器人定位方法，其特征在于，所述方法具体包括如下步骤：/nS1、加载全局地图，将空闲区域作为有效区域；/nS2、初始化种群，即设置种群大小、迭代次数、交叉概率、变异概率；/nS3、基于最近障碍物距离的似然值来计算初始个体的适应度；/nS4、将初适应度最大值的初始个体作为初始化个体中的最优个体；/nS5、迭代次数加一，进行迭代操作，即依次进行选择、交叉、变异以及更新最优粒子；/nS6、选择：计算个体的选择概率，采用轮盘赌的选择法进行概率选择，从种群中选择两个个体作为父方和母方；/nS7、交叉：检测随机生成概率值是否大于交叉概率，若检测结果为是，则随机把父方和母方的浮点数编码在交叉点进行交换，产生新的个体；/nS8、变异：检测较随机生成概率是否小于变异概率，若检测结果为是，则进行变异操作，变异操作具体如下：随机选择变异个体，将变异个体的浮点数编码增加或者减少一个小随机数，产生新的个体；/nS9、更新最优个体：计算各个体的适应度值，将本次迭代中的最大适应度值与上次迭代的最优个体的适应度值进行比较，将适应度值大的个体作为当前的最优个体；/nS10、检测迭代次数是否达到了设定的迭代次数，若检测结果为是，则输出当前的最优个体，对最优个体的浮点数编码进行解码，获取的位姿即最优位姿，基于最优位姿来获取移动机器人在全局地图中的位姿，若检测结果为否，则执行步骤S5。/n...

【技术特征摘要】
1.一种基于遗传算法的移动机器人定位方法，其特征在于，所述方法具体包括如下步骤：
S1、加载全局地图，将空闲区域作为有效区域；
S2、初始化种群，即设置种群大小、迭代次数、交叉概率、变异概率；
S3、基于最近障碍物距离的似然值来计算初始个体的适应度；
S4、将初适应度最大值的初始个体作为初始化个体中的最优个体；
S5、迭代次数加一，进行迭代操作，即依次进行选择、交叉、变异以及更新最优粒子；
S6、选择：计算个体的选择概率，采用轮盘赌的选择法进行概率选择，从种群中选择两个个体作为父方和母方；
S7、交叉：检测随机生成概率值是否大于交叉概率，若检测结果为是，则随机把父方和母方的浮点数编码在交叉点进行交换，产生新的个体；
S8、变异：检测较随机生成概率是否小于变异概率，若检测结果为是，则进行变异操作，变异操作具体如下：随机选择变异个体，将变异个体的浮点数编码增加或者减少一个小随机数，产生新的个体；
S9、更新最优个体：计算各个体的适应度值，将本次迭代中的最大适应度值与上次迭代的最优个体的适应度值进行比较，将适应度值大的个体作为当前的最优个体；
S10、检测迭代次数是否达到了...

【专利技术属性】
技术研发人员：伍永健，陈智君，郝奇，高云峰，曹雏清，
申请(专利权)人：芜湖哈特机器人产业技术研究院有限公司，
类型：发明
国别省市：安徽;34