基于多定位融合的室内定位导航系统及方法技术方案

本发明专利技术提供了一种基于多定位融合的室内定位导航系统及方法，包括超宽带模块：获得室内物体的初始定位坐标；激光雷达定位模块：基于超宽带模块提供的初始定位坐标为原点进行激光雷达SLAM定位，获取激光雷达SLAM定位信息；里程计定位模块：获取里程定位信息；惯导定位模块：获取惯导定位信息；定位信息融合模块：对激光雷达SLAM定位信息、里程定位信息、惯导定位信息进行融合。本发明专利技术通过使用超宽带获得初始定位的方式，既可以得到激光雷达SLAM缺少的初始定位信息，又可以弥补超宽带定位在小场景应用中，精度不足的问题。通过结合里程计与惯导信息，可以更好地修正激光雷达SLAM定位中可能出现的坐标抖动。可能出现的坐标抖动。可能出现的坐标抖动。

【技术实现步骤摘要】
基于多定位融合的室内定位导航系统及方法


[0001]本专利技术涉及室内定位导航领域，具体地，涉及一种基于多定位融合的室内定位导航系统及方法。

技术介绍

[0002]现在用于室内的定位方式多为里程计、惯导、超宽带等单一定位的方式，也存在通过对里程计、惯导、超宽带等传感器定位信息进行融合产生一个最终的定位信息的方式。
[0003]目前的室内场景的定位融合方式，在部分传感器精度不高或者会出现跳变的情况下，依靠单一的定位方式的话，这种定位信息无法进行使用。考虑使用定位融合的话，在部分传感器定位信息可信度不高的情况下，定位信息也会受到一定程度的影响。
[0004]专利文献为CN 108981720 A的专利技术专利公开了一种UWB与惯导融合的室内导航系统，为解决现有室内导航系统基于未知环境进行，存在全局定位失效和绑架机器人的问题。所述UWB与惯导融合的室内导航系统，在移动机器人上设置四个UWB标签、惯导和激光雷达，在移动机器人的运行环境中布置四个UWB基站；通过UWB基站、UWB标签和移动机器人之间的几何约束关系，获取移动机器人的位姿；利用扩展卡尔曼滤波将获取的移动机器人位姿与惯导获得的位姿进行融合，获得移动机器人的全局位姿；再将全局位姿代替导航系统中利用里程计获得的位姿，与激光雷达数据进行融合定位。上述方案与本方案所述内容差别较大。首先是在实际应用中，在室内场景的小型机器人上应用UWB定位，定位误差可能会达到10cm，这个误差会导致小型机器人其他需要运用定位的功能，例如导航功能等无法正差工作。以及当机器人的里程计精度较低时，定位融合出来的结果其实也无法作为参考。
[0005]专利文献为CN106643720B的专利技术专利公开了一种基于UWB室内定位技术与激光雷达的地图构建方法，采用UWB和激光雷达双传感器构建地图，可以保证，在室内受到金属遮挡，导致UWB定位不准时，激光雷达的数据能让误差减小。当激光雷达的数据由于运动物体的定位精度降低时，UWB定位又可以让此误差减小。但是在成本方面三维激光雷达更高。并且因为激光雷达维数不同，所以激光雷达的定位方式也不同。
[0006]专利文献为CN111694006A的专利技术专利公开了一种用于室内无人系统的导航传感系统。整个系统包括主控制器、地图构建模块，定位模块、导航模块和数据存储模块,其中通过单片机控制地图构建模块，定位模块、导航模块独立工作，数据存储模块用于存储地图构建模块传来的室内地图信息和定位模块传来的无人系统的状态信息、位置信息。所述地图构建模块包括UWB、里程计和激光雷达；所述定位模块包括惯性导航系统和测距系统；所述导航模块包括摄像头和路径规划子模块。电但是上述方案无法实现初始位置定位。

技术实现思路

