一种移动机器人平台自定位系统及自定位方法技术方案

本发明专利技术公开了一种移动机器人平台自定位系统及自定位方法，该自定位系统包括一台移动机器人平台以及定位装置，定位装置由三个置于天花板的信标组成。每个信标都有一个蓝牙模块，同时移动机器人平台也内置蓝牙模块，与信标进行通信，以测量移动机器人平台当前与信标之间的斜角距离。再通过一个信标的高度测量单元测量天花板到地板间的垂直距离。据此，定位装置依据测量所得的斜角距离及垂直距离，计算定位装置与移动机器人平台间的水平距离，利用三边定位算法，得出移动机器人平台相对于定位装置的相对位置。

A self positioning system and self localization method for mobile robot platform

The invention discloses a mobile robot platform self-positioning system and a self-positioning method. The self-positioning system comprises a mobile robot platform and a positioning device, which is composed of three beacons placed on the ceiling. Each beacon has a Bluetooth module, and the mobile robot platform also has a built-in Bluetooth module to communicate with the beacon to measure the diagonal distance between the mobile robot platform and the beacon. The vertical distance between the ceiling and the floor is also measured through a beacon height measuring unit. According to the measured diagonal distance and vertical distance, the location device calculates the horizontal distance between the location device and the mobile robot platform. The relative position of the mobile robot platform relative to the positioning device is obtained by using the trilateral positioning algorithm.

【技术实现步骤摘要】
一种移动机器人平台自定位系统及自定位方法
本专利技术涉及一种移动机器人平台自定位系统及自定位方法。
技术介绍
移动机器人平台例如扫地机器人等智能设备，近年来正逐渐普及。市场上的移动机器人，大多利用移动机器人平台内置的红外传感器或者超声波传感器，对周围环境进行判断，若周围有障碍物，就会选择其他的路径。这种方法很难采集当前移动机器人平台的位置信息。为了能够准确控制平台的移动，移动机器人平台必须具备特定的自定位系统。移动机器人平台可以使用环境地图模型匹配定位，这也是很多移动机器人平台所采用的自定位方法。机器人通过自身的各种传感器探测周围环境，利用感知到的局部环境信息进行局部的地图构造，并与其内部事先存储的完整地图进行匹配。通过匹配关系获得自己在全局环境中的位置，从而确定自身的位置。该方法在结构复杂的环境中测量的精度并不是很高。基于信标的定位系统依赖于一系列环境中已知特征的信标，并需要在移动机器人上安装传感器对信标进行观测。用于信标观测的传感器有很多种，比如红外传感器、超声波传感器、激光雷达、视觉传感器等。红外传感器与超声波传感器可以测得障碍物的距离，但是测量精度不是很高，而且红外信号在室内有反射，会造成误差。激光雷达、视觉传感器等可以实时测量，没有累进误差，精度相对较高、稳定性好，提供快速、稳定、精确的绝对位置信息，但安装和维护信标的费用很高。市场上已经出现较为成熟的基于信标定位的信标定位移动机器人平台，如Proscenic的模拟GPS卫星三点定位技术，iRobot的Northstar导航定位技术，但由于其价格较为昂贵，它们都用于相对高端的产品中。
技术实现思路
本专利技术的目的在于提供移动机器人平台自定位系统及自定位方法，通过蓝牙模块进行通信，进行高准确度的定位工作，由此来提高移动机器人平台的清扫效率，缩短清扫时间。为了达到上述目的，本专利技术的技术方案如下：一种移动机器人平台的自定位系统，包括移动机器人平台和定位装置；所述移动机器人平台内部具有一个蓝牙模块，所述定位装置具有三个内置蓝牙模块的信标，其中一个信标具有高度测量单元；所述定位装置安装于天花板，由高度测量单元测得信标到地板之间的垂直距离，通过信标内置的蓝牙模块与移动机器人平台的蓝牙模块进行通信，计算得出信标与移动机器人平台蓝牙模块间的斜角距离，由控制器计算出所述信标与移动机器人平台的水平距离，得到移动机器人平台的相对坐标。如上所述，位于天花板的三个信标需要提前测量它们的相对距离，提前用移动机器人平台内的控制器建立平面坐标系。如上所述，该移动机器人平台的控制器连接蓝牙模块，识别三个信标的ID，每个信标的ID是唯一的。如上所述，该移动机器人平台还包括：一处理单元，用以计算各个信标与移动机器人平台蓝牙模块间的斜角距离、水平距离和相对位置，其中该计算程序以该垂直距离和斜线距离进行三角函数计算出三个水平距离，用三边定位算法计算当前的相对位置。如上所述，所述蓝牙模块为贴片式。如上所述，本专利技术提供了一种基于该移动机器人平台自定位系统的自定位方法，该自定位方法包括以下步骤：(a)通过一高度测量单元测量定位装置到一地板间的垂直距离；(b)三个信标会向移动机器人平台发送用于标识自己唯一的ID，随后会请求移动机器人平台发送一个射频信号，并要求移动机器人平台附带蓝牙定位节点的ID以及这个射频信号的发送功率P1；射频信号在传播到蓝牙定位节点的过程中会有功率的衰减，得到接收功率P2；使用RSSI测距算法进行此节点与移动机器人平台的距离计算，得到斜角距离L；(c)依据该垂直距离与该斜角距离计算该定位装置与该移动机器人平台的一水平距离；(d)依次计算出三个信标与移动机器人平台的水平距离S1、S2和S3，用三点定位算法计算出移动机器人平台当前的坐标。本专利技术相对于本领域相关技术所能达到的技术功效在于，定位装置可发出每个信标唯一的ID，移动机器人平台接收到蓝牙发出的信息，计算出移动机器人平台相对于定位装置的相对位置。通过此相对位置，可令移动机器人平台不会迷失方向或者重复清扫已完成作业的区域。因此，可实现更有效率的清扫动作，以缩短作业时间，进而降低移动机器人平台的电池使用量。此外，本专利技术主要通过设置在天花板上的内置蓝牙模块的信标，与移动机器人平台进行蓝牙通信，用移动机器人平台的控制器计算出移动机器人平台的相对位置。与其他基于信标的移动机器人平台定位相比，蓝牙定位比激光雷达等传感器的成本要低，有利于市场开拓。再者，本专利技术将定位装置安装在欲作业空间的天花板上，因此可在干扰最小的情况下使移动机器人平台接收蓝牙信号对自身进行定位。并且可以不受障碍物的影响，时刻对移动机器人平台进行定位。附图说明为了更清楚地说明本专利技术的技术方案，下面将对实施例中所需使用的附图作简单的介绍。图1为本专利技术的移动机器人平台定位系统示意图；图2为本专利技术的移动机器人平台方框图；图3为本专利技术的定位装置安装示意图；图4为本专利技术的定位流程图；其中：1.室内空间，11.天花板，12.地板，2.移动机器人平台，21.蓝牙模块，22.处理模块，23.运动机构，24.记忆单元，25.计算程序，26.工作数据，3.内置蓝牙模块的信标一，4.内置蓝牙模块的信标二，5.内置蓝牙模块的信标三，6.高度测量单元，7.定位装置，H.信标到地板的垂直距离，L1.信标1到移动机器人平台的斜角距离，L2.信标2到移动机器人平台的斜角距离，L3.信标3到移动机器人平台的斜角距离，S1.信标1到移动机器人平台的水平距离，S2.信标2到移动机器人平台的水平距离，S3.信标3到移动机器人平台的水平距离，S10-S20.定位步骤。具体实施方式为了使本
的人员更好地理解本申请中的技术方案，下面将结合实施例对本申请中的技术方案进行清楚、完整地描述。图1为本专利技术的移动机器人平台定位系统示意图。本专利技术揭露了一种移动机器人平台定位系统，包括定位装置7以及移动机器人平台2，该系统主要运用于欲清扫的室内空间1，其中定位装置7设置于该室内空间1的天花板11，而该移动机器人平台2则放置在该室内空间1的地板12上，在地板12上自动进行清扫工作。如图1所示，该定位装置7安装于天花板11上，由三个内置蓝牙模块的信标3、4和5构成，其中一个具有高度测量单元6，用以测量该定位装置7与地板12之间的距离H，多个信标内部的模块用以测量信标3、4和5到移动机器人平台之间的斜角距离L1、L2和L3，该移动机器人平台可依据三个信标与移动机器人平台间的斜角距离L1、L2和L3以及定位装置7与地板12之间的距离H，计算出三个信标与移动机器人平台间的水平距离S1、S2和S3。位于天花板的三个信标需要提前测量它们的相对距离，提前用移动机器人平台内的控制器建立平面坐标系。该移动机器人平台内部控制器必须连接蓝牙模块，识别三个信标的的ID，每个信标的ID都是唯一的。图2为本专利技术的移动机器人平台方框图。如图2所示，该移动机器人平台2主要具有蓝牙模块21、处理模块22、运动机构23以及记忆单元24。其中记忆单元24包括计算程序25和工作数据26。蓝牙模块21负责采集三个信标发出的蓝牙信号，并分别对它们的ID进行采集。处理模块22将蓝牙信号通过RSSI算法计算出三个信标与移动机器人平台间的距离。并且处理模块22控制该本文档来自技高网...

【技术保护点】
1.一种移动机器人平台自定位系统，包括移动机器人平台和定位装置，所述移动机器人平台内部具有一个蓝牙模块，其特征在于，所述定位装置安装于天花板、且具有三个内置蓝牙模块的信标，所述信标通过其内置的蓝牙模块与移动机器人平台的蓝牙模块进行通信，计算得出信标与移动机器人平台蓝牙模块间的斜角距离；所述定位装置通过高度测量模块测得信标与移动机器人的垂直距离；由控制器计算出所述信标与移动机器人平台的水平距离，得到移动机器人平台的相对坐标。

【技术特征摘要】
1.一种移动机器人平台自定位系统，包括移动机器人平台和定位装置，所述移动机器人平台内部具有一个蓝牙模块，其特征在于，所述定位装置安装于天花板、且具有三个内置蓝牙模块的信标，所述信标通过其内置的蓝牙模块与移动机器人平台的蓝牙模块进行通信，计算得出信标与移动机器人平台蓝牙模块间的斜角距离；所述定位装置通过高度测量模块测得信标与移动机器人的垂直距离；由控制器计算出所述信标与移动机器人平台的水平距离，得到移动机器人平台的相对坐标。2.根据权利要求1所述的一种移动机器人平台自定位系统，其特征在于，位于天花板的三个信标需要提前测量它们的相对距离，提前用移动机器人平台内的控制器建立平面坐标系。3.根据权利要求1所述的一种移动机器人平台自定位系统，其特征在于，所述移动机器人平台的控制器连接蓝牙模块，识别三个信标的ID，每个信标的ID是唯一的。4.根据权利要求1所述的一种移动机器人平台自定位系统，其特征在于，所述移动机器人平台还包括：一处理单元，用以计算各个信标与移动机器人平台蓝牙模块间的斜角距离、水平距离及相对位置，其中计算程序以该垂直...

【专利技术属性】
技术研发人员：熊鹏文，蒋逸飞，熊宏锦，黄鑫，陈海初，熊根良，张华，宋爱国，李建清，
申请(专利权)人：南昌大学，
类型：发明
国别省市：江西,36