混合定位辅助地图修正方法及系统的制作方法
【技术领域】
[0001]本发明涉及室内定位技术领域,特别涉及一种混合定位辅助地图修正方法及系统。
【背景技术】
[0002]随着计算机处理能力、传感器和人工智能技术的发展,机器人研宄的主流方向已逐渐向可移动的智能机器人转移。原先传统固定机械臂式工业机器人所未考虑的问题也日益凸显出来,成为智能机器人所必须克服的技术难点。最典型的,比如位置识别和路径规划,就是智能机器人在移动之前必须具备的自主处理能力,其处理效率及可靠性直接决定了机器人自主移动的智能程度。
[0003]现有技术中,GPS定位技术虽然已比较成熟,但其仅可用于户外定位,定位精度和信号质量均无法适用于室内环境。因此,目前室内服务机器人主要依赖SLAM (SimultaneousLocalizat1n and Mapping,同步定位与建图)技术来实现全自主移动。SLAM技术中,机器人首先借助传感器设备探测周边环境建立地图,同时识别并标注自身当前在地图中位置,对于建图和标注,现有技术一般采用的方式有:栅格、几何信息和拓扑图表示法。其中,栅格表示法分别扫描多个栅格区域后进行叠加,得到详细地图并进行定位;几何信息法则是采集被扫描物的几何特征,利用不同的几何信息进行定位;拓扑图法则是将环境特征抽象为拓扑点和线,利用拓扑形状规划机器人移动。
[0004]现有技术各方案的优缺点均较为明显,其中栅格法精度较高,但计算量大且栅格叠加会造成地图偏移,可靠性不强;几何信息法计算量稍小,但相应地精度偏低;拓扑图法计算量最小、效率高,但因拓扑表示过于抽象,无法准确分辨相似场景,错误率较高。除了上述明显缺陷,现有技术更大的问题在于各方案均无法适用于复杂环境或复杂应用,尤其是其定位方式依赖于特定障碍物或标志物,要求机器人在启动时启动地点和角度固定,否则需要大范围扫描重新构建地图,这给实际应用带来了极大不便。
【发明内容】
[0005]针对现有技术的缺陷,本发明所要解决的技术问题是如何实现智能机器人的快速高精度的定位。
[0006]为解决该问题,一方面,本发明提供了一种混合定位辅助地图修正方法,该方法包括步骤:
[0007]获取预设区域的初始地图信息和无线节点信息,并将无线节点位置和所述初始地图信息结合后与服务器同步;
[0008]与多个无线节点进行无线通讯,各节点分别记录各自的无线通讯连接信息;
[0009]根据第一类无线节点的连接信息确定当前位置信息,根据第二类无线节点的连接信息对当前位置信息进行校验;
[0010]将校验后的位置信息和当前扫描结果结合后与服务器同步更新地图信息。[0011 ] 优选地,所述第一类无线节点为蓝牙和/或WIFI节点,所述第二类无线节点为UWB节点。
[0012]优选地,根据测量参数的不同,所述校验采用基于接收信号强度、基于到达角度和基于接收信号时间中至少一种方式进行。
[0013]优选地,所述方法中,所述多个节点的位置固定且已知,各节点位置和所述当前位置信息采用统一坐标系的坐标来表示和标注。
[0014]优选地,所述同步更新地图信息为:根据校验后的位置信息,进一步结合对当前位置周边环境的扫描结果,判断已有的地图信息是否准确;若地图信息存在偏差,则同步更新本地和服务器中的地图信息。
[0015]另一方面,本发明还同时提供一种混合定位辅助地图修正系统,该系统包括:
[0016]初始化模块,用于获取预设区域的初始地图信息和无线节点信息,并将无线节点位置和所述初始地图信息结合后与服务器同步;
[0017]无线通讯模块,与多个无线节点进行无线通讯,各节点分别记录各自的无线通讯连接信息;
[0018]定位模块,用于根据第一类无线节点的连接信息确定当前位置信息,根据第二类无线节点的连接信息对当前位置信息进行校验;
[0019]修正模块,用于将校验后的位置信息和当前扫描结果结合后与服务器同步更新地图信息。
[0020]优选地,所述系统为机器人,还包括:行进系统、控制系统、地图及位置测量系统、智能语音交互系统和通讯系统、图像识别和人脸交互系统和供电与自动回充系统;
[0021]其中,行进系统用于实现机器人的移动;控制系统用于将一个坐标转换成具体指令的控制系统;地图及位置测量系统用于扫描周围环境建立地图;智能语音交互系统和通讯系统用于和服务器进行交互;图像识别和人脸交互系统用于获得当前环境并确定捕捉到人脸和确认身份;供电与自动回充系统用于提供电源并在电量不足时返回充电粧充电的。
[0022]优选地,所述第一类无线节点为蓝牙和/或WIFI节点,所述第二类无线节点为UWB节点。
[0023]优选地,所述定位模块中,根据测量参数的不同,采用基于接收信号强度、基于到达角度和基于接收信号时间中至少一种方式进行所述校验。
[0024]优选地,所述系统还包括:
[0025]移动终端,用于通过自身的通讯单元与服务器和/或机器人交互,向机器人发出移动指示或服务任务。
[0026]本发明的技术方案提供了一种混合定位辅助地图修正方法及系统,通过多种无线定位技术帮助智能机器人实现定位,进而通过定位信息辅助修正扫描地图。由于多种定位技术相结合,系统不再依赖于单一的设备和技术,可大幅提高机器人定位的精度和可靠性,同时提高了扫描地图的识别和定位精度,使得智能机器人的自主移动更为准确高效可靠。
【附图说明】
[0027]图1为本发明的一个实施例中混合定位辅助地图修正方法的流程图;
[0028]图2为UWB定位的原理示意图;
[0029]图3为本发明的一个优选实施例中蓝牙节点设置效果示意图;
[0030]图4为本发明的一个优选实施例中UWB节点设置效果示意图;
[0031]图5为本发明的另一个优选实施例中基于到达时间差进行定位的原理示意图。
【具体实施方式】
[0032]下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述。显然,所描述的实施例为实施本发明的较佳实施方式,所述描述是以说明本发明的一般原则为目的,并非用以限定本发明的范围。本发明的保护范围应当以权利要求所界定者为准,基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例,都属于本发明保护的范围。
[0033]智能机器人的自主移动依赖于地图和自身位置来规划路径,其中地图的建立一般依赖于传感器对周边环境的感测,比如通过激光扫描获得环境中各标志物的位置和形状;而自身位置则依靠机器人的定位能力,现有技术的多种定位方式均是通过比对特定障碍物或标志物,过于依赖传感器对物体的识别能力,识别的正确率和设备成本很难有理想的平衡。
[0034]随着无线通信技术的发展,无线设备的体积越来越小、成本越来越低,已可广泛应用于小型设备中提供快捷高效的无线服务。本发明的实施例中,在传感器扫描地图的基础上,利用多种无线技术结合实现机器人的室内定位,并根据定位结果进一步修正地图,从而大幅提高地图精度、识别正确率,同时提高了路径规划及移动的效率和可靠性。
[0035]在本发明的一个实施例中,提供了一种混合定位辅助地图修正的方法,利用多种无线技术混合对机器人进行定位和校验。在机器人的室内活动区域中固定设置多个无线节点,同时在机器人自身设置相应无线设备,通过多种无线技术的连接信息对机器人的位置进行定位和校验。如图1的流程图所示,该方法包括步骤:
[0036]S1、获取预设区域的初始地图信息和无线节点信息,并将无线节点位置和所述初始地图信息结合后与服务器同步;
[0037]S2、与多个无线节点进行无线通讯,各节点分别记录各自的无线通讯连接信息;
[0038]S3、根据第一类无线节点的连接信息确定当前位置信息,根据第二类无线节点的连接信息对当前位置信息进行校验;
[0039]S4、将校验后的位置信息和当前扫描结果结合后与服务器同步更新地图信息。
[0040]本发明至少采用两种无线技术分别进行定位和位置校验,故多个无线节点中至少包括两类,两类无线节点优选采用定位方式、精度或成本不同的,比如以精度低、成本低的进行广泛配置并实现初次定位,以精度高、成本高的进行重点配置并实现二次校验。
[0041 ] 优选地,第一类定位节点为蓝牙和/或WIFI节点,第二类校验节点为训^卬1廿&-11(168&11(1,超宽带)节点:即首先以蓝牙或WIFI等方式区域定位,随后以UWB方式进行校验。蓝牙或WIFI定位时,将室内区域进一步划分为多个栅格,每个栅格中设置一个蓝牙或WIFI节点,机器人自身设置蓝牙或WIFI模块;UWB校验定位时,区域内固定设置多个UWB节点,机器人自身设置UWB标签。具体地,蓝牙或WIFI方式一般只在机器人模块与节点间建立单一连接,机器人在移动过程中分别与当前栅格中设置的节点建立连接(同时断开之前的连接),因而可简单地以建立连接的节点(以节点编号或ID区分)所对应栅格进行初步定位;而UWB方式可以精确计算距离和方位,因而以UWB精确定位结果进行二次校验。
[0042]其中,UWB技术是一种使用IGHz以上带宽且无需载波的先进无线通信技术。虽然是无线通信,但其通信速度可以达到几百Mbit/s以上。由于不需要价格昂贵、体积庞大的中频设备,UWB无线定位系统的体积小且成本低。而UWB系统发射的功率谱密度可以非常低,甚至低于美国联邦通信委员会(FCC,Federal Communicat1ns Commiss1n)规定的电磁兼容背景噪声电平,因此短距离UWB无线电通信系统可以与其他窄带无线电通信系统共存。
[0043]根据测量参数的不同,UWB定位的计算方式可采用基于接收信号强度(RSS,Received Signal Strength)、基于到达角度(AOA,Angle of Arrival)和基于接收信号时间(TOA/TDOA,Time of Arrival/Time Difference of Arrival)中至少一种。进一步如图2所示,对于一个标签,其发出的脉冲信号分别到达至少两个节点的接收传感器,每个传感器接收信号时分别获得相应的物理量,图2中示出了两传感器可能有两个接收时间t2,基于接收时间可以分别计算标签到两个传感器的距离,根据两距离的交集进一步计算出标签所在位置;或者两传感器可能有两个接收角度%、a2,基于接收角度可以分别