[0007]针对现有技术中的缺陷，本专利技术的目的是提供一种基于多定位融合的室内定位导航系统及方法。
[0008]根据本专利技术提供的一种基于多定位融合的室内定位导航系统，包括如下模块：
[0009]超宽带模块：获得室内物体的初始定位坐标；
[0010]激光雷达定位模块：基于超宽带模块提供的初始定位坐标为原点进行激光雷达SLAM定位，获取激光雷达SLAM定位信息；
[0011]里程计定位模块：获取里程定位信息；
[0012]惯导定位模块：获取惯导定位信息；
[0013]定位信息融合模块：对激光雷达SLAM定位信息、里程定位信息、惯导定位信息进行融合。
[0014]优选地，所述超宽带模块包括UWB标签和UWB基站，所述UWB基站至少设置有三个，UWB基站在高于场景的位置架设。
[0015]优选地，所述UWB基站在对应的使用场景的最外周以矩形或者三角形顶点的位置架设。
[0016]优选地，所述里程计定位模块包括光电编码器。
[0017]优选地，所述惯导定位模块包括加速度计和陀螺仪，加速度计用于输出物体在载体坐标系统中的三个坐标轴方向上的加速度信息，陀螺仪用于输出载体相对于导航坐标系的三个坐标轴方向上的角速度信息，根据载体在三维空间中的角速度以及加速度值解算出对应的姿态。
[0018]优选地，还包括搭设在室内场景中的靶标，所述靶标能够达到激光雷达的高度需求。
[0019]优选地，定位信息融合模块中，通过卡尔曼滤波进行定位信息的融合。
[0020]根据本专利技术提供的一种基于多定位融合的室内定位导航方法，包括如下步骤：
[0021]超宽带定位步骤：用于获得室内物体的初始定位坐标；
[0022]激光雷达定位步骤：基于超宽带模块提供的初始定位坐标为原点进行激光雷达SLAM定位，获取激光雷达SLAM定位信息；
[0023]里程计定位步骤：获取里程定位信息；
[0024]惯导定位步骤：获取惯导定位信息；
[0025]定位信息融合步骤：对激光雷达SLAM定位信息、里程定位信息、惯导定位信息进行融合。
[0026]与现有技术相比，本专利技术具有如下的有益效果：
[0027]1、本专利技术通过使用超宽带获得初始定位的方式，既可以得到激光雷达SLAM缺少的初始定位信息，又可以弥补超宽带定位在小场景应用中，精度不足的问题。
[0028]2、本专利技术通过结合里程计与惯导信息，可以更好地修正激光雷达SLAM定位中可能出现的坐标抖动，最终可以作为一种室内比较准确的定位方式。
[0029]3、本专利技术采用的是UWB给出初始坐标，再通过二维激光雷达SLAM的算法进行定位，采用的SLAM的算法核心是扫描匹配，对于不同时刻点云形成的地图进行匹配，位姿的运算并且在不同分辨率的地图中进行迭代处理。
附图说明
[0030]通过阅读参照以下附图对非限制性实施例所作的详细描述，本专利技术的其它特征、目的和优点将会变得更明显：
[0031]图1为基于多定位融合的室内定位导航系统的结构示意图。
具体实施方式
[0032]下面结合具体实施例对本专利技术进行详细说明。以下实施例将有助于本领域的技术人员进一步理解本专利技术，但不以任何形式限制本专利技术。应当指出的是，对本领域的普通技术人员来说，在不脱离本专利技术构思的前提下，还可以做出若干变化和改进。这些都属于本专利技术的保护范围。
[0033]如图1所示，本专利技术提供了一种基于多定位融合的室内定位导航系统及方法，本专利技术为了在室内场景获得比较准确的定位信息，需要采用更加准确的定位方式。在室内特征物比较丰富的情况下，所以利用激光雷达定位与建图(SLAM)、里程计、惯导、超宽带多种定位方式进行融合定位。在部分传感器精度无法完成任务时，可以通过关闭或者降低权值的办法来使融合后的信息更加准确。
[0034]进一步说明，本专利技术包括超宽带模块：获得室内物体的初始定位坐标；激光雷达定位模块：基于超宽带模块提供的初始定位坐标为原点进行激光雷达SLAM定位，获取激光雷达SLAM定位信息；里程计定位模块：获取里程定位信息；惯导定位模块：获取惯导定位信息；定位信息融合模块：对激光雷达SLAM定位信息、里程定位信息、惯导定位信息本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于多定位融合的室内定位导航系统，其特征在于，包括如下模块：超宽带模块：获得室内物体的初始定位坐标；激光雷达定位模块：基于超宽带模块提供的初始定位坐标为原点进行激光雷达SLAM定位，获取激光雷达SLAM定位信息；里程计定位模块：获取里程定位信息；惯导定位模块：获取惯导定位信息；定位信息融合模块：对激光雷达SLAM定位信息、里程定位信息、惯导定位信息进行融合。2.根据权利要求1所述的基于多定位融合的室内定位导航系统，其特征在于，所述超宽带模块包括UWB标签和UWB基站，所述UWB基站至少设置有三个，UWB基站在高于场景的位置架设。3.根据权利要求2所述的基于多定位融合的室内定位导航系统，其特征在于，所述UWB基站在对应的使用场景的最外周以矩形或者三角形顶点的位置架设。4.根据权利要求1所述的基于多定位融合的室内定位导航系统，其特征在于，所述里程计定位模块包括光电编码器。5.根据权利要求1所述的基于多定位融合的室内定位导航系统，其特征在于，所述惯导定位...

【专利技术属性】
技术研发人员：高瑞金，王震涛，陈志鹏，林新雨，洪源，
申请(专利权)人：上海智能网联汽车技术中心有限公司，
类型：发明
国别省市：