CN108513353A - 基于双信标节点实现移动机器人定位的方法 - Google Patents
基于双信标节点实现移动机器人定位的方法 Download PDFInfo
- Publication number
- CN108513353A CN108513353A CN201810184009.0A CN201810184009A CN108513353A CN 108513353 A CN108513353 A CN 108513353A CN 201810184009 A CN201810184009 A CN 201810184009A CN 108513353 A CN108513353 A CN 108513353A
- Authority
- CN
- China
- Prior art keywords
- mobile robot
- beaconing nodes
- circle
- coordinate information
- radius
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W64/00—Locating users or terminals or network equipment for network management purposes, e.g. mobility management
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/02—Services making use of location information
- H04W4/023—Services making use of location information using mutual or relative location information between multiple location based services [LBS] targets or of distance thresholds
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种基于双信标节点实现移动机器人定位的方法,移动机器人的通信半径与数个信标节点的通信半径相同,当移动机器人在其通信半径内只与无线传感器网络中的两个信标节点建立通信连接,则对所述的无线传感器网络建立二维直角坐标系,两个信标节点分别根据其与移动机器人的距离为半径、以自身的坐标信息为圆心做圆,根据两个圆的交点数量判断移动机器人的实际坐标信息。采用本发明的基于双信标节点实现移动机器人定位的方法,算法简单可靠,降低了对硬件的要求,无需里程计和陀螺仪,避免定位算法的累积误差,节省了网络成本,可扩展性强,适用性强、成本低廉、具有广泛的应用价值。
Description
技术领域
本发明涉及机器人通信领域,尤其涉及机器人无线通信定位领域,具体是指一种基于双信标节点实现移动机器人定位的方法。
背景技术
定位技术是移动机器人研究中的一项关键技术,对于一个自主的机器人系统,精确的空间定位是其实现自主导航的前提.目前有很多方法可以得到机器人的位置信息,主要分为以下两类:①通过码盘、电子陀螺仪、加速度计等传感器记录机器人自己的移动过程,通过累计计算出当前时刻的位置;②通过雷达、激光测距仪、图像匹配等确定机器人与环境的相对位置进而获得自己的位置信息。但是由于移动机器人机动性强、自身建模困难,第一种方法积分累计误差对定位精度影响较大,第二种方法成本较高,需要增加昂贵的附属设备。
近年来,随着无线传感器网络(Wireless Sensor Network,WSN)技术研究的兴起,将移动机器人与无线传感器网络结合,实现机器人全区域定位和跟踪。基于WSN的定位算法主要分为两类:基于测距算法(Range-based)和非测距算法(Range-free)。前者通过信标节点间距或角度计算未知节点的位置,主要包括三边测量法(Trilateration Algorithm,TA)、极大似然估计法等;后者无需距离或角度信息,仅依靠网络连通性等信息实现目标定位,包括DV-hop定位算法、质心法、SPA(self-positioning algorithm)相对定位算法等。
其中,三边测量法需要三个或三个以上的信标节点才能定位,如果在机器人的通信范围内只有两个信标节点,则无法得到移动机器人的位置信息,此时就需要更改算法,使得移动机器人的定位变得复杂,延长了计算和分析的时间。
发明内容
本发明的目的是克服了上述现有技术的缺点,提供了一种通过两个信标节点就能确认移动机器人位置、简化结构、优化算法、提高分析速度、缩短计算时间的基于双信标节点实现移动机器人定位的方法。
为了实现上述目的,本发明的基于双信标节点实现移动机器人定位的方法具有如下构成:
该基于双信标节点实现移动机器人定位的方法,所述的移动机器人位于无线传感器网路中,其主要特点是,所述的无线传感器网络包含数个通信半径相同的信标节点,所述的移动机器人的通信半径与所述的数个信标节点的通信半径相同,当所述的移动机器人在其通信半径内只与所述的无线传感器网络中的两个信标节点建立通信连接,在所述的移动机器人的通信半径外存在数个未建立通信连接的信标节点,则三边测量法无法使用,所述的方法可以根据以下步骤来得到移动机器人的实际坐标信息:
(1)对所述的无线传感器网络建立二维直角坐标系,在二维直角坐标系内分布数个信标节点;
(2)与所述的移动机器人通信连接的两个信标节点分别根据其与所述的移动机器人的距离为半径、以自身的已知坐标信息为圆心做圆;
(3)根据两个圆的交点数量判断所述的移动机器人的实际坐标信息。
进一步地,所述的根据两个圆的交点数量判断所述的移动机器人的实际坐标信息,具体包括以下步骤:
(3.1)判断两个圆的交点数量为一个还是两个,如果为一个交点,则继续步骤(3.2),如果为两个交点,则继续步骤(3.3);
(3.2)确定该交点的坐标信息并设定为所述的移动机器人的实际坐标信息;
(3.3)确定两个交点的坐标信息并设定为第一交点坐标和第二交点坐标;
(3.4)以第一交点坐标的坐标信息为圆心、以通信半径为半径做圆,如果圆内包含三个或三个以上的信标节点,则判定为无效交点坐标,并继续步骤(3.5),否则设定为所述的移动机器人的实际坐标信息;
(3.5)以第二交点坐标的坐标信息为圆心、以通信半径为半径做圆,如果圆内包含三个或三个以上的信标节点,则判定为无效交点坐标,并返回上述步骤(1),否则设定为所述的移动机器人的实际坐标信息。
更进一步地,所述的判断两个圆的交点数量为一个还是两个,具体为:
判断所述的移动机器人和与所述的移动机器人通信连接的两个信标节点是否共线,如果是,则判定为一个交点,否则判定为两个交点。
采用了本发明的基于双信标节点实现移动机器人定位的方法,当移动机器人在通信半径内只与无线传感器网络中的两个信标节点建立通信连接,利用两个信标节点实现了移动机器人的定位,弥补了三边测量法的缺陷,且无需改动测量距离的算法,只需利用现有的距离信息和信标节点的坐标信息即可完成移动机器人的坐标定位,改动内容少,算法简单可靠,且在非刚性的网络结构下仍然可以精准定位移动机器人的位置,降低了对硬件的要求,无需里程计和陀螺仪,避免定位算法的累积误差,节省了网络成本,可扩展性强,适用性强、成本低廉、具有广泛的应用价值。
附图说明
图1为本发明的基于双信标节点实现移动机器人定位的方法的流程图。
图2为本发明的基于双信标节点实现移动机器人定位的方法的具体实施例的第一种情况的示意图。
图3为本发明的基于双信标节点实现移动机器人定位的方法的具体实施例的第二种情况的示意图。
图4为本发明的基于双信标节点实现移动机器人定位的方法的具体实施例的第三种情况的示意图。
具体实施方式
为了能够更清楚地描述本发明的技术内容,下面结合具体实施例来进行进一步的描述。
如图1所示,为本发明的基于双信标节点实现移动机器人定位的方法的流程图。
无线传感器网络包含数个通信半径相同的信标节点,所述的移动机器人位于无线传感器网路中,移动机器人的通信半径与数个信标节点的通信半径相同,当移动机器人在其通信半径内只与无线传感器网络中的两个信标节点建立通信连接,在移动机器人的通信半径外存在数个未建立通信连接的信标节点,则三边测量法无法使用,本发明的方法可以根据以下步骤来得到移动机器人的实际坐标信息:
(1)对所述的无线传感器网络建立二维直角坐标系,在二维直角坐标系内分布数个信标节点;
(2)与所述的移动机器人通信连接的两个信标节点分别根据其与所述的移动机器人的距离为半径、以自身的已知坐标信息为圆心做圆;
(3)根据两个圆的交点数量判断所述的移动机器人的实际坐标信息,具体包括以下步骤:
(3.1)判断两个圆的交点数量为一个还是两个,具体为:
判断所述的移动机器人和与所述的移动机器人通信连接的两个信标节点是否共线,如果是,则判定为一个交点,否则判定为两个交点。
如果为一个交点,则继续步骤(3.2),如果为两个交点,则继续步骤(3.3);
(3.2)确定该交点的坐标信息并设定为所述的移动机器人的实际坐标信息;
(3.3)确定两个交点的坐标信息并设定为第一交点坐标和第二交点坐标;
(3.4)以第一交点坐标的坐标信息为圆心、以通信半径为半径做圆,如果圆内包含三个或三个以上的信标节点,则判定为无效交点坐标,并继续步骤(3.5),否则设定为所述的移动机器人的实际坐标信息;
(3.5)以第二交点坐标的坐标信息为圆心、以通信半径为半径做圆,如果圆内包含三个或三个以上的信标节点,则判定为无效交点坐标,并返回上述步骤(1),否则设定为所述的移动机器人的实际坐标信息。
无线传感器网络环境中,坐标已知的节点称为信标节点(或锚节点),在具体实施例中,无线传感器网络环境包括数个已知坐标信息的信标节点,移动机器人依赖周围传感器网络实现自身定位服务。在R2(二维)空间内信标节点可以提供精确位置信息,而移动机器人需要依赖周围信标节点提供的坐标实时定位自身位置。如果无线传感器节点的通信半径已知为ρ(ρ>0),移动机器人能携带相同的无线传感器节点,并且通信半径同样为ρ(ρ>0),能够探测到四周任何通信范围内的信标节点Ai,通过测距得到两点之间距离为dri,该距离存在环境噪声干扰和传感器自身的测量误差,因此使用测距误差e表示该噪声干扰。当无线传感器自身天线为圆形覆盖区域时,在通信半径ρ的圆形区域内能够实现与其它传感器节点的网络通信,网络连通图定义为单位圆盘图。在R2空间中,三角形结构图具有全局刚性特征,建立的无线传感器网络符合全局刚性结构,由于本实施例中的信标节点的通信半径相同,因此信标节点可以以三角形结构进行排列,优选地,还可以以等边三角形进行排列。但若与移动机器人建立通信的信标节点不足3个,无法构成三角形结构,则是非刚性的网络结构,TA算法无法实现。
机器人在通信半径为ρ的全局刚性无线传感器网络中移动,虚线箭头代表通信半径。机器人探测到周围存在两个信标节点A1和A2,表示为星形标识,带有箭头的实线表示在通信半径ρ之内信标节点到达机器人的测量距离dr1和dr2。信标节点A3位于机器人通信半径之外,无法与机器人建立通信。由于探测到的信标节点数量未达到三个,机器人无法构成三角形刚性结构,不能使用TA算法实现动态定位。
此时,本发明的基于双信标节点实现移动机器人定位的方法能够帮助确定移动机器人的准确位置。以已知测量距离dr1和dr2为圆半径,以探测到信标节点坐标A1和A2作为圆心,绘制两个圆(以实线表示),考虑到无线传感器之间测距误差e,可以在加入误差e的情况下得到与A1和A2圆心相同的同心圆,表示为点划线圆。
由于通信半径相同,此时会出现两种情况:
1、两个圆相交于两点Rtr和Rtd。
如图2所示,此时产生了两个交点Rtr和Rtd,由图可以明显看出Rtd到A3的距离明显小于通信半径ρ,若一定机器人在交点Rtd处应该可以与A1、A2和A3都建立通信,这与事实不符,因此判定为无效交点坐标,另一交点Rtr即为移动机器人的实际坐标。
2、两个圆相交于一点Rtr,Rtr和A1之间距离为dr1,Rtr和A2之间距离为dr2,A1和A2之间距离为d12,此时又可分为两种情况:
1)两个信标节点A1和A2在机器人的相反方向。
如图3所示,公式表示为dr1+dr2-e≤d12≤dr1+dr2+e。不管dr1和dr2之间的关系如何,该关系可以定义为dr1<dr2-e,dr2-e≤dr1≤dr2+e,或dr1>dr2+e,只要机器人在两个信标节点之间,并且三个不同点共线或者近似共线,则移动机器人Rtr总有唯一坐标。在这种情况下,d12总是大于或者等于dr1和dr2。
2)两个信标节点A1和A2在机器人的相同方向。
如图4所示,第二种情况是两个信标节点A1和A2在机器人Rtr同侧。如果信标节点A2距离机器人Rtr近,表示dr1≥d12-e,和dr1≥dr2-e,公式表示为d12+dr2-e≤dr1≤d12+dr2+e。如果信标节点A1距离机器人Rtr近,表示dr2≥d12-e和dr2≥dr1-e,公式表示为d12+dr1-e≤dr2≤d12+dr1+e。如果三个不同点共线或者近似共线,并且两个信标在机器人同侧,移动机器人总有唯一坐标。
因此,不管两个信标节点在移动机器人的异侧或者同侧,要三个不同点共线或者近似共线,并且两个信标在机器人通信半径内,两圆相交的交点Rtr对应了移动机器人的唯一坐标。
采用了本发明的基于双信标节点实现移动机器人定位的方法,当移动机器人在通信半径内只与无线传感器网络中的两个信标节点建立通信连接,利用两个信标节点实现了移动机器人的定位,弥补了三边测量法的缺陷,且无需改动测量距离的算法,只需利用现有的距离信息和信标节点的坐标信息即可完成移动机器人的坐标定位,改动内容少,算法简单可靠,且在非刚性的网络结构下仍然可以精准定位移动机器人的位置,降低了对硬件的要求,无需里程计和陀螺仪,避免定位算法的累积误差,节省了网络成本,可扩展性强,适用性强、成本低廉、具有广泛的应用价值。
在此说明书中,本发明已参照其特定的实施例作了描述。但是,很显然仍可以作出各种修改和变换而不背离本发明的精神和范围。因此,说明书和附图应被认为是说明性的而非限制性的。
Claims (3)
1.一种基于双信标节点实现移动机器人定位的方法,所述的移动机器人位于无线传感器网路中,其特征在于,所述的无线传感器网络包含数个通信半径相同的信标节点,所述的移动机器人的通信半径与所述的数个信标节点的通信半径相同,所述的移动机器人在其通信半径内只与所述的无线传感器网络中的两个信标节点建立通信连接,在所述的移动机器人的通信半径外存在数个未建立通信连接的信标节点,所述的方法包括以下步骤:
(1)对所述的无线传感器网络建立二维直角坐标系,在二维直角坐标系内分布数个信标节点;
(2)与所述的移动机器人通信连接的两个信标节点分别根据其与所述的移动机器人的距离为半径、以自身的坐标信息为圆心做圆;
(3)根据两个圆的交点数量判断所述的移动机器人的实际坐标信息。
2.根据权利要求1所述的基于双信标节点实现移动机器人定位的方法,其特征在于,所述的根据两个圆的交点数量判断所述的移动机器人的实际坐标信息,具体包括以下步骤:
(3.1)判断两个圆的交点数量为一个还是两个,如果为一个交点,则继续步骤(3.2),如果为两个交点,则继续步骤(3.3);
(3.2)确定该交点的坐标信息并设定为所述的移动机器人的实际坐标信息;
(3.3)确定两个交点的坐标信息并设定为第一交点坐标和第二交点坐标;
(3.4)以第一交点坐标的坐标信息为圆心、以通信半径为半径做圆,如果圆内包含三个或三个以上的信标节点,则判定为无效交点坐标,并继续步骤(3.5),否则设定为所述的移动机器人的实际坐标信息;
(3.5)以第二交点坐标的坐标信息为圆心、以通信半径为半径做圆,如果圆内包含三个或三个以上的信标节点,则判定为无效交点坐标,并返回上述步骤(1),否则设定为所述的移动机器人的实际坐标信息。
3.根据权利要求2所述的基于双信标节点实现移动机器人定位的方法,其特征在于,所述的判断两个圆的交点数量为一个还是两个,具体为:
判断所述的移动机器人和与所述的移动机器人通信连接的两个信标节点是否共线,如果是,则判定为一个交点,否则判定为两个交点。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810184009.0A CN108513353B (zh) | 2018-03-07 | 2018-03-07 | 基于双信标节点实现移动机器人定位的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810184009.0A CN108513353B (zh) | 2018-03-07 | 2018-03-07 | 基于双信标节点实现移动机器人定位的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108513353A true CN108513353A (zh) | 2018-09-07 |
CN108513353B CN108513353B (zh) | 2020-06-16 |
Family
ID=63376152
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810184009.0A Active CN108513353B (zh) | 2018-03-07 | 2018-03-07 | 基于双信标节点实现移动机器人定位的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108513353B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109813315A (zh) * | 2019-01-02 | 2019-05-28 | 广州市康软信息科技有限公司 | 一种室内导航方法、系统及存储介质 |
CN112034494A (zh) * | 2020-09-14 | 2020-12-04 | 航科院中宇(北京)新技术发展有限公司 | 一种飞机飞行导航数据中导航点精度计算系统及方法 |
CN112055305A (zh) * | 2020-08-28 | 2020-12-08 | 太原理工大学 | 一种无线传感器网络未知传感器节点的两圆交点定位方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101389118A (zh) * | 2007-09-10 | 2009-03-18 | 大唐移动通信设备有限公司 | 一种移动终端的定位方法及定位系统 |
CN102209331A (zh) * | 2011-05-31 | 2011-10-05 | 河海大学常州校区 | 无线传感器网络中不规则传输模型下的节点定位方法 |
CN103327607A (zh) * | 2013-06-28 | 2013-09-25 | 河海大学常州校区 | 无线传感器网络多锚节点组移动路径规划方法 |
US20160182170A1 (en) * | 2014-06-10 | 2016-06-23 | PB, Inc | System Architectures and Methods for Radiobeacon Data Sharing |
-
2018
- 2018-03-07 CN CN201810184009.0A patent/CN108513353B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101389118A (zh) * | 2007-09-10 | 2009-03-18 | 大唐移动通信设备有限公司 | 一种移动终端的定位方法及定位系统 |
CN102209331A (zh) * | 2011-05-31 | 2011-10-05 | 河海大学常州校区 | 无线传感器网络中不规则传输模型下的节点定位方法 |
CN103327607A (zh) * | 2013-06-28 | 2013-09-25 | 河海大学常州校区 | 无线传感器网络多锚节点组移动路径规划方法 |
US20160182170A1 (en) * | 2014-06-10 | 2016-06-23 | PB, Inc | System Architectures and Methods for Radiobeacon Data Sharing |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109813315A (zh) * | 2019-01-02 | 2019-05-28 | 广州市康软信息科技有限公司 | 一种室内导航方法、系统及存储介质 |
CN112055305A (zh) * | 2020-08-28 | 2020-12-08 | 太原理工大学 | 一种无线传感器网络未知传感器节点的两圆交点定位方法 |
CN112034494A (zh) * | 2020-09-14 | 2020-12-04 | 航科院中宇(北京)新技术发展有限公司 | 一种飞机飞行导航数据中导航点精度计算系统及方法 |
CN112034494B (zh) * | 2020-09-14 | 2023-09-22 | 航科院中宇(北京)新技术发展有限公司 | 一种飞机飞行导航数据中导航点精度计算系统及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108513353B (zh) | 2020-06-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105547305B (zh) | 一种基于无线定位和激光地图匹配的位姿解算方法 | |
CN104655137B (zh) | 行人航迹推测辅助的Wi‑Fi信号指纹定位算法 | |
Kim et al. | Smartphone-based collaborative and autonomous radio fingerprinting | |
Shang et al. | Improvement schemes for indoor mobile location estimation: A survey | |
CN102419180B (zh) | 一种基于惯性导航系统和wifi的室内定位方法 | |
US10699573B1 (en) | Device locator | |
Boukerche et al. | Localization systems for wireless sensor networks | |
Sun et al. | Indoor positioning tightly coupled Wi-Fi FTM ranging and PDR based on the extended Kalman filter for smartphones | |
Du et al. | A hybrid outdoor localization scheme with high-position accuracy and low-power consumption | |
Cui et al. | Four-mobile-beacon assisted localization in three-dimensional wireless sensor networks | |
Tiglao et al. | Smartphone-based indoor localization techniques: State-of-the-art and classification | |
Ahn et al. | Simple pedestrian localization algorithms based on distributed wireless sensor networks | |
CN108151747A (zh) | 一种利用声信号与惯性导航融合的室内定位系统及定位方法 | |
CN102932742A (zh) | 基于惯性传感器与无线信号特征的室内定位方法及系统 | |
CN102033220A (zh) | 一种室内无线定位信息融合方法及系统 | |
CN108513353A (zh) | 基于双信标节点实现移动机器人定位的方法 | |
Manley et al. | Localization and tracking in sensor systems | |
CN108414977A (zh) | 基于无线传感器网络实现移动机器人定位的方法 | |
Brown et al. | Classification schemes of positioning technologies for indoor navigation | |
US11448509B1 (en) | System and method for facilitating limited area GPS | |
Martins et al. | OTMCL: Orientation tracking-based Monte Carlo localization for mobile sensor networks | |
Elfadil et al. | Indoor navigation algorithm for mobile robot using wireless sensor networks | |
CN108332749B (zh) | 一种室内动态追踪定位方法 | |
Lin et al. | An efficient outdoor localization method for smartphones | |
CN108414969A (zh) | 基于无线传感器网络实现移动机器人最大范围定位的方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |