CN105848284B - 一种无线传感网络高精度定位系统 - Google Patents
一种无线传感网络高精度定位系统 Download PDFInfo
- Publication number
- CN105848284B CN105848284B CN201610286648.9A CN201610286648A CN105848284B CN 105848284 B CN105848284 B CN 105848284B CN 201610286648 A CN201610286648 A CN 201610286648A CN 105848284 B CN105848284 B CN 105848284B
- Authority
- CN
- China
- Prior art keywords
- coordinate
- node
- tested
- module
- 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.)
- Expired - Fee Related
Links
- 238000004891 communication Methods 0.000 claims abstract description 14
- 238000012545 processing Methods 0.000 claims description 31
- 239000000872 buffer Substances 0.000 claims description 28
- 238000012360 testing method Methods 0.000 claims description 15
- 230000005540 biological transmission Effects 0.000 claims description 14
- 230000004044 response Effects 0.000 claims description 9
- 230000010365 information processing Effects 0.000 claims description 6
- 238000013507 mapping Methods 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 4
- 238000007781 pre-processing Methods 0.000 claims description 3
- 239000012536 storage buffer Substances 0.000 claims description 3
- 238000000034 method Methods 0.000 abstract description 8
- 238000011160 research Methods 0.000 abstract description 4
- 238000010586 diagram Methods 0.000 description 6
- 241000208340 Araliaceae Species 0.000 description 2
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 2
- 235000003140 Panax quinquefolius Nutrition 0.000 description 2
- 230000003139 buffering effect Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 235000008434 ginseng Nutrition 0.000 description 2
- 238000011161 development Methods 0.000 description 1
- 238000010191 image analysis Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000008092 positive effect Effects 0.000 description 1
- 238000010998 test method Methods 0.000 description 1
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
-
- 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
- H04W84/00—Network topologies
- H04W84/18—Self-organising networks, e.g. ad-hoc networks or sensor networks
Abstract
本发明提供一种无线传感网络高精度定位系统，其特征在于，包括初始化模块：设置一组锚节点，并选择适当的位置作为坐标原点o，建立原点坐标系xoz,计算各个锚节点相对于坐标原点o的相对极坐标(r,δ)，每个锚节点上设置有一组红外摄像头，计算各个红外摄像头的方向信息，将各个相对极坐标和红外摄像头方向信息录入对应的锚节点主控模块，被测节点上设置两个红外发光模块。本方法对无线传感网定位参考坐标获取这一核心为题提供低成本高精度的解决方案，对于无线传感网机近距离无线通信高精度定位系统研究具有重要的参考价值。
Description
技术领域
本发明涉及无线传感网络定位领域，具体地讲，涉及一种无线传感网络高精度定位系统。
背景技术
无线传感网(WSN)中的节点定位是WSN众多研究和应用的基础，也是一个研究热点。为了评价定位算法，我们需要获取高精度的参考坐标，采用普通的GPS定位方法定位精度能够达到2米以内，对于一些高精度定位而言不能满足需求；虽然通过差分GPS方法可以达到非常高的精度，但是这种方法花费极大，更重要的是GPS技术室内无法完成定位，而无线定位的试验环境很多时候是在室内或半开放环境下，因此我们需要一种通用、廉价、便捷的参考坐标提供系统和方法，摄像定位系统可以实现高精度的物体定位，但是通常这些系统需要非常复杂的图像处理算法、图像识别技术及强大的处理器来进行图像分析处理，要求很强的专业知识，开发难度大，我们设计了一种不同于传统摄像定位方法的低复杂度摄像实时定位系统，过滤掉无关的信息，能够用简单的算法实现较精度的实时定位。
发明内容
本发明要解决的技术问题是提供一种无线传感网络高精度定位系统，能够用简单的算法实现较精度的实时定位。
本发明采用如下技术方案实现发明目的：
一种无线传感网络高精度定位系统，其特征在于，包括如下模块：
初始化模块：设置一组锚节点，并选择适当的位置作为坐标原点o，建立原点坐标系xoz,计算各个锚节点相对于坐标原点o的相对极坐标(r,δ)，每个锚节点上设置有一组红外摄像头，计算各个红外摄像头的方向信息，将各个相对极坐标和红外摄像头方向信息录入对应的锚节点主控模块，被测节点上设置两个红外发光模块；
预处理模块：首先进行预测量操作,将两个间距为d红外发光模块竖直放置，其中位置较低的红外发光模块与锚节点的红外摄像头同高的位置，分别用红外摄像头拍摄距离红外发光模块不同设定距离时的红外图像，并求得每个红外图像的两个红外发光模块间的像素点数存入距离参考缓冲区DisRef[i],缓冲区格式如下：Dref[i]、nref[i]，其中，Dref[i]表示不同设定距离，nref[i]表示不同设定距离对应的两个红外发光模块之间的像素点数，距离参考缓冲区DisRef[i]按照由大到小的顺序进行存储；
无线通信测试模块：其中一个锚节点自动成为主节点，每5秒钟在发送时隙T0发送一次系统同步指令SYSSYNC，其他锚节点在自己对应的锚节点时隙Tn发送应答无线数据包ACKSYSSYNC，被测节点在终端节点时隙Tt发送应答无线数据包TACKSYSSYNC，如果主节点收到应答无线数据包ACKSYSSYNC和TACKSYSSYNC，则表明无线网络通信成功，否则，持续测试直到网络通信成功；
拍照前同步通信模块：被测试节点按键在Tt时隙发送请求测试无线数据包ApplyTest，每个锚节点接收到请求数据包后在对应的Tn时隙发送ACKApplyTest数据包，被测节点接收到全部锚节点的应答数据包；
被测节点全局坐标计算模块：被测节点按键打开红外发射模块，然后发送定位测试数据包LocTest，等待2秒后关闭红外发射模块，每个锚节点接收到无线数据包后通知对应的图像处理模块进行拍照，并对采集的图像信息进行处理，获取被测节点的全局坐标：
被测节点最终坐标计算模块：各个锚节点将获取的原始数据和最终计算的被测节点全局坐标发送至主节点，主节点将接收的所有被测节点坐标取平均后得到最终的被测节点坐标，同时将坐标信息存入TF卡，然后将被测节点坐标信息发送至被测节点，被测节点接收到坐标信息后在显示模块上显示，至此完成一次定位。
作为对本技术方案的进一步限定，所述被测节点全局坐标计算模块包括如下步骤：
(1)被测节点打开红外发射模块，然后发送定位测试数据包LocTest，锚节点接收到无线数据包后通知图像处理模块进行拍照，每个锚节点拍摄的图像不存在重叠现象，图像处理模块对采集的图像信息进行处理；
(2)将图像处理模块的处理信息发送到锚节点主控模块计算被测节点的相对坐标；
(3)通过极坐标运算就可以得到被测节点的全局坐标。
作为对本技术方案的进一步限定，所述步骤(1)的图像信息处理包括如下步骤：
(1.1)图像处理模块首先将N个发光区域的存储缓冲区Pos[N]清空，每个存储缓冲区有7个参数，分别为最小X坐标Xmin，最大X坐标Xmax，最小Y坐标Ymin，最大Y坐标Ymax，X坐标平均值Xavg，Y坐标平均值Yavg，像素点数量Num，上述参数的初始值均为0；
(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；
(1.3)如果该像素点不在所有的发光区域中，则判断为新的发光区域，新的发光区域的存储缓冲区Pos[m]的参数设置如下:
Xmin＝X坐标；
Xmax＝X坐标；
Ymin＝Y坐标；
Ymax＝Y坐标；
Xavg＝X坐标；
Yavg＝Y坐标；
Num＝1；
(1.4)当所有的像素点传输完毕后图像处理模块将所有存储缓冲区信息处理，首先选择满足如下条件的发光区域以降低误差：
Xavg-Xmin>Rxth同时Xmax-Xavg>Rxth同时Yavg-Ymin>Ryth同时Ymax-Yavg>RYth，Rxth,Ryth为系统设置的发光区域最小有效半径；然后选出所有发光区域Xavg相差5以内的发光区域，如有2个发光区域满足条件则表明成功拍摄到被测节点，否则表明未拍摄到被测节点。
作为对本技术方案的进一步限定，所述步骤(2)包括如下步骤：
(2.1)获取被测节点的高度：
其中，nt为拍摄图像中两个发光区域中心点间的像素点数，假设较高的发光区域中心点Y坐标为Yavg1,较低的发光区域中心点Y坐标为Yavg2,则nt＝(Yavg1-Yavg2)；Yimagemax表示拍摄图像的高度，d表示两个红外发光模块的实际间距；
(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数组的最大数量；
(2.3)计算被测节点的坐标，具体步骤如下：
首先建立垂直于拍摄图像XY平面的XZ平面，XZ平面穿过红外摄像头且与两个被测节点连线垂直，拍摄图像平面为XY平面，红外摄像头在XY平面的投影位于拍摄图像的中心o(nx/2,ny/2)，nx为拍摄图像的宽度，ny为拍摄图像的高度，拍摄图像的中心o距离两个被测节点连线的距离Dx为：；
红外摄像头与被测节点的距离Dis在XZ平面映射距离Diszx为：
红外摄像头与拍摄图像中心o的距离Dz为
Diszx与Dz的水平夹角γ计算如下：
被测节点相对摄像头在XZ平面上的相对极坐标为(Diszx，γ)。
作为对本技术方案的进一步限定，所述红外摄像头的方向信息是指红外摄像头与原点坐标系xoz的x轴在XZ平面的夹角β。
作为对本技术方案的进一步限定，所述步骤(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。
本发明包括如下模块：
初始化模块：设置一组锚节点，并选择适当的位置作为坐标原点o，建立原点坐标系xoz,计算各个锚节点相对于坐标原点o的相对极坐标(r,δ)，每个锚节点上设置有一组红外摄像头，计算各个红外摄像头的方向信息，将各个相对极坐标和红外摄像头方向信息录入对应的锚节点主控模块，被测节点上设置两个红外发光模块；
预处理模块：首先进行预测量操作,将两个间距为d红外发光模块竖直放置，其中位置较低的红外发光模块与锚节点的红外摄像头同高的位置，分别用红外摄像头拍摄距离红外发光模块不同设定距离时的红外图像，并求得每个红外图像的两个红外发光模块间的像素点数存入距离参考缓冲区DisRef[i],缓冲区格式如下：Dref[i]、nref[i]，其中，Dref[i]表示不同设定距离，nref[i]表示不同设定距离对应的两个红外发光模块之间的像素点数，距离参考缓冲区DisRef[i]按照由大到小的顺序进行存储；
无线通信测试模块：其中一个锚节点自动成为主节点，每5秒钟在发送时隙T0发送一次系统同步指令SYSSYNC，其他锚节点在自己对应的锚节点时隙Tn发送应答无线数据包ACKSYSSYNC，被测节点在终端节点时隙Tt发送应答无线数据包TACKSYSSYNC，如果主节点收到应答无线数据包ACKSYSSYNC和TACKSYSSYNC，则表明无线网络通信成功，否则，持续测试直到网络通信成功；
拍照前同步通信模块：被测试节点按键在Tt时隙发送请求测试无线数据包ApplyTest，每个锚节点接收到请求数据包后在对应的Tn时隙发送ACKApplyTest数据包，被测节点接收到全部锚节点的应答数据包；
被测节点全局坐标计算模块：被测节点按键打开红外发射模块，然后发送定位测试数据包LocTest，等待2秒后关闭红外发射模块，每个锚节点接收到无线数据包后通知对应的图像处理模块进行拍照，并对采集的图像信息进行处理，获取被测节点的全局坐标：
被测节点最终坐标计算模块：各个锚节点将获取的原始数据和最终计算的被测节点全局坐标发送至主节点，主节点将接收的所有被测节点坐标取平均后得到最终的被测节点坐标，同时将坐标信息存入TF卡，然后将被测节点坐标信息发送至被测节点，被测节点接收到坐标信息后在显示模块上显示，至此完成一次定位。
所述被测节点全局坐标计算模块包括如下步骤：
(1)被测节点打开红外发射模块，然后发送定位测试数据包LocTest，锚节点接收到无线数据包后通知图像处理模块进行拍照，每个锚节点拍摄的图像不存在重叠现象，图像处理模块对采集的图像信息进行处理；
(2)将图像处理模块的处理信息发送到锚节点主控模块计算被测节点的相对坐标；
(3)通过极坐标运算就可以得到被测节点的全局坐标。
所述步骤(1)的图像信息处理包括如下步骤：
(1.1)图像处理模块首先将N个发光区域的存储缓冲区Pos[N]清空，每个存储缓冲区有7个参数，分别为最小X坐标Xmin，最大X坐标Xmax，最小Y坐标Ymin，最大Y坐标Ymax，X坐标平均值Xavg，Y坐标平均值Yavg，像素点数量Num，上述参数的初始值均为0；
(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；
(1.3)如果该像素点不在所有的发光区域中，则判断为新的发光区域，新的发光区域的存储缓冲区Pos[m]的参数设置如下:
Xmin＝X坐标；
Xmax＝X坐标；
Ymin＝Y坐标；
Ymax＝Y坐标；
Xavg＝X坐标；
Yavg＝Y坐标；
Num＝1；
(1.4)当所有的像素点传输完毕后图像处理模块将所有存储缓冲区信息处理，首先选择满足如下条件的发光区域以降低误差：
Xavg-Xmin>Rxth同时Xmax-Xavg>Rxth同时Yavg-Ymin>Ryth同时Ymax-Yavg>RYth，Rxth,Ryth为系统设置的发光区域最小有效半径；然后选出所有发光区域Xavg相差5以内的发光区域，如有2个发光区域满足条件则表明成功拍摄到被测节点，否则表明未拍摄到被测节点。
作为对本技术方案的进一步限定，所述步骤(2)包括如下步骤：
(2.1)获取被测节点的高度：
其中，nt为拍摄图像中两个发光区域中心点间的像素点数，假设较高的发光区域中心点Y坐标为Yavg1,较低的发光区域中心点Y坐标为Yavg2,则nt＝(Yavg1-Yavg2)；Yimagemax表示拍摄图像的高度，d表示两个红外发光模块的实际间距；
(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数组的最大数量；
(2.3)计算被测节点的坐标，具体步骤如下：
首先建立垂直于拍摄图像XY平面的XZ平面，XZ平面穿过红外摄像头且与两个被测节点连线垂直，拍摄图像平面为XY平面，红外摄像头在XY平面的投影位于拍摄图像的中心o(nx/2,ny/2)，nx为拍摄图像的宽度，ny为拍摄图像的高度，拍摄图像的中心o距离两个被测节点连线的距离Dx为：
红外摄像头与被测节点的距离Dis在XZ平面映射距离Diszx为：
红外摄像头与拍摄图像中心o的距离Dz为
Diszx与Dz的水平夹角γ计算如下：
被测节点相对摄像头在XZ平面上的相对极坐标为(Diszx，γ)。
所述红外摄像头的方向信息是指红外摄像头与原点坐标系xoz的x轴在XZ平面的夹角β。
所述步骤(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.一种无线传感网络高精度定位系统，其特征在于，包括如下模块：
初始化模块：设置一组锚节点，并选择适当的位置作为坐标原点o，建立原点坐标系xoy,计算各个锚节点相对于坐标原点o的相对极坐标(r,δ)，每个锚节点上设置有一组红外摄像头，计算各个红外摄像头的方向信息，将各个相对极坐标和红外摄像头方向信息录入对应的锚节点主控模块，被测节点上设置两个红外发光模块；
预处理模块：首先进行预测量操作,将两个间距为d红外发光模块竖直放置，其中位置较低的红外发光模块与锚节点的红外摄像头同高的位置，分别用红外摄像头拍摄距离红外发光模块不同设定距离时的红外图像，并求得每个红外图像的两个红外发光模块间的像素点数存入距离参考缓冲区DisRef[i],缓冲区格式如下：Dref[i]、nref[i]，其中，Dref[i]表示不同设定距离，nref[i]表示不同设定距离对应的两个红外发光模块之间的像素点数，距离参考缓冲区DisRef[i]按照由大到小的顺序进行存储；
无线通信测试模块：其中一个锚节点自动成为主节点，每5秒钟在发送时隙T0发送一次系统同步指令SYSSYNC，其他锚节点在自己对应的锚节点时隙Tn发送应答无线数据包ACKSYSSYNC，被测节点在终端节点时隙Tt发送应答无线数据包TACKSYSSYNC，如果主节点收到应答无线数据包ACKSYSSYNC和TACKSYSSYNC，则表明无线网络通信成功，否则，持续测试直到网络通信成功；
拍照前同步通信模块：被测试节点按键在Tt时隙发送请求测试无线数据包ApplyTest，每个锚节点接收到请求数据包后在对应的Tn时隙发送ACKApplyTest数据包，被测节点接收到全部锚节点的应答数据包；
被测节点全局坐标计算模块：被测节点按键打开红外发射模块，然后发送定位测试数据包LocTest，等待2秒后关闭红外发射模块，每个锚节点接收到定位测试数据包LocTest后通知对应的图像处理模块进行拍照，并对采集的图像信息进行处理，获取被测节点的全局坐标：
被测节点最终坐标计算模块：各个锚节点将获取的原始数据和最终计算的被测节点全局坐标发送至主节点，主节点将接收的所有被测节点坐标取平均后得到最终的被测节点坐标，同时将坐标信息存入TF卡，然后将被测节点坐标信息发送至被测节点，被测节点接收到坐标信息后在显示模块上显示，至此完成一次定位。
2.根据权利要求1所述的无线传感网络高精度定位系统，其特征在于，所述被测节点全局坐标计算模块包括如下步骤：
(1)被测节点打开红外发射模块，然后发送定位测试数据包LocTest，锚节点接收到定位测试数据包LocTest后通知图像处理模块进行拍照，每个锚节点拍摄的图像不存在重叠现象，图像处理模块对采集的图像信息进行处理；
(2)将图像处理模块的处理信息发送到锚节点主控模块计算被测节点的相对坐标；
(3)通过极坐标运算就可以得到被测节点的全局坐标。
3.根据权利要求2所述的无线传感网络高精度定位系统，其特征在于，所述步骤(1)的图像信息处理包括如下步骤：
(1.1)图像处理模块首先将N个发光区域的存储缓冲区Pos[N]清空，每个存储缓冲区有7个参数，分别为最小X坐标Xmin，最大X坐标Xmax，最小Y坐标Ymin，最大Y坐标Ymax，X坐标平均值Xavg，Y坐标平均值Yavg，像素点数量Num，上述参数的初始值均为0；
(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；
(1.3)如果该像素点不在所有的发光区域中，则判断为新的发光区域，新的发光区域的存储缓冲区Pos[m]的参数设置如下:
Xmin＝X坐标；
Xmax＝X坐标；
Ymin＝Y坐标；
Ymax＝Y坐标；
Xavg＝X坐标；
Yavg＝Y坐标；
Num＝1；
(1.4)当所有的像素点传输完毕后图像处理模块将所有存储缓冲区信息处理，首先选择满足如下条件的发光区域以降低误差：
Xavg-Xmin>Rxth同时Xmax-Xavg>Rxth同时Yavg-Ymin>Ryth同时Ymax-Yavg>RYth，Rxth,Ryth为系统设置的发光区域最小有效半径；然后选出所有发光区域Xavg相差5以内的发光区域，如有2个发光区域满足条件则表明成功拍摄到被测节点，否则表明未拍摄到被测节点。
4.根据权利要求3所述的无线传感网络高精度定位系统，其特征在于，所述步骤(2)包括如下步骤：
(2.1)获取被测节点的高度：
其中，nt为拍摄图像中两个发光区域中心点间的像素点数，假设较高的发光区域中心点Y坐标为Yavg1,较低的发光区域中心点Y坐标为Yavg2,则nt＝(Yavg1-Yavg2)；Yimagemax表示拍摄图像的高度，d表示两个红外发光模块的实际间距；
(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数组的最大数量；
(2.3)计算被测节点的坐标，具体步骤如下：
首先建立垂直于拍摄图像XY平面的XZ平面，XZ平面穿过红外摄像头且与两个被测节点连线垂直，拍摄图像平面为XY平面，红外摄像头在XY平面的投影位于拍摄图像的中心o(nx/2,ny/2)，nx为拍摄图像的宽度，ny为拍摄图像的高度，拍摄图像的中心o距离两个被测节点连线的距离Dx为：
红外摄像头与被测节点的距离Dis在XZ平面映射距离Diszx为：
红外摄像头与拍摄图像中心o的距离Dz为
Diszx与Dz的水平夹角γ计算如下：
被测节点相对摄像头在XZ平面上的相对极坐标为(Diszx，γ)。
5.根据权利要求4所述的无线传感网络高精度定位系统，其特征在于，所述红外摄像头的方向信息是指红外摄像头与原点坐标系xoy的x轴在XZ平面的夹角β。
6.根据权利要求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 |
|---|---|---|---|
| CN201610286648.9A CN105848284B (zh) | 2016-05-03 | 2016-05-03 | 一种无线传感网络高精度定位系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610286648.9A CN105848284B (zh) | 2016-05-03 | 2016-05-03 | 一种无线传感网络高精度定位系统 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN105848284A CN105848284A (zh) | 2016-08-10 |
| CN105848284B true CN105848284B (zh) | 2019-05-07 |
Family
ID=56591195
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201610286648.9A Expired - Fee Related CN105848284B (zh) | 2016-05-03 | 2016-05-03 | 一种无线传感网络高精度定位系统 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN105848284B (zh) |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107046695B (zh) * | 2017-04-06 | 2020-08-28 | 山东省计算中心（国家超级计算济南中心） | 一种低复杂度的高精度单锚节点定位测试系统和方法 |
| CN108174442B (zh) * | 2017-12-26 | 2020-02-21 | 河海大学常州校区 | 一种水下构筑物裂缝修复机器人传感网定位检测方法 |
| DE102018002765A1 (de) * | 2018-04-04 | 2019-10-10 | Zactrack Gmbh | Beleuchtungssystem |
Citations (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104778690A (zh) * | 2015-04-02 | 2015-07-15 | 中国电子科技集团公司第二十八研究所 | 一种基于摄像机网络的多目标定位方法 |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US8990319B2 (en) * | 2010-08-26 | 2015-03-24 | Fuji Xerox Co., Ltd. | System and method for coordinating communication events using computer-assisted structured interaction |
-
2016
- 2016-05-03 CN CN201610286648.9A patent/CN105848284B/zh not_active Expired - Fee Related
Patent Citations (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104778690A (zh) * | 2015-04-02 | 2015-07-15 | 中国电子科技集团公司第二十八研究所 | 一种基于摄像机网络的多目标定位方法 |
Non-Patent Citations (2)
| Title |
|---|
| Correlation Based Video Processing in Video Sensor Networks;MA，Huadong 等;《2005 International Conference on Wireless Networks, Communications and Mobile Computing》;20051231;全文 |
| 无线多媒体传感器网络的关键技术研究进展;陈长英 等;《山东科学》;20130630;全文 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN105848284A (zh) | 2016-08-10 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN105246039B (zh) | 一种基于图像处理的室内定位方法及系统 | |
| JP5436559B2 (ja) | ポータブル・デバイス上での画像アノテーション | |
| CN105848284B (zh) | 一种无线传感网络高精度定位系统 | |
| CN106651990A (zh) | 一种室内地图构建方法及基于室内地图的室内定位方法 | |
| KR20120093991A (ko) | 증강 현실 시스템 | |
| JP5575758B2 (ja) | 空間予測近似 | |
| KR101126449B1 (ko) | 증강 현실 서비스 시스템 및 방법 | |
| CN104936283A (zh) | 室内定位方法、服务器和系统 | |
| CN108120436A (zh) | 一种iBeacon辅助地磁室内实景导航方法 | |
| CN109916408A (zh) | 机器人室内定位和导航方法、装置、设备及存储介质 | |
| CN109765936A (zh) | 移动终端的定位和控制方法、装置及无人机 | |
| CN108803683A (zh) | 基于ZigBee无线传感网络的多摄像头追踪拍摄系统和方法 | |
| CN106370160A (zh) | 一种机器人室内定位系统和方法 | |
| CN110120098A (zh) | 场景尺度估计及增强现实控制方法、装置和电子设备 | |
| CN109936712A (zh) | 基于光标签的定位方法及系统 | |
| CN105828291B (zh) | 一种无线传感网络高精度定位方法 | |
| KR20200002219A (ko) | 실내 길안내 장치 및 그 방법 | |
| CN110471403A (zh) | 通过光通信装置对能够自主移动的机器进行导引的方法 | |
| Kolakowski et al. | Static LiDAR assisted UWB anchor nodes localization | |
| KR20100060472A (ko) | 위치 측정 방법 및 이를 이용한 휴대 단말기 | |
| CN107347209A (zh) | 基于Beacon技术的三点共线定位方法 | |
| CN114332422A (zh) | 一种基于ar技术的虚拟空间互动方法、编辑更新方法、系统、电子设备和可读存储介质 | |
| JP3762382B2 (ja) | 画像処理方法及び装置 | |
| CN109636850A (zh) | 面向室内智能灯下的可见光定位方法 | |
| CN109712249A (zh) | 地理要素增强现实方法及装置 |
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 |
Granted publication date: 20190507 |