一种基于Gmapping算法的垃圾分类机器人二维栅格地图构建系统技术方案

本发明专利技术公开了一种基于Gmapping算法的垃圾分类机器人二维栅格地图构建系统,包括以下步骤：S1：启动拾分一体移动式垃圾分类机器人，确认传感器与系统端口连接情况；S2：根据拾分一体移动式垃圾分类机器人上安装的传感器、轮式里程计以及惯性导航模块所采集的数据，基于RBPF粒子滤波算法得到拾分一体移动式垃圾分类机器人的初步位姿；S3：根据估计的拾分一体移动式垃圾分类机器人预测移动轨迹以及传感器模板的观测数据，用更少的粒子即覆盖了机器人位姿的概率分布，提高机器人的工作效率，通过拾分一体移动式垃圾分类机器人对区域中的垃圾进行拾取、分类以及回收，减少广大环保工作者的工作量，减少垃圾分类政策的实施难度、推进绿色城市建设。推进绿色城市建设。推进绿色城市建设。

【技术实现步骤摘要】
一种基于Gmapping算法的垃圾分类机器人二维栅格地图构建系统


[0001]本专利技术涉及视觉导航
，具体为一种基于Gmapping算法的垃圾分 类机器人二维栅格地图构建系统。

技术介绍

[0002]随着SLAM导航技术日益成熟，越来越多工业机器人选择搭载SLAM导航 系统来完成更细致更实用的任务。通过SLAM导航技术，垃圾分类机器人得以 在室外环境或室内大小场所自由灵活移动，同时对区域内的垃圾进行拾取， 分类以及回收。在拾分一体移动式垃圾分类机器人的协助下，城市垃圾分类 工作将会更好的落实到位。
[0003]本方法可以协助拾分一体移动式垃圾分类机器人构建二维栅格室内环境 地图，通过地图自主定点巡航，对区域中的垃圾进行拾取、分类以及回收。 可以更加灵活地应对不同类型的地形，自由移动穿梭室内空间，克服了传统 垃圾分类工作机动性较弱，拾取分类回收工作流程繁琐的缺点。
[0004]因此本方法在已有的技术上，使得垃圾分类工作实施方法灵活简单，实 现难度小，使得垃圾分类机器人可以覆盖多种不同室内场所，从而在减少广 大环保工作者的工作量、减少垃圾分类政策的实施难度、推进绿色城市建设 等方面具有重大意义。

技术实现思路

