CN105828291A - 一种无线传感网络高精度定位方法 - Google Patents
一种无线传感网络高精度定位方法 Download PDFInfo
- Publication number
- CN105828291A CN105828291A CN201610285587.4A CN201610285587A CN105828291A CN 105828291 A CN105828291 A CN 105828291A CN 201610285587 A CN201610285587 A CN 201610285587A CN 105828291 A CN105828291 A CN 105828291A
- Authority
- CN
- China
- Prior art keywords
- coordinate
- node
- tested node
- tested
- infrared camera
- 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
- 238000000034 method Methods 0.000 title claims abstract description 29
- 238000012545 processing Methods 0.000 claims description 28
- 239000000872 buffer Substances 0.000 claims description 24
- 230000005540 biological transmission Effects 0.000 claims description 14
- 230000004044 response Effects 0.000 claims description 12
- 238000012360 testing method Methods 0.000 claims description 12
- 230000010365 information processing Effects 0.000 claims description 6
- 238000013507 mapping Methods 0.000 claims description 6
- 238000011160 research Methods 0.000 abstract description 3
- 238000004891 communication Methods 0.000 abstract description 2
- 238000005516 engineering process Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010191 image analysis Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000010998 test method Methods 0.000 description 1
Classifications
-
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/16—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using electromagnetic waves other than radio waves
-
- 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/025—Services making use of location information using location based information parameters
-
- 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
- H04W84/00—Network topologies
- H04W84/18—Self-organising networks, e.g. ad-hoc networks or sensor networks
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明提供一种无线传感网络高精度定位方法,其特征在于,包括如下步骤:设置一组锚节点,并选择适当的位置作为坐标原点o,建立原点坐标系xoz,计算各个锚节点相对于坐标原点o的相对极坐标(r,δ),每个锚节点上设置有一组红外摄像头,计算各个红外摄像头的方向信息,将各个相对极坐标和红外摄像头方向信息录入对应的锚节点主控模块,被测节点上设置两个红外发光模块。本方法对无线传感网定位参考坐标获取这一核心为题提供低成本高精度的解决方案,对于无线传感网机近距离无线通信高精度定位系统研究具有重要的参考价值。
Description
技术领域
本发明涉及无线传感网络定位领域,具体地讲,涉及一种无线传感网络高精度定位方法。
背景技术
无线传感网(WSN)中的节点定位是WSN众多研究和应用的基础,也是一个研究热点。为了评价定位算法,我们需要获取高精度的参考坐标,采用普通的GPS定位方法定位精度能够达到2米以内,对于一些高精度定位而言不能满足需求;虽然通过差分GPS方法可以达到非常高的精度,但是这种方法花费极大,更重要的是GPS技术室内无法完成定位,而无线定位的试验环境很多时候是在室内或半开放环境下,因此我们需要一种通用、廉价、便捷的参考坐标提供系统和方法,摄像定位系统可以实现高精度的物体定位,但是通常这些系统需要非常复杂的图像处理算法、图像识别技术及强大的处理器来进行图像分析处理,要求很强的专业知识,开发难度大,我们设计了一种不同于传统摄像定位方法的低复杂度摄像实时定位系统,过滤掉无关的信息,能够用简单的算法实现较精度的实时定位。
发明内容
本发明要解决的技术问题是提供一种无线传感网络高精度定位方法,能够用简单的算法实现较精度的实时定位。
本发明采用如下技术方案实现发明目的:
一种无线传感网络高精度定位方法,其特征在于,包括如下步骤:
(1)设置一组锚节点,并选择适当的位置作为坐标原点o,建立原点坐标系xoz,计算各个锚节点相对于坐标原点o的相对极坐标(r,δ),每个锚节点上设置有一组红外摄像头,计算各个红外摄像头的方向信息,将各个相对极坐标和红外摄像头方向信息录入对应的锚节点主控模块,被测节点上设置两个红外发光模块;
(2)首先进行预测量操作,将两个间距为d红外发光模块竖直放置,其中位置较低的红外发光模块与锚节点的红外摄像头同高的位置,分别用红外摄像头拍摄距离红外发光模块不同设定距离时的红外图像,并求得每个红外图像的两个红外发光模块间的像素点数存入距离参考缓冲区DisRef[i],缓冲区格式如下:Dref[i]、nref[i],其中,Dref[i]表示不同设定距离,nref[i]表示不同设定距离对应的两个红外发光模块之间的像素点数,距离参考缓冲区DisRef[i]按照由大到小的顺序进行存储;
(3)其中一个锚节点自动成为主节点,每5秒钟在发送时隙T0发送一次系统同步指令SYSSYNC,其他锚节点在自己对应的锚节点时隙Tn发送应答无线数据包ACKSYSSYNC,被测节点在终端节点时隙Tt发送应答无线数据包TACKSYSSYNC,如果主节点收到应答无线数据包ACKSYSSYNC和TACKSYSSYNC,则转步骤(4),否则重复步骤(3);
(4)被测试节点按键在Tt时隙发送请求测试无线数据包ApplyTest,每个锚节点接收到请求数据包后在对应的Tn时隙发送ACKApplyTest数据包,被测节点接受到全部锚节点应答后开始测试进入步骤(5);
(5)被测节点按键打开红外发射模块,然后发送定位测试数据包LocTest,等待2秒后关闭红外发射模块,每个锚节点接收到无线数据包后通知对应的图像处理模块进行拍照,并对采集的图像信息进行处理,获取被测节点的全局坐标:
(6)各个锚节点将获取的原始数据和最终计算的被测节点全局坐标发送至主节点,主节点将接收的所有被测节点全局坐标取平均后得到最终的被测节点坐标,同时将坐标信息存入TF卡,然后将被测节点坐标信息发送至被测节点,被测节点接收到坐标信息后再显示模块上显示,至此完成一次定位。
作为对本技术方案的进一步限定,所述步骤(5)包括如下步骤:
(5.1)被测节点打开红外发射模块,然后发送定位测试数据包LocTest,锚节点接收到无线数据包后通知图像处理模块进行拍照,每个锚节点拍摄的图像不存在重叠现象,图像处理模块对采集的图像信息进行处理;
(5.2)将图像处理模块的处理信息发送到锚节点主控模块计算被测节点的相对坐标;
(5.3)通过极坐标运算就可以得到被测节点的全局坐标。
作为对本技术方案的进一步限定,所述步骤(5.1)的图像信息处理包括如下步骤:
(5.1.1)图像处理模块首先将N个发光区域的存储缓冲区Pos[N]清空,每个存储缓冲区有7个参数,分别为最小X坐标Xmin,最大X坐标Xmax,最小Y坐标Ymin,最大Y坐标Ymax,X坐标平均值Xavg,Y坐标平均值Yavg,像素点数量Num,上述参数的初始值均为0;
(5.1.2)然后将红外摄像头采集的灰度图像按照行列的顺序依次将各像素点发送至图像处理模块,图像处理模块判断每个像素点的亮度是否大于预设的强度阈值Ath,如果亮度大于Ath,则判断该像素点为发光点,然后将该像素点的坐标依次与每个存储缓冲区的参数进行比对:
如果像素点X坐标<Xmin-2或像素X坐标>Xmax+2,
同时
像素Y坐标<Ymin-2或像素Y坐标>Ymax+2,
则判断该像素点不在该发光区域内,查找下一个存储缓冲区;
否则判断该发光点在该发光区域内,更新存储缓冲区参数:
如果X坐标<Xmin,则Xmin=X坐标,
否则如果X坐标>Xmax,则Xmax=X坐标,
如果Y坐标<Ymin,则Ymin=Y坐标,
否则如果Y坐标>Ymax,则Ymax=Y坐标;
Xavg=(Xavg*Num+X坐标)/Num;
Yavg=(Yavg*Num+Y坐标)/Num;
Num=Num+1;
(5.1.3)如果该像素点不在所有的发光区域中,则判断为新的发光区域,新的发光区域的存储缓冲区Pos[m]的参数设置如下:
Xmin=X坐标;
Xmax=X坐标;
Ymin=Y坐标;
Ymax=Y坐标;
Xavg=X坐标;
Yavg=Y坐标;
Num=1;
(5.1.4)当所有的像素点传输完毕后图像处理模块将所有存储缓冲区信息处理,首先选择满足如下条件的发光区域以降低误差:
Xavg-Xmin>Rxth同时Xmax-Xavg>Rxth同时Yavg-Ymin>Ryth同时Ymax-Yavg>RYth,Rxth,Ryth为系统设置的发光区域最小有效半径;然后选出所有发光区域Xavg相差5以内的发光区域,如有2个发光区域满足条件则表明成功拍摄到被测节点,否则表明未拍摄到被测节点。
作为对本技术方案的进一步限定,所述步骤(5.2)包括如下步骤:
(5.2.1)获取被测节点的高度:
其中,nt为拍摄图像中两个发光区域中心点间的像素点数,假设较高的发光区域中心点Y坐标为Yavg1,较低的发光区域中心点Y坐标为Yavg2,则nt=(Yavg1-Yavg2);Yimagemax表示拍摄图像的高度,d表示两个红外发光模块的实际间距;
(5.2.2)计算红外摄像头与被测节点的距离Dis,具体步骤如下:
首先在距离参考缓冲区DisRef[i]中查找nt,当nref[i]<nt或者nref[i]=nt时停止查找,
如果nref[i]=nt,则被测节点与摄像头距离Dis=Dref[i];
否则Dis=nt*(Dref[i]-Dref[i-1])/(nref[i]-nref[i-1])
如果没有找到则:
Dis=nt*(Dref[Nmax-1]-Dref[Nmax-2])/(nref[Nmax-1]-nref[Nmax-2]),Nmax表示Dref和nref数组的最大数量;
(5.2.3)计算被测节点的相对坐标,具体步骤如下:
首先建立垂直于拍摄图像XY平面的XZ平面,XZ平面穿过红外摄像头且与两个被测节点连线垂直,拍摄图像平面为XY平面,红外摄像头在XY平面的投影位于拍摄图像中心O1(nx/2,ny/2),在XY平面上穿过拍摄图像中心O1且与两个被测节点连线垂直的直线为拍摄图像X轴,在XY平面上穿过拍摄图像中心O1且与拍摄图像X轴垂直的为拍摄图像Y轴,在XZ平面上穿过拍摄图像中心O1和红外摄像头的直线为拍摄图像Z轴,nx为拍摄图像的宽度,ny为拍摄图像的高度,拍摄图像的中心O1距离两个被测节点连线的距离Dx为:
红外摄像头与被测节点的距离Dis在XZ平面映射距离Diszx为:
红外摄像头与拍摄图像中心O1的距离Dz为
Diszx与Dz的水平夹角γ计算如下:
被测节点相对摄像头在XZ平面上的相对坐标为(Diszx,γ)。
作为对本技术方案的进一步限定,所述红外摄像头的方向信息是指红外摄像头与原点坐标系xoz的x轴在XZ平面的夹角β。
作为对本技术方案的进一步限定,所述步骤(5.3)包括如下步骤:
被测节点在xz平面上与红外摄像头的夹角为γ;
被测节点相对锚节点的高度Dy,也就是被测节点距离XZ平面的高度,即被测节点的实际的Y向坐标为:
所以可以得到被测节点相对锚节点x轴坐标:
被测节点相对红外摄像头在XZ平面上映射距离为Diszx,又已知红外摄像头与原点坐标系的x轴在XZ平面夹角为β,因此被测节点相对红外摄像头在XZ平面上与原点坐标系的x轴的夹角为β+γ;
最后利用各锚节点的相对极坐标(r,δ)计算得到被测节点相对于原点o的坐标,被测节点的全局x向坐标为:r·cos(δ)+Diszx·cos(β+γ);被测节点的全局z向坐标为:r·sin(δ)+Diszx·sin(β+γ)。
与现有技术相比,本发明的优点和积极效果是:本测试方法通过在被测节点安装红外发光模块,定位锚节点上安装多台单通道红外摄像头采集图像信息,得到被测节点红外发光区域大小和位置计算得到被测节点的三维坐标,通过多锚节点协同得到精确的位置信息,为无线传感网定位提供高精度的参考位置信息。本方法对无线传感网定位参考坐标获取这一核心为题提供低成本高精度的解决方案,对于无线传感网机近距离无线通信高精度定位系统研究具有重要的参考价值。
附图说明
图1为本发明的被测节点控制装置的原理方框图。
图2为本发明的锚节点控制装置的原理方框图。
图3为本发明的被测节点所处的无线网络的结构示意图。
图4为本发明的原点坐标系和红外摄像头关系的结构示意图。
图5为本发明的拍摄图像的结构示意图。
图6为本发明的XY平面和XZ平面的结构示意图。
具体实施方式
下面结合附图和优选实施例对本发明作更进一步的详细说明。
参见图1-图6,本发明的硬件部分包括被测节点控制装置和锚节点控制装置,所述被测节点控制装置包括被测节点主控模块1,所述被测节点主控模块1分别连接被测节点无线模块2和两个红外发射模块3,所述锚节点控制装置包括锚节点主控模块7,所述锚节点主控模块7分别连接锚节点无线模块8和图像处理模块9,每个所述图像处理模块9分别连接红外摄像头10,所述被测节点无线模块和锚节点无线模块分别连接有天线6。
所述被测节点主控模块1还连接被测节点显示模块4和被测节点键盘模块5。所述锚节点主控模块7还连接锚节点显示模块11和锚节点键盘模块12,被测节点显示模块4和锚节点显示模块11采用OLED模块。
两个所述红外发射模块3竖直放置,两个所述红外摄像头10的夹角为90-120度。
所述被测节点控制装置和所述锚节点控制装置都设置于支架13上,所述被测节点控制装置和所述锚节点控制装置都设置有电源模块14。
本发明包括如下步骤:
(1)设置一组锚节点,并选择适当的位置作为坐标原点o,建立原点坐标系xoz,计算各个锚节点相对于坐标原点o的相对极坐标(r,δ),每个锚节点上设置有一组红外摄像头,计算各个红外摄像头的方向信息,将各个相对极坐标和红外摄像头方向信息录入对应的锚节点主控模块,被测节点上设置两个红外发光模块;
(2)首先进行预测量操作,将两个间距为d红外发光模块竖直放置,其中位置较低的红外发光模块与锚节点的红外摄像头同高的位置,分别用红外摄像头拍摄距离红外发光模块不同设定距离时的红外图像,并求得每个红外图像的两个红外发光模块间的像素点数存入距离参考缓冲区DisRef[i],缓冲区格式如下:
Dref[i]、nref[i],其中,Dref[i]表示不同设定距离,nref[i]表示不同设定距离对应的两个红外发光模块之间的像素点数,距离参考缓冲区DisRef[i]按照由大到小的顺序进行存储;
(3)其中一个锚节点自动成为主节点,每5秒钟在发送时隙T0发送一次系统同步指令SYSSYNC,其他锚节点在自己对应的锚节点时隙Tn发送应答无线数据包ACKSYSSYNC,被测节点在终端节点时隙Tt发送应答无线数据包TACKSYSSYNC,如果主节点收到应答无线数据包ACKSYSSYNC和TACKSYSSYNC,则转步骤(4),否则重复步骤(3);
(4)被测试节点按键在Tt时隙发送请求测试无线数据包ApplyTest,每个锚节点接收到请求数据包后在对应的Tn时隙发送ACKApplyTest数据包,被测节点接受到全部锚节点应答后开始测试进入步骤(5);
(5)被测节点按键打开红外发射模块,然后发送定位测试数据包LocTest,等待2秒后关闭红外发射模块,每个锚节点接收到无线数据包后通知对应的图像处理模块进行拍照,并对采集的图像信息进行处理,获取被测节点的全局坐标:
(6)各个锚节点将获取的原始数据和最终计算的被测节点全局坐标发送至主节点,主节点将接收的所有被测节点全局坐标取平均后得到最终的被测节点坐标,同时将坐标信息存入TF卡,然后将被测节点坐标信息发送至被测节点,被测节点接收到坐标信息后再显示模块上显示,至此完成一次定位。
所述步骤(5)包括如下步骤:
(5.1)被测节点打开红外发射模块,然后发送定位测试数据包LocTest,锚节点接收到无线数据包后通知图像处理模块进行拍照,每个锚节点拍摄的图像不存在重叠现象,图像处理模块对采集的图像信息进行处理;
(5.2)将图像处理模块的处理信息发送到锚节点主控模块计算被测节点的相对坐标;
(5.3)通过极坐标运算就可以得到被测节点的全局坐标。
所述步骤(5.1)的图像信息处理包括如下步骤:
(5.1.1)图像处理模块首先将N个发光区域的存储缓冲区Pos[N]清空,每个存储缓冲区有7个参数,分别为最小X坐标Xmin,最大X坐标Xmax,最小Y坐标Ymin,最大Y坐标Ymax,X坐标平均值Xavg,Y坐标平均值Yavg,像素点数量Num,上述参数的初始值均为0;
(5.1.2)然后将红外摄像头采集的灰度图像按照行列的顺序依次将各像素点发送至图像处理模块,图像处理模块判断每个像素点的亮度是否大于预设的强度阈值Ath,如果亮度大于Ath,则判断该像素点为发光点,然后将该像素点的坐标依次与每个存储缓冲区的参数进行比对:
如果像素点X坐标<Xmin-2或像素X坐标>Xmax+2,
同时
像素Y坐标<Ymin-2或像素Y坐标>Ymax+2,
则判断该像素点不在该发光区域内,查找下一个存储缓冲区;
否则判断该发光点在该发光区域内,更新存储缓冲区参数:
如果X坐标<Xmin,则Xmin=X坐标,
否则如果X坐标>Xmax,则Xmax=X坐标,
如果Y坐标<Ymin,则Ymin=Y坐标,
否则如果Y坐标>Ymax,则Ymax=Y坐标;
Xavg=(Xavg*Num+X坐标)/Num;
Yavg=(Yavg*Num+Y坐标)/Num;
Num=Num+1;
(5.1.3)如果该像素点不在所有的发光区域中,则判断为新的发光区域,新的发光区域的存储缓冲区Pos[m]的参数设置如下:
Xmin=X坐标;
Xmax=X坐标;
Ymin=Y坐标;
Ymax=Y坐标;
Xavg=X坐标;
Yavg=Y坐标;
Num=1;
(5.1.4)当所有的像素点传输完毕后图像处理模块将所有存储缓冲区信息处理,首先选择满足如下条件的发光区域以降低误差:
Xavg-Xmin>Rxth同时Xmax-Xavg>Rxth同时Yavg-Ymin>Ryth同时Ymax-Yavg>RYth,Rxth,Ryth为系统设置的发光区域最小有效半径;然后选出所有发光区域Xavg相差5以内的发光区域,如有2个发光区域满足条件则表明成功拍摄到被测节点,否则表明未拍摄到被测节点。
所述步骤(5.2)包括如下步骤:
(5.2.1)获取被测节点的高度:
其中,nt为拍摄图像中两个发光区域中心点间的像素点数,假设较高的发光区域中心点Y坐标为Yavg1,较低的发光区域中心点Y坐标为Yavg2,则nt=(Yavg1-Yavg2);Yimagemax表示拍摄图像的高度,d表示两个红外发光模块的实际间距;
(5.2.2)计算红外摄像头与被测节点的距离Dis,具体步骤如下:
首先在距离参考缓冲区DisRef[i]中查找nt,当nref[i]<nt或者nref[i]=nt时停止查找,
如果nref[i]=nt,则被测节点与摄像头距离Dis=Dref[i];
否则Dis=nt*(Dref[i]-Dref[i-1])/(nref[i]-nref[i-1])
如果没有找到则:
Dis=nt*(Dref[Nmax-1]-Dref[Nmax-2])/(nref[Nmax-1]-nref[Nmax-2]),Nmax表示Dref和nref数组的最大数量;
(5.2.3)计算被测节点的相对坐标,具体步骤如下:
首先建立垂直于拍摄图像XY平面的XZ平面,XZ平面穿过红外摄像头且与两个被测节点连线垂直,拍摄图像平面为XY平面,红外摄像头在XY平面的投影位于拍摄图像中心O1(nx/2,ny/2),在XY平面上穿过拍摄图像中心O1且与两个被测节点连线垂直的直线为拍摄图像X轴,在XY平面上穿过拍摄图像中心O1且与拍摄图像X轴垂直的为拍摄图像Y轴,在XZ平面上穿过拍摄图像中心O1和红外摄像头的直线为拍摄图像Z轴,nx为拍摄图像的宽度,ny为拍摄图像的高度,拍摄图像的中心O1距离两个被测节点连线的距离Dx为:
红外摄像头与被测节点的距离Dis在XZ平面映射距离Diszx为:
红外摄像头与拍摄图像中心O1的距离Dz为
Diszx与Dz的水平夹角γ计算如下:
被测节点相对摄像头在XZ平面上的相对坐标为(Diszx,γ)。
所述红外摄像头的方向信息是指红外摄像头与原点坐标系xoz的x轴在XZ平面的夹角β。
所述步骤(5.3)包括如下步骤:
被测节点在xz平面上与红外摄像头的夹角为γ;
被测节点相对锚节点的高度Dy,也就是被测节点距离XZ平面的高度,即被测节点的实际的Y向坐标为:
所以可以得到被测节点相对锚节点x轴坐标:
被测节点相对红外摄像头在XZ平面上映射距离为Diszx,又已知红外摄像头与原点坐标系的x轴在XZ平面夹角为β,因此被测节点相对红外摄像头在XZ平面上与原点坐标系的x轴的夹角为β+γ;
最后利用各锚节点的相对极坐标(r,δ)计算得到被测节点相对于原点o的坐标,被测节点的全局x向坐标为:r·cos(δ)+Diszx·cos(β+γ);被测节点的全局z向坐标为:r·sin(δ)+Diszx·sin(β+γ)。
Claims (6)
1.一种无线传感网络高精度定位方法,其特征在于,包括如下步骤:
(1)设置一组锚节点,并选择适当的位置作为坐标原点o,建立原点坐标系xoz,计算各个锚节点相对于坐标原点o的相对极坐标(r,δ),每个锚节点上设置有一组红外摄像头,计算各个红外摄像头的方向信息,将各个相对极坐标和红外摄像头方向信息录入对应的锚节点主控模块,被测节点上设置两个红外发光模块;
(2)首先进行预测量操作,将两个间距为d红外发光模块竖直放置,其中位置较低的红外发光模块与锚节点的红外摄像头同高的位置,分别用红外摄像头拍摄距离红外发光模块不同设定距离时的红外图像,并求得每个红外图像的两个红外发光模块间的像素点数存入距离参考缓冲区DisRef[i],缓冲区格式如下:
Dref[i]、nref[i],其中,Dref[i]表示不同设定距离,nref[i]表示不同设定距离对应的两个红外发光模块之间的像素点数,距离参考缓冲区DisRef[i]按照由大到小的顺序进行存储;
(3)其中一个锚节点自动成为主节点,每5秒钟在发送时隙T0发送一次系统同步指令SYSSYNC,其他锚节点在自己对应的锚节点时隙Tn发送应答无线数据包ACKSYSSYNC,被测节点在终端节点时隙Tt发送应答无线数据包TACKSYSSYNC,如果主节点收到应答无线数据包ACKSYSSYNC和TACKSYSSYNC,则转步骤(4),否则重复步骤(3);
(4)被测试节点按键在Tt时隙发送请求测试无线数据包ApplyTest,每个锚节点接收到请求数据包后在对应的Tn时隙发送ACKApplyTest数据包,被测节点接受到全部锚节点应答后开始测试进入步骤(5);
(5)被测节点按键打开红外发射模块,然后发送定位测试数据包LocTest,等待2秒后关闭红外发射模块,每个锚节点接收到无线数据包后通知对应的图像处理模块进行拍照,并对采集的图像信息进行处理,获取被测节点的全局坐标:
(6)各个锚节点将获取的原始数据和最终计算的被测节点全局坐标发送至主节点,主节点将接收的所有被测节点全局坐标取平均后得到最终的被测节点坐标,同时将坐标信息存入TF卡,然后将被测节点坐标信息发送至被测节点,被测节点接收到坐标信息后再显示模块上显示,至此完成一次定位。
2.根据权利要求1所述的无线传感网络高精度定位方法,其特征在于,所述步骤(5)包括如下步骤:
(5.1)被测节点打开红外发射模块,然后发送定位测试数据包LocTest,锚节点接收到无线数据包后通知图像处理模块进行拍照,每个锚节点拍摄的图像不存在重叠现象,图像处理模块对采集的图像信息进行处理;
(5.2)将图像处理模块的处理信息发送到锚节点主控模块计算被测节点的相对坐标;
(5.3)通过极坐标运算就可以得到被测节点的全局坐标。
3.根据权利要求2所述的无线传感网络高精度定位方法,其特征在于,所述步骤(5.1)的图像信息处理包括如下步骤:
(5.1.1)图像处理模块首先将N个发光区域的存储缓冲区Pos[N]清空,每个存储缓冲区有7个参数,分别为最小X坐标Xmin,最大X坐标Xmax,最小Y坐标Ymin,最大Y坐标Ymax,X坐标平均值Xavg,Y坐标平均值Yavg,像素点数量Num,上述参数的初始值均为0;
(5.1.2)然后将红外摄像头采集的灰度图像按照行列的顺序依次将各像素点发送至图像处理模块,图像处理模块判断每个像素点的亮度是否大于预设的强度阈值Ath,如果亮度大于Ath,则判断该像素点为发光点,然后将该像素点的坐标依次与每个存储缓冲区的参数进行比对:
如果像素点X坐标<Xmin-2或像素X坐标>Xmax+2,
同时
像素Y坐标<Ymin-2或像素Y坐标>Ymax+2,
则判断该像素点不在该发光区域内,查找下一个存储缓冲区;
否则判断该发光点在该发光区域内,更新存储缓冲区参数:
如果X坐标<Xmin,则Xmin=X坐标,
否则如果X坐标>Xmax,则Xmax=X坐标,
如果Y坐标<Ymin,则Ymin=Y坐标,
否则如果Y坐标>Ymax,则Ymax=Y坐标;
Xavg=(Xavg*Num+X坐标)/Num;
Yavg=(Yavg*Num+Y坐标)/Num;
Num=Num+1;
(5.1.3)如果该像素点不在所有的发光区域中,则判断为新的发光区域,新的发光区域的存储缓冲区Pos[m]的参数设置如下:
Xmin=X坐标;
Xmax=X坐标;
Ymin=Y坐标;
Ymax=Y坐标;
Xavg=X坐标;
Yavg=Y坐标;
Num=1;
(5.1.4)当所有的像素点传输完毕后图像处理模块将所有存储缓冲区信息处理,首先选择满足如下条件的发光区域以降低误差:
Xavg-Xmin>Rxth同时Xmax-Xavg>Rxth同时Yavg-Ymin>Ryth同时Ymax-Yavg>RYth,Rxth,Ryth为系统设置的发光区域最小有效半径;然后选出所有发光区域Xavg相差5以内的发光区域,如有2个发光区域满足条件则表明成功拍摄到被测节点,否则表明未拍摄到被测节点。
4.根据权利要求3所述的无线传感网络高精度定位方法,其特征在于,所述步骤(5.2)包括如下步骤:
(5.2.1)获取被测节点的高度:
其中,nt为拍摄图像中两个发光区域中心点间的像素点数,假设较高的发光区域中心点Y坐标为Yavg1,较低的发光区域中心点Y坐标为Yavg2,则nt=(Yavg1-Yavg2);Yimagemax表示拍摄图像的高度,d表示两个红外发光模块的实际间距;
(5.2.2)计算红外摄像头与被测节点的距离Dis,具体步骤如下:
首先在距离参考缓冲区DisRef[i]中查找nt,当nref[i]<nt或者nref[i]=nt时停止查找,
如果nref[i]=nt,则被测节点与摄像头距离Dis=Dref[i];
否则Dis=nt*(Dref[i]-Dref[i-1])/(nref[i]-nref[i-1])
如果没有找到则:
Dis=nt*(Dref[Nmax-1]-Dref[Nmax-2])/(nref[Nmax-1]-nref[Nmax-2]),Nmax表示Dref和nref数组的最大数量;
(5.2.3)计算被测节点的相对坐标,具体步骤如下:
首先建立垂直于拍摄图像XY平面的XZ平面,XZ平面穿过红外摄像头且与两个被测节点连线垂直,拍摄图像平面为XY平面,红外摄像头在XY平面的投影位于拍摄图像中心O1(nx/2,ny/2),在XY平面上穿过拍摄图像中心O1且与两个被测节点连线垂直的直线为拍摄图像X轴,在XY平面上穿过拍摄图像中心O1且与拍摄图像X轴垂直的为拍摄图像Y轴,在XZ平面上穿过拍摄图像中心O1和红外摄像头的直线为拍摄图像Z轴,nx为拍摄图像的宽度,ny为拍摄图像的高度,拍摄图像的中心O1距离两个被测节点连线的距离Dx为:
红外摄像头与被测节点的距离Dis在XZ平面映射距离Diszx为:
红外摄像头与拍摄图像中心O1的距离Dz为
Diszx与Dz的水平夹角γ计算如下:
被测节点相对摄像头在XZ平面上的相对坐标为(Diszx,γ)。
5.根据权利要求4所述的无线传感网络高精度定位方法,其特征在于,所述红外摄像头的方向信息是指红外摄像头与原点坐标系xoz的x轴在XZ平面的夹角β。
6.根据权利要求5所述的无线传感网络高精度定位方法,其特征在于,所述步骤(5.3)包括如下步骤:
被测节点在xz平面上与红外摄像头的夹角为γ;
被测节点相对锚节点的高度Dy,也就是被测节点距离XZ平面的高度,即被测节点的实际的Y向坐标为:
所以可以得到被测节点相对锚节点x轴坐标:
被测节点相对红外摄像头在XZ平面上映射距离为Diszx,又已知红外摄像头与原点坐标系的x轴在XZ平面夹角为β,因此被测节点相对红外摄像头在XZ平面上与原点坐标系的x轴的夹角为β+γ;
最后利用各锚节点的相对极坐标(r,δ)计算得到被测节点相对于原点o的坐标,被测节点的全局x向坐标为:r·cos(δ)+Diszx·cos(β+γ);
被测节点的全局z向坐标为:r·sin(δ)+Diszx·sin(β+γ)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610285587.4A CN105828291B (zh) | 2016-05-03 | 2016-05-03 | 一种无线传感网络高精度定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610285587.4A CN105828291B (zh) | 2016-05-03 | 2016-05-03 | 一种无线传感网络高精度定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105828291A true CN105828291A (zh) | 2016-08-03 |
CN105828291B CN105828291B (zh) | 2019-04-19 |
Family
ID=56528095
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610285587.4A Expired - Fee Related CN105828291B (zh) | 2016-05-03 | 2016-05-03 | 一种无线传感网络高精度定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105828291B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108445891A (zh) * | 2018-05-28 | 2018-08-24 | 山东华力机电有限公司 | 一种agv小车光学导航系统和导航方法 |
CN111139579A (zh) * | 2019-12-27 | 2020-05-12 | 杭州晶一智能科技有限公司 | 基于纵向宽度分布的纺机纱线监测方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012048708A (ja) * | 2010-08-26 | 2012-03-08 | Fuji Xerox Co Ltd | コミュニケーション支援装置およびプログラム |
CN104778690A (zh) * | 2015-04-02 | 2015-07-15 | 中国电子科技集团公司第二十八研究所 | 一种基于摄像机网络的多目标定位方法 |
-
2016
- 2016-05-03 CN CN201610285587.4A patent/CN105828291B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012048708A (ja) * | 2010-08-26 | 2012-03-08 | Fuji Xerox Co Ltd | コミュニケーション支援装置およびプログラム |
CN104778690A (zh) * | 2015-04-02 | 2015-07-15 | 中国电子科技集团公司第二十八研究所 | 一种基于摄像机网络的多目标定位方法 |
Non-Patent Citations (2)
Title |
---|
MA,HUADONG 等: "Correlation Based Video Processing in Video Sensor Networks", 《2005 INTERNATIONAL CONFERENCE ON WIRELESS NETWORKS, COMMUNICATIONS AND MOBILE COMPUTING》 * |
陈长英 等: "无线多媒体传感器网络的关键技术研究进展", 《山东科学》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108445891A (zh) * | 2018-05-28 | 2018-08-24 | 山东华力机电有限公司 | 一种agv小车光学导航系统和导航方法 |
CN111139579A (zh) * | 2019-12-27 | 2020-05-12 | 杭州晶一智能科技有限公司 | 基于纵向宽度分布的纺机纱线监测方法 |
Also Published As
Publication number | Publication date |
---|---|
CN105828291B (zh) | 2019-04-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR101728123B1 (ko) | 지구 자기장을 이용한 동시 로컬리제이션 및 매핑 | |
CN103983262A (zh) | 基于光通信的行进路线确定方法和装置 | |
CN106646566A (zh) | 乘客定位方法、装置及系统 | |
EP3779360A1 (en) | Indoor positioning method, indoor positioning system, indoor positioning device, and computer readable medium | |
CN103442436A (zh) | 一种室内定位终端、网络、系统及其方法 | |
CN108120436A (zh) | 一种iBeacon辅助地磁室内实景导航方法 | |
US20100310125A1 (en) | Method and Device for Detecting Distance, Identifying Positions of Targets, and Identifying Current Position in Smart Portable Device | |
US10107629B2 (en) | Information processing system, information processing method, and non-transitory computer readable storage medium | |
CN109916408A (zh) | 机器人室内定位和导航方法、装置、设备及存储介质 | |
CN106370160A (zh) | 一种机器人室内定位系统和方法 | |
CN106352871A (zh) | 一种基于天花板人工信标的视觉室内定位系统和方法 | |
CN108803683A (zh) | 基于ZigBee无线传感网络的多摄像头追踪拍摄系统和方法 | |
CN105848284A (zh) | 一种无线传感网络高精度定位系统 | |
CN107193820B (zh) | 位置信息获取方法、装置及设备 | |
CN105828291A (zh) | 一种无线传感网络高精度定位方法 | |
CN112422653A (zh) | 基于位置服务的场景信息推送方法、系统、存储介质及设备 | |
KR20200002219A (ko) | 실내 길안내 장치 및 그 방법 | |
CN109636850A (zh) | 面向室内智能灯下的可见光定位方法 | |
CN107347209A (zh) | 基于Beacon技术的三点共线定位方法 | |
CN111354037A (zh) | 一种定位方法及系统 | |
CN107196704A (zh) | 终端定位方法、装置和电子设备 | |
CN110319830B (zh) | 基于地磁数据的定位处理方法、装置及设备 | |
CN110796706A (zh) | 视觉定位方法及系统 | |
US11085992B2 (en) | System and method for positioning a terminal device | |
CN108834044B (zh) | 一种基于三维标定的共享单车WiFi定位方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20190419 |