基于可变形拓扑地图的服务机器人自主导航方法
专利汇可以提供基于可变形拓扑地图的服务机器人自主导航方法专利检索，专利查询，专利分析的服务。并且一种 机器人 导航技术领域的基于可 变形 拓扑地图的服务 机器人自主导航 方法，通过SLAM技术实时地采集机器人所在的室内外环境的地形 地貌 状况，进行环境特征提取，对采集的信息进行拓扑地图的创建，并且在此 基础 上根据服务机器人的 姿态 变化制定出所需的不同的拓扑点的尺寸，将这些不同的尺寸作为输入量，对于拓扑地图进行重构，生成符合 移动机器人 姿态变化的拓扑点自适应性的拓扑地图。，下面是基于可变形拓扑地图的服务机器人自主导航方法专利的具体信息内容。
1，一种基于可变形拓扑地图的服务机器人自主导航方法，其特征在于，包 括以下步骤：
第一步、首先依次将激光三维扫描传感器、倾斜传感器和6个超声波传感 器分别并联至服务机器人并将超声波传感器分别安装于服务机器人的周围，然 后设置激光三维扫描传感器以1毫秒为采样周期采集环境数据并进行模数转换， 得到原始三维环境数据；再设置倾斜传感器测得该倾斜传感器与地面的夹角以 及激光三维扫描传感器与地面的夹角作为夹角数据，最后记录超声波传感器测 得的服务机器人与前方障碍物的距离数据；
第二步、服务机器人通过原始三维环境数据获得相对坐标并结合夹角数据 标定出绝对坐标；然后根据距离数据进行三维场景分割，在以1毫秒为单位的 三维分割场景的基础上进行局部三维场景重建，生成局部三维场景信息；最后 通过扩展卡尔曼滤波的定位算法将局部三维场景信息通过鲁棒性的预测，每一 个时间点环境细节的匹配融合处理后生成全局三维场景；
第三步、首先以服务机器人的各种姿态所占的投影面积中的最小值作为栅 格，并以此栅格为单位将全局三维场景栅格化，然后应用腐蚀-剪裁算法在全局 三维场景中计算栅格化相关值并根据拓扑点判断的结果决定是否应该修改对应 栅格的标记值，最终生成服务机器人运动路径拓扑地图；
第四步、根据服务机器人的姿态变化在地面的投影制定出对应的栅格，然后 依据蒙特卡罗配比法生成标准栅格，此处所述的蒙特卡罗配比法是基于蒙特卡 罗算法的一种扩展算法，同时，标准栅格的另外一个作用是，能标准栅格作为 预输入量，进行全局三维场景的栅格化；
第五步、依据服务机器人的姿态变化在地面的投影制定出对应的栅格的个 数创建旋转矩阵的维数，对原有的拓扑点进行计算，在机器人导航过程中，首先 以尺寸最大的拓扑点进行导航，导航的过程中同样依靠栅格地图，但当遇到较 狭窄环境后，将机器人的尺寸变小，变为较小的拓扑点，当相应的环境变窄， 机器人的尺寸也相应变小，即标准栅格的组合数变小。
2、根据权利要求1所述的基于可变形拓扑地图的服务机器人自主导航方法， 其特征是，所述的全局三维场景栅格化是指：障碍物栅格标记为1，空白栅格标 记为0。
3、根据权利要求1所述的基于可变形拓扑地图的服务机器人自主导航方法， 其特征是，所述的栅格化相关值是指：在全局三维场景中以从上至下，从左至 右的顺序依次计算每一个栅格与该栅格周围的8个栅格之间的相关值。
4、根据权利要求1所述的基于可变形拓扑地图的服务机器人自主导航方法， 其特征是，所述的拓扑点判断是指：判断该栅格对应的拓扑点是否为服务机器 人运动路径的末端点、服务机器人运动路径方向变化的点或服务机器人运动路 径的交叉点，以此来区分关键的拓扑点与非关键的拓扑点，并且将非关键的拓 扑点去除，以拓扑线代替，得到服务机器人运动路径拓扑地图。
5、根据权利要求1所述的基于可变形拓扑地图的服务机器人自主导航方法， 其特征是，所述的腐蚀-剪裁算法是指：在一副数字化图像上的一个像素点为p1， 顺时针环绕p1的相邻的8个方向上的像素依次设置为p2至p9，然后进行以下判 断：
步骤一、当p2+p3+……+p8+p9的和小于等于6且大于等于2时，设置：
a)从p2至p9按照p2，p3，…，p8，p9的顺序从0到1的变化次数为1；
b)设置p2*p3*p4＝0且设置p4*p6*p8＝0；
步骤二、当p2+p3+……+p8+p9的和小于等于6且大于等于2时，设置：
a)从p2至p9按照p2，p3，…，p8，p9的顺序从0到1的变化次数为1；
b)设置p2*p4*p8＝0且设置p2*p6*p8＝0
步骤三、重复步骤一并反复迭代计算，计算P1与周围栅格化相关值的关系， 直至p2+p3+……+p8+p9的和大于6或小于2；
步骤四、去除多余点，保留关键拓扑点，所有拓扑点被区分为冗余点与关 键点，区分的规则为：轨迹的末端点、轨迹变化的点或是连接交叉点，利用这 些规则对于拓扑点进行区分；
步骤五、将单个拓扑线融合为完整拓扑线在实现单独点相连基础上将其发 展为关键拓扑点相连的方法，利用原本点与相近点之间短线相连，通过保留原 本冗余点的位置信息，将冗余点消除的同时，将冗余拓扑点之间的拓扑线进行 融合处理，从而得到所需要的拓扑线。
6、根据权利要求5所述的基于可变形拓扑地图的服务机器人自主导航方法， 其特征是，所述的拓扑点判断是指：判断该栅格对应的拓扑点是否为服务机器 人运动路径的末端点、服务机器人运动路径方向变化的点或服务机器人运动路 径的交叉点，以此来区分关键的拓扑点与非关键的拓扑点，并且将非关键的拓 扑点去除，以拓扑线代替，得到服务机器人运动路径拓扑地图。
技术领域
本发明涉及的是一种机器人导航技术领域的方法，具体是一种基于可变形 拓扑地图的服务机器人自主导航方法。
背景技术
经对现有技术的文献检索发现，专利公开号CN101033971A，公开日2007年 9月12日，记载了一种“移动机器人地图创建系统及地图创建方法”，该方法将 无线传感器网络节点布撒于监控区域并形成无线传感器网络，根据无线传感器 网络节点的数据构建全局拓扑移动地图；该方法需要预先铺设相当数量的无线 传感器，而且得到地图会因为传感器在相应位置的缺省而不完整。
又经检索发现，普林斯顿大学的John J.Leonard和Hugh F.Durrant-Whyte 等在Intelligent Robots and Systems’91.’Intelligence for Mechanical Systems，Proceedings IROS’91.IEEE/RSJ International Workshop on： 1442-1447.(1991年IEEE机器人与系统国际会议，doi：1442-1447)上发表的 Simultaneous map building and localization for an autonomous mobilerobot (SLAM技术在移动机器人上的应用)，该文中描述了一种智能移动机器人通过 SLAM技术，描绘所处环境信息的一种方法，但主要集中在对于机器人的定位以 及环境的描述，不能地对于环境中的障碍信息进行处理，产生可用的移动地图， 有效地实现自主导航。
发明内容
本发明是通过以下技术方案实现的，本发明包括以下步骤：
第一步、首先依次将激光三维扫描传感器、倾斜传感器和6个超声波传感 器分别并联至服务机器人并将超声波传感器分别安装于服务机器人的周围，然 后设置激光三维扫描传感器以1毫秒为采样周期采集环境数据并进行模数转换， 得到原始三维环境数据；再设置倾斜传感器测得该倾斜传感器与地面的夹角以 及激光三维扫描传感器与地面的夹角作为夹角数据，最后记录超声波传感器测 得的服务机器人与前方障碍物的距离数据；
第二步、服务机器人通过原始三维环境数据获得相对坐标并结合夹角数据 标定出绝对坐标；然后根据距离数据进行三维场景分割，在以1毫秒为单位的 三维分割场景的基础上进行局部三维场景重建，生成局部三维场景信息；最后 通过扩展卡尔曼滤波的定位算法将局部三维场景信息通过鲁棒性的预测，每一 个时间点环境细节的匹配融合处理后生成全局三维场景。
第三步、首先以服务机器人的各种姿态所占的投影面积中的最小值作为栅 格，并以此栅格为单位将全局三维场景栅格化，然后应用腐蚀-剪裁算法在全局 三维场景中计算栅格化相关值并根据拓扑点判断的结果决定是否应该修改对应 栅格的标记值，最终生成服务机器人运动路径拓扑地图；
所述的全局三维场景栅格化是指：障碍物栅格标记为1，空白栅格标记为0；
所述的栅格化相关值是指：在全局三维场景中以从上至下，从左至右的顺 序依次计算每一个栅格与该栅格周围的8个栅格之间的相关值。
所述的拓扑点判断是指：判断该栅格对应的拓扑点是否为服务机器人运动 路径的末端点、服务机器人运动路径方向变化的点或服务机器人运动路径的交 叉点，以此来区分关键的拓扑点与非关键的拓扑点，并且将非关键的拓扑点去 除，以拓扑线代替，得到服务机器人运动路径拓扑地图。
第四步、根据服务机器人的姿态变化在地面的投影制定出对应的栅格，然后 依据蒙特卡罗配比法生成标准栅格，此处所述的蒙特卡罗配比法是基于蒙特卡 罗算法的一种扩展算法，其的功能便是将机器人不同的姿态投影进行栅格化， 并且，对于不同的尺寸进行最小公倍化处理，得到一个最小的标准栅格，其的 作用便是能够以一定的正整数倍数组成所有的姿态投影尺寸；同时，标准栅格 的另外一个作用是，能标准栅格作为预输入量，进行全局三维场景的栅格化。
第五步、依据服务机器人的姿态变化在地面的投影制定出对应的栅格的个 数创建旋转矩阵的维数，对原有的拓扑点进行计算，由于机器人姿态的投影尺寸 大小不一，在机器人导航过程中，首先以尺寸最大的拓扑点进行导航，导航的 过程中同样依靠栅格地图，但当遇到较狭窄环境后，将机器人的尺寸变小，变 为较小的拓扑点，这在运算上便理解为标准栅格组合形式的变化，当相应的环 境变窄，机器人的尺寸也相应变小，即标准栅格的组合数变小。
本发明能对于环境中的障碍信息进行实时处理，产生可用的移动地图，获 取符合服务机器人姿态变化的拓扑路径地图，有效地实现自主导航，与传统的 导航方法相比劳动强度减少的同时精度和效率都大大提高。
附图说明
图1为实施例中服务机器人运动路径拓扑地图；
其中：图1a：全局三维场景示意图、图1b：全局三维场景栅格化示意图、 图1c：服务机器人运动路径拓扑地图、图1d：拓扑路径地图。
图2为实施例中蒙特卡罗配比示意图；
图3为实施例中拓扑点示意图；
图4为实施例中拓扑路径地图；
其中：图4a：服务机器人运动路径拓扑地图；图4b：拓扑路径地图。
具体实施方式
如图1所示，本实施例包括以下步骤：第一步、首先依次将激光三维扫描 传感器、倾斜传感器和6个超声波传感器分别并联至服务机器人并将超声波传 感器分别安装于服务机器人的周围，然后设置激光三维扫描传感器以1毫秒为 采样周期采集环境数据并进行模数转换，得到原始三维环境数据；然后设置倾 斜传感器测得该倾斜传感器与地面的夹角以及激光三维扫描传感器与地面的夹 角作为夹角数据，再记录超声波传感器测得的服务机器人与前方障碍物的距离 数据；
第二步、服务机器人通过原始三维环境数据获得相对坐标并结合夹角数据 标定出绝对坐标；然后根据距离数据进行三维场景分割，在以1毫秒为单位的 三维分割场景的基础上进行局部三维场景重建，生成局部三维场景信息；最后 通过扩展卡尔曼滤波的定位算法将局部三维场景信息通过鲁棒性的预测，每一 个时间点环境细节的匹配等融合处理后生成全局三维场景。
如图3所示，第三步、首先以服务机器人的各种姿态所占的投影面积中的 最小值作为栅格，并以此栅格为单位将全局三维场景栅格化，然后应用腐蚀-剪 裁算法在全局三维场景中计算栅格化相关值并根据拓扑点判断的结果决定是否 应该修改对应栅格的标记值，最终生成服务机器人运动路径拓扑地图；
所述的全局三维场景栅格化是指：障碍物栅格标记为1，空白栅格标记为0；
所述的栅格化相关值是指：在全局三维场景中以从上至下，从左至右的顺 序依次计算每一个栅格与该栅格周围的8个栅格之间的关系，如图1所示；
所述的腐蚀-剪裁算法是指：在一副数字化图像上的一个像素点为p1，顺时 针环绕p1的相邻的8个方向上的像素依次设置为p2至p9，然后进行以下判断：
步骤一、当p2+p3+……+p8+p9的和小于等于6且大于等于2时，设置：
a)从p2至p9按照p2，p3，…，p8，p9的顺序从0到1的变化次数为1；
b)设置p2*p3*p4＝0且设置p4*p6*p8＝0。
步骤二、当p2+p3+……+p8+p9的和小于等于6且大于等于2时，设置：
a)从p2至p9按照p2，p3，…，p8，p9的顺序从0到1的变化次数为1；
b)设置p2*p4*p8＝0且设置p2*p6*p8＝0
步骤三、重复步骤一并反复迭代计算，计算P1与周围栅格化相关值的关系， 直至p2+p3+……+p8+p9的和大于6或小于2；
步骤四、去除多余点，保留关键拓扑点，所有拓扑点被区分为冗余点与关 键点，区分的规则为：轨迹的末端点、轨迹变化的点或是连接交叉点，利用这 些规则对于拓扑点进行区分。
步骤五、将单个拓扑线融合为完整拓扑线本文提出在实现单独点相连基础 上将其发展为关键拓扑点相连的方法。由图3，利用原本点与相近点之间短线相 连，通过保留原本冗余点的位置信息，将冗余点消除的同时，将冗余拓扑点之 间的拓扑线进行融合处理，从而得到所需要的拓扑线。
所述的拓扑点判断是指：判断该栅格对应的拓扑点是否为服务机器人运动 路径的末端点、服务机器人运动路径方向变化的点或服务机器人运动路径的交 叉点，以此来区分关键的拓扑点与非关键的拓扑点，并且将非关键的拓扑点去 除，以拓扑线代替，得到服务机器人运动路径拓扑地图。
如图2所示，第四步、根据服务机器人的姿态变化在地面的投影制定出对 应的栅格，然后依据蒙特卡罗配比法生成标准栅格，此处所述的蒙特卡罗配比法 是基于蒙特卡罗算法的一种扩展算法，其的功能便是将机器人不同的姿态投影 进行栅格化，并且，对于不同的尺寸进行最小公倍化处理，得到一个最小的标 准栅格，其的作用便是能够以一定的正整数倍数组成所有的姿态投影尺寸；同 时，标准栅格的另外一个作用是，能标准栅格作为预输入量，进行全局三维场 景的栅格化。
第五步、依据服务机器人的姿态变化在地面的投影制定出对应的栅格的个 数创建旋转矩阵的维数，对原有的拓扑点进行计算，由于机器人姿态的投影尺寸 大小不一，在机器人导航过程中，首先以尺寸最大的拓扑点进行导航，导航的 过程中同样依靠栅格地图，但当遇到较狭窄环境后，将机器人的尺寸变小，变 为较小的拓扑点，这在运算上便理解为标准栅格组合形式的变化，当相应的环 境变窄，机器人的尺寸也相应变小，即标准栅格的组合数变小。
如图4所示，本实施例能对于环境中的障碍信息进行实时处理，产生可用 的移动地图，获取符合服务机器人姿态变化的拓扑路径地图，有效地实现自主 导航，与传统的导航方法相比劳动强度减少的同时精度和效率都大大提高。
| 标题 | 发布/更新时间 | 阅读量 |
|---|---|---|
| 一种基于深度学习的2D+3D大飞机外形缺陷检测与分析方法 | 2020-05-08 | 965 |
| 一种环噪消除系统及其应用方法 | 2020-05-19 | 403 |
| 一种柔性地面上3D欠驱动双足机器人动力学模型计算方法 | 2020-05-21 | 111 |
| 一种移动机器人的目标轨迹跟踪方法 | 2020-05-13 | 13 |
| 一种移动机器人同步定位与地图构建方法 | 2020-05-14 | 640 |
| 一种清洁机器人及其控制方法 | 2020-05-22 | 651 |
| 一种工业机器人运动学标定方法 | 2020-05-16 | 532 |
| 一种基于灵敏度分析的切削加工机器人本体参数描述方法 | 2020-05-12 | 425 |
| 一种无人驾驶交通导航信号设备和其管理系统 | 2020-05-12 | 420 |
| 表面清洁机器人 | 2020-05-20 | 586 |
高效检索全球专利专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台，是提供专利分析，专利查询，专利检索等数据服务功能的知识产权数据服务商。
我们的产品包含105个国家的1.26亿组数据，免费查、免费专利分析。
专利汇分析报告产品可以对行业情报数据进行梳理分析，涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度，系统通过AI智能系统对图表进行解读，只需1分钟，一键生成行业专利分析报告。