[0005](一)解决的技术问题
[0006]针对现有技术的不足，本专利技术提供了一种基于Gmapping算法的垃圾分类 机器人二维栅格地图构建系统，具备实施方法灵活简单，实现难度小，等优 点，解决了广大环保工作者的工作量大、垃圾分类政策的实施难度高、绿色 城市建设速度慢的问题。
[0007](二)技术方案
[0008]为实现上述减少广大环保工作者的工作量、减少垃圾分类政策的实施难 度、推进绿色城市建设的目的，本专利技术提供如下技术方案：一种基于Gmapping 算法的垃圾分类机器人二维栅格地图构建系统，包括以下步骤：
[0009]S1：启动拾分一体移动式垃圾分类机器人，确认传感器与系统端口连接 情况；
[0010]S2：根据拾分一体移动式垃圾分类机器人上安装的传感器、轮式里程计 以及惯性导航模块所采集的数据，基于RBPF粒子滤波算法得到拾分一体移动 式垃圾分类机器人的初步位姿；
[0011]S3：根据估计的拾分一体移动式垃圾分类机器人预测移动轨迹以及传感 器模板的观测数据，输入Gmapping算法进行位姿优化，完成二维栅格地图的 构建；
[0012]S4：根据拾分一体移动式垃圾分类机器人的实时位姿数据，可以确定机 器人在地图上的位置，从而完成区域内垃圾拾取分类工作
[0013]优选的，该方法使用基于RBPF的Gmapping算法。
[0014]优选的，矢量均值和协方差的计算公式为：
[0015][0016][0017]优选的，多元正态分布公式如下，可以根据均值和协方差，直接计算得 出后验概率
[0018][0019]优选的，算法流程为：开始初始化粒子群——遍历上一时刻的所有例子 ——取得粒子携带的位姿、权重和地图。
[0020]优选的，取得粒子携带的位姿、权重和地图后借助里程计——更新位姿 后采用极大似然法——求取局部极值，失败进入使用提议分布通过观测模型 继续重复更新位姿步骤。
[0021]优选的，求取局部极值成功进入在局部极值附近取K个位姿——求取K 个位姿的均值、权重和方差通过归一化处理后进入使用多元正态分布近似新 位姿。
[0022]优选的，使用多元正态分布近似新位姿后计算该位姿粒子的权重然后更 新地图与粒子群，然后再次进入遍历上一时刻的所有例子这一步。
[0023](三)有益效果
[0024]与现有技术相比，本专利技术提供了一种基于Gmapping算法的垃圾分类机器 人二维栅格地图构建系统，具备以下有益效果：
[0025]1、该基于Gmapping算法的垃圾分类机器人二维栅格地图构建系统，通 过使用基于RBPF的Gmapping算法。针对粒子耗散，Gmapping通过最近一帧 的观测(scan)，把proposal分布限制在一个狭小的有效区域，然后在正常 的对proposal分布进行采样。如果proposal分布用激光匹配来表示，则可 以把采样范围限制在一个比较小的区域，因此可以用更少的粒子即覆盖了机 器人位姿的概率分布，使得地图更加准确，提高机器人的工作效率。
[0026]2、该基于Gmapping算法的垃圾分类机器人二维栅格地图构建系统，通 过拾分一体移动式垃圾分类机器人对区域中的垃圾进行拾取、分类以及回收， 减少广大环保工作者的工作量。
[0027]3、该基于Gmapping算法的垃圾分类机器人二维栅格地图构建系统，通 过拾分一体移动式垃圾分类机器人对区域中的垃圾进行拾取、分类以及回收， 减少垃圾分类政策的实施难度、推进绿色城市建设。
附图说明
[0028]图1为本专利技术的步骤图。
具体实施方式
[0029]下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行 清楚、完
整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而 不是全部的实施例。
[0030]所述实施例的示例在附图中示出，其中自始至终相同或类似的标号表示 相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的 实施例是示例性的，旨在用于解释本专利技术，而不能理解为对本专利技术的限制。
[0031]在本专利技术的描述中，需要理解的是，术语“中心”、“纵向”、“横向”、“长 度”、“宽度”、“厚度”、“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水 平”、“顶”、“底”“内”、“外”、“顺时针”、“逆时针”、“轴向”、“径向”、“周 向”等指示的方位或位置关系为基于附图所示的方位或位置关系，仅是为了 便于描述本专利技术和简化描述，而不是指示或暗示所指的装置或元件必须具有 特定的方位、以特定的方位构造和操作，因此不能理解为对本专利技术的限制。
[0032]在本专利技术中，除非另有明确的规定和限定，术语“安装”、“相连”、“连 接”、“固定”等术语应做广义理解，例如，可以是固定连接，也可以是可拆 卸连接，或成一体；可以是机械连接，也可以是电连接；可以是直接相连， 也可以通过中间媒介间接相连，可以是两个元件内部的连通或两个元件的相 互作用关系。对于本领域的普通技术人员而言，可以根据具体情况理解上述 术语在本专利技术中的具体含义。
[0033]如图1所示，本专利技术提供一种技术方案：一种基于Gmapping算法的垃圾 分类机器人二维栅格地图构建系统，包括以下步骤：
[0034]S1：启动拾分一体移动式垃圾分类机器人，确认传感器与系统端口连接 情况；
[0035]S2：根据拾分一体移动式垃圾分类机器人上安装的传感器、轮式里程计 以及惯性导航模块所采集的数据，基于RBPF粒子滤波算法得到拾分一体移动 式垃圾分类机器人的初步位姿；
[0036]S3：根据估计的拾分一体移动式垃圾分类机器人预测移动轨迹以及传感 本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于Gmapping算法的垃圾分类机器人二维栅格地图构建系统，其特征在于，包括以下步骤：S1：启动拾分一体移动式垃圾分类机器人，确认传感器与系统端口连接情况；S2：根据拾分一体移动式垃圾分类机器人上安装的传感器、轮式里程计以及惯性导航模块所采集的数据，基于RBPF粒子滤波算法得到拾分一体移动式垃圾分类机器人的初步位姿；S3：根据估计的拾分一体移动式垃圾分类机器人预测移动轨迹以及传感器模板的观测数据，输入Gmapping算法进行位姿优化，完成二维栅格地图的构建；S4：根据拾分一体移动式垃圾分类机器人的实时位姿数据，可以确定机器人在地图上的位置，从而完成区域内垃圾拾取分类工作。2.根据权利要求1所述的一种基于Gmapping算法的垃圾分类机器人二维栅格地图构建系统，其特征在于，所述该方法使用基于RBPF的Gmapping算法。3.根据权利要求1所述的一种基于Gmapping算法的垃圾分类机器人二维栅格地图构建系统，其特征在于，所述矢量均值和协方差的计算公式为：系统，其特征在于，所述矢量均值和协方差的计算公式为：4.根据权利要求1所述的一种基于Gmapping算法的垃圾分类机器人二维栅...

【专利技术属性】
技术研发人员：朱静，黄雅楠，王坤辉，李昂，欧阳淑榆，邓幸维，李冠贤，尹邦政，单梓琪，
申请(专利权)人：广州大学，
类型：发明
国别省市：