CN103826297B - 一种传感网络目标定位方法及传感节点 - Google Patents

一种传感网络目标定位方法及传感节点 Download PDF

Info

Publication number
CN103826297B
CN103826297B CN201210468237.3A CN201210468237A CN103826297B CN 103826297 B CN103826297 B CN 103826297B CN 201210468237 A CN201210468237 A CN 201210468237A CN 103826297 B CN103826297 B CN 103826297B
Authority
CN
China
Prior art keywords
msub
mrow
target
sensing node
estimated location
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.)
Active
Application number
CN201210468237.3A
Other languages
English (en)
Other versions
CN103826297A (zh
Inventor
程伟
徐勇
李勇
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guangdong Gaohang Intellectual Property Operation Co ltd
Haining Huangwan Town Asset Management Co ltd
Original Assignee
Huawei Technologies Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Huawei Technologies Co Ltd filed Critical Huawei Technologies Co Ltd
Priority to CN201210468237.3A priority Critical patent/CN103826297B/zh
Publication of CN103826297A publication Critical patent/CN103826297A/zh
Application granted granted Critical
Publication of CN103826297B publication Critical patent/CN103826297B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Abstract

本发明公开了一种传感网络目标定位方法及传感节点,方法包括:从传感节点的邻居节点中,获取与传感节点同时感知到目标的节点,并组成邻居集合。判断邻居集合是否为空;若邻居集合为空,则判断传感节点的测量距离是否小于或者等于感知半径,若是,则保留该测量距离,并用于目标的定位计算;若邻居集合非空,则分别为邻居集合中的成员构建限定区域,限定区域重叠部份为估计区域,并判断传感节点的测量距离是否小于或者等于估计区域内两点间的最大距离和感知半径之间的最小值,若是,保留该测量距离,并用于目标的定位计算。通过上述方式,本发明能够将不可靠的测量距离排除在目标的定位计算之外,提高目标的定位的准确性,节约传感节点的计算资源。

Description

一种传感网络目标定位方法及传感节点
技术领域
本发明涉及通信技术领域,特别是涉及一种传感网络目标定位方法及传感节点。
背景技术
无线传感网络是由分布在监测区域内的大量无线传感节点,通过无线通信方式形成的一个多跳的自组织网络。无线传感节点能够协作地感知、采集和处理进入无线传感网络内的对象的信息。并且无线传感节点具有体积小、价格低廉和功耗小等特点。无线传感网络具有部署随机,自组织性、鲁棒性和隐蔽性等特点。因此,无线传感网络非常适合用于对运动目标进行定位和跟踪。
使用无线传感网络来实现对目标跟踪需要无线传感网络中无线传感节点感知到目标后,能够在较短的时间内,完成对监测数据的处理,并与其他无线传感节点交换监测数量,协同合作共同确定目标的位置,并结合历史数据拟合出目标的运动轨迹。
目前常用的无线传感网络中的目标定位跟踪方法有最小二乘法、Bilateration等。最小二乘法用于将监测到目标的无线传感节点与目标建立距离方程组,解距离方程组获得目标的估计位置,其中,计算方式以下:
假设目标的坐标是(x,y),监测到目标无线传感节点的坐标分别为(x1,y1)、(x2,y2)、…、(xn,yn)。无线传感节点与目标的距离分别是d1,d2,…,dn。那么存在
为消除二次项式,前n-1个方程分别减去第n个方程,可得线性方程组式Ax=b,其中:
便得从而目标的估计位置(x,y)的解。
进一步地,结合目标的估计位置的历史数据,拟合出目标的运动轨迹。
Bilateration用于将两两监测到目标的无线传感节点进行双边定位,获得两个定位解,其中,定位解为目标估计位置的候选位置。如果不存在攻击和噪声,侯选位置中应当会有一些重叠的点,这个点便是目标的估计位置。如果存在攻击或噪声时,可能没有重合点,但是在误差范围有限的情况下,由正常样本产生的合理位置应当分布在真实位置的附近,因而这些位置相互靠近。目标对于获得的每对测量样本计算候选位置,得到包含M个候选位置的集合C。对于C中的每一个候选位置ci计算到其它候选位置的距离,找到距离小于门限δ的候选位置,统计其个数,并记录相应的候选位置集合Ei。找到{ni}中的最大值nm,Em即为最大的候选位置簇,计算这些位置的质心即为目标的估计位置。进一步地,结合目标的估计位置的历史数据,拟合出目标的运动轨迹。
本发明人在长期研究中发现,对于最小二乘法的目标跟踪方法,不能抵抗节点攻击,即为无线传感网络中部份无线传感节点出现测量距离误差时,就会使目标的估计位置出现较大偏差,从而使得目标运动轨迹跟踪的可靠性大大降低。Bilateration目标跟踪方法,尽管可以抵抗节点攻击,但使用排列候选解的方法,比较复杂,并且不管测量距离是否可靠,先用测量距离计算出位置估计,再后对位置估计进行验证的方法,将不可靠的测量距离也参与计算,浪费了计算资源,增加了无线传感的计算开销。
发明内容
本发明主要解决的技术问题是提供一种传感网络目标定位方法,能够将不可靠的测量距离排除在对目标的定位计算之外,提高目标的定位的准确性,节约传感节点的计算资源。
为解决上述技术问题,本发明采用的一个技术方案是:提供一种传感网络目标定位方法,包括第一传感节点接收来自至少一个第二传感节点的信息,其中,信息包括至少一个第二传感节点的节点标识及至少一个第二传感节点到目标的测量距离;第一传感节点将自身的节点标识和至少一个第二传感节点的节点标识组成标识集合;第一传感节点获取标识集合中的标识成员i的邻居标识,并组成邻居集合,其中,邻居标识属于标识集合中的标识成员,并且是标识集合中的标识成员i所对应传感节点的邻居节点的节点标识,i为标识集合中的标识成员的编号;第一传感节点判断邻居集合是否为空;若邻居集合为空,则第一传感节点判断标识集合中的标识成员i对应的测量距离是否小于或者等于感知半径,若是,则将标识集合中的标识成员i对应的测量距离加入测量距离集合,若邻居集合非空,则分别为邻居集合中的成员构建限定区域,限定区域重叠部份为估计区域,并且第一传感节点判断标识集合中的标识成员i对应的测量距离是否小于或者等于估计区域内两点间的最大距离和感知半径之间的最小值,若是,则将标识集合的成员i对应的测量距离加入测量距离集合;第一传感节点根据测量距离集合的成员的数量以及测量距离集合的成员对应的位置,计算当前时刻目标所在的估计位置。。
其中,限定区域为以邻居集合中的成员对应的位置为中心,以感知半径为半径的圆的外接正方形的区域。
其中,第一传感节点根据测量距离集合的成员的数量以及测量距离集合的成员对应的位置,计算当前时刻目标所在的估计位置的步骤包括:第一传感节点判断测量距离集合的成员的数量;若测量距离集合的成员的数量为一个,则第一传感节点以测量距离集合中的成员对应的估计区域的中心作为估计位置,并标记估计位置的参与度为一,若测量距离集合中的成员的数量为两个,则第一传感节点分别以测量距离集合中的成员对应的位置和测量距离进行双边定位,获得两个定位位置,并计算定位位置与测量距离集合中的成员对应的估计区域的中心之间的距离,以距离最小的一个定位位置作为估计位置,并标记估计位置的参与度为二,若测量距离集合中的成员的数量大于或者等于三个,则第一传感节点以测量距离集合的成员对应的位置和测量距离进行三边定位或者多边定位,获得估计位置,并标记估计位置的参与度为测量距离集合的成员的数量。
其中,第一传感节点计算当前时刻目标所在的估计位置,标记估计位置的参与度的步骤之后,还包括:第一传感节点判断估计位置的参与度;若参与度大于或者等于三,则第一传感节点获取目标的三个历史时刻的估计位置,所述三个历史时刻的估计位置包括当前时刻目标的估计位置及前两个时刻的目标的估计位置;若参与度小于三,则第一传感节点获取目标的三个历史时刻的估计位置,三个历史时刻的估计位置均为参与度大于三,且参与度都高于其他估计位置的参与度的估计位置;第一传感节点根据三个历史时刻的估计位置及时间间隔计算目标下一个时刻所在的预测位置。
其中,计算目标下一个时刻所在的预测位置的步骤包括:第一传感节点根据三个历史时刻的估计位置及时间间隔,获取目标的对应时间间隔内的纵向平均速度和横向平均速度,其中,纵向平均速度和横向平均速度通过以下计算方式得到:
(x1,y1)、(x2,y2)和(x3,y3)分别为所选取三个估计位置的坐标,并且估计位置(x3,y3)对应的时刻离目标当前时刻最近,估计位置(x1,y1)对应的时刻离目标当前时刻最远,Δt为时间间隔,v′x为目标在估计位置(x1,y1)和估计位置(x2,y2)之间的平均横向速度,v″x为目标在估计位置(x3,y3)和估计位置(x2,y2)之间的平均横向速度,y′x为目标在估计位置(x1,y1)和估计位置(x2,y2)之间的平均纵向速度,y″x为目标在估计位置(x3,y3)和估计位置(x2,y2)之间的平均纵向速度;
第一传感节点根据目标的纵向平均速度和横向平均速度,获取目标的纵向加速度和横向加速度,其中,纵向加速度和横向加速度通过以下计算方式得到:
ax和ay分别为目标的横向加速度和纵向加速;
第一传感节点根据目标的纵向加速度和横向加速度,计算目标下一个时刻所在的预测位置,其中,预测位置通过以下计算方式得到:
x和y分别预测位置的横坐标和纵坐标,Δt2为目标一下时刻与目标在估计位置(x3,y3)的时刻之间的时间间隔。
其中,第一传感节点计算目标下一个时刻的预测位置的步骤之后,还包括:第一传感节点广播目标的估计位置及下一个时刻所在的预测位置。
其中,第一传感节点接收来自至少一个第二传感节点的信息的步骤之前,还包括:第一传感节点根据自身电能和或自身到目标的预测位置的距离,广播通知,以使至少一个第二传感节点接收通知后,标记第一传感节点为主节点,自身为从属节点。
为解决上述技术问题,本发明采用的另一个技术方案是:提供一种传感节点,包括接收模块,用于接收来自至少一个第二传感节点的信息,其中,信息包括至少一个第二传感节点的节点标识和至少一个第二传感节自身到目标的测量距离;组合模块,用于将传感节点的节点标识与至少一个第二传感节点的节点标识组成标识集合;第一获取模块,用于获取标识集合中的标识成员i的邻居标识,并组成邻居集合,其中,邻居标识属于标识集合中的标识成员,并且是标识集合中的标识成员i所对应传感节点的邻居节点的节点标识,i为标识集合中的标识成员的编号;第一判断模块,用于判断邻居集合是否为空;第二判断模块,用于在第一判断模块判断到邻居集合为空时,判断标识集合中的标识成员i对应的测量距离是否小于或者等于感知半径;限定区域构建模块,用于在第一判断模块判断到邻居集合非空时,分别为邻居集合的成员构建限定区域,限定区域重叠的部份为估计区域;第三判断模块,用于判断标识集合中的标识成员i对应的测量距离是否小于或者等于估计区域内两点间的最大距离和感知半径之间的最小值;添加模块,用于在第二判断模块判断到标识集合中的标识成员i对应的测量距离小于或者等于感知半径时,或者第三判断模块判断到标识集合中的标识成员i的测量距离小于或者等于估计区域内两点间的最大距离和感知半径之间的最小值时,将标识成员i对应的测量距离加入测量距离集合;计算模块,用于根据测量距离集合的成员的数量以及测量距离集合的成员对应的位置,计算当前时刻目标所在的估计位置。
其中,限定区域为以邻居集合的成员对应的位置为中心,以感知半径为半径的圆的外接正方形的区域。
其中,计算模块包括:第四判断单元,用于判断测量距离集合中的成员的数量;第一计算单元,用于在第四判断单元判断到距离集合中的成员的数量为一个时,则计算测量距离集合的成员对应的估计区域的中心,并以估计区域的中心作为估计位置,并标记估计位置的参与度为一;第二计算单元,用于在第四判断单元判断到距离集合中的成员的数量为两个时,则分别以测量距离集合中的成员对应的位置和测量距离进行双边定位,获得两个定位位置,并计算定位位置与测量距离集合中的成员对应的估计区域的中心之间的距离,且以距离最小的一个定位位置作为估计位置,并标记估计位置的参与度为二;第三计算单元,用于在第四判断单元判断到测量距离集合的成员的数量大于或者等于三个时,则以测量距离集合的成员对应的位置和测量距离进行三边定位或者多边定位,获得估计位置,并标记估计位置的参与度为测量距离集合的成员的数量。
其中,传感节点还包括:第五判断模块,用于判断估计位置的参与度;第二获取模块,用于在第五判断模块判断到参与度大于或者等于三时,获取目标的三个历史时刻的估计位置,三个历史时刻的估计位置包括当前时刻目标的估计位置及前两个时刻的目标的估计位置;第三获取模块,用于在第五判断模块判断到参与度小于三时,获取目标的三个历史时刻的估计位置,三个历史时刻的估计位置均为参与度大于三,且参与度都高于其他估计位置的参与度的估计位置;第四计算模块,用于根据三个历史时刻的估计位置及时间间隔计算目标下一个时刻所在的预测位置。
其中,第四计算单元具体包括:平均速度计算单元,用于根据三个历史时刻的估计位置及时间间隔,获取目标的对应时间间隔内的纵向平均速度和横向平均速度,其中,纵向平均速度和横向平均速度通过以下计算方式得到:
(x1,y1)、(x2,y2)和(x3,y3)分别为所选取三个估计位置的坐标,并且估计位置(x3,y3)对应的时刻离目标当前时刻最近,估计位置(x1,y1)对应的时刻离目标当前时刻最远,Δt1为时间间隔,v′x为目标在估计位置(x1,y1)和估计位置(x2,y2)之间的平均横向速度,v″x为目标在估计位置(x3,y3)和估计位置(x2,y2)之间的平均横向速度,y′x为目标在估计位置(x1,y1)和估计位置(x2,y2)之间的平均纵向速度,y″x为目标在估计位置(x3,y3)和估计位置(x2,y2)之间的平均纵向速度;
加速度计算单元,用于根据目标的纵向平均速度和横向平均速度,获取目标的纵向加速度和横向加速度,其中,纵向加速度和横向加速度通过以下计算方式得到:
ax和ay分别为目标的横向加速度和纵向加速;
预测位置计算单元,用于根据目标的纵向加速度和横向加速度,计算目标下一个时刻所在的预测位置,其中,预测位置通过以下计算方式得到:
x和y分别预测位置的横坐标和纵坐标,Δt2为目标一下时刻与目标在估计位置(x3,y3)的时刻之间的时间间隔。
其中,传感节点还包括:广播模块,广播模块,用于广播目标的估计位置及目标下一个时刻所在的预测位置。
其中,传感节点还包括通知模块,用于根据自身到目标的预测位置的距离与自身能量之和或者自身能量,广播通知,以使至少一个第二传感节点接收通知后,标记第一传感节点为主节点,自身为从属节点。
本发明的有益效果是:区别于现有技术的情况,本发明获取既是传感节点的邻居节点,又与传感节点同时感知到目标的节点,并组成邻居集合。判断邻居集合是否为空。若邻居集合非空,则可分别为邻居集合的成员构建限定区域,限定区域的重叠部份为估计区域。其中,传感节点与邻居集合的成员均相邻,则传感节点必定在估计区域内,邻居集合的成员均感知到目标,则目标也必定在估计区域内,因此,传感节点的测量距离必定小于或者等于估计区域内两点间的最大距离,并且小于或者等于感知半径。则可通过判断传感节点的测量距离是否小于或者等于估计区域内两点间的最大距离与感知半径之间的最小值的方式,判断传感节点的测量距离是否可靠,并把不可靠的测量距离排除在对目标的定位计算之外。传感节点的最大测量距离为感知半径的长度。若邻居集合为空,则通过判断传感节点的测量距离是否小于或者等于感知半径的方式,判断传感节点的测量距离是否可靠,并把不可靠的测量距离排除在对目标的定位计算之外。本发明仅使用可靠的测量距离进行目标定位计算,提高目标定位的准确性。并且在目标定位计算之前,就把不可靠的测量距离筛选掉,不需要在目标定位计算之后,再对目标的位置进行修正,减少传感节点的计算工作量,节约传感节点的计算资源。
附图说明
图1是本发明传感网络目标定位方法第一实施方式的流程图;
图2是本发明传感网络目标定位方法第一实施方式中,分别为邻居节点的成员构建正方形限定区域的示意图;
图3是本发明传感网络目标定位方法第一实施方式中,分别为邻居节点的成员构建圆形限定区域的示意图;
图4是本发明传感网络目标定位方法第二实施方式的流程图;
图5是本发明传感网络目标定位方法第二实施方式中目标定位的计算方法的流程图;
图6是本发明传感网络目标定位方法第二实施方式中目标的预测位置的计算方法的流程图;
图7是本发明传感节点第一实施方式的结构示意图;
图8是本发明传感节点第二实施方式的结构示意图。
具体实施方式
下面结合附图和实施方式对本发明进行详细说明。
请参阅图1,图1是本发明传感网络目标定位方法第一实施方式的流程图。如图所示,所述方法包括:
步骤S100:第一传感节点接收来自至少一个第二传感节点的信息,其中,信息包括至少一个第二传感节点的节点标识及至少一个第二传感节点到目标的测量距离;
传感节点为传感网络中的基本单元,多个传感节点组成传感网络,并且传感节点具有计算、存储和通信功能。传感节点间通过相互协作,确定进入传感网络内的目标的位置。无线信号强度随着传播距离的增加而衰减,并且无线信号强度与传播距离存在特定的函数关系。本发明实施方式中,传感节点通过计算接收到的信号强度RSSI值(ReceivedSignalStrength Indication,接收的信号强度指示),确定目标到传感节点间的测量距离。当然,传感节点也可以通过其他方式,确定目标到传感节点间的测量距离,例如:激光测距离、声波测距离等。节点标识为传感网络中的传感节点的标记。其中,第一传感节点与至少一个第二传感节点均在同一时刻内感知到半径。
步骤S101:第一传感节点将自身的节点标识和至少一个第二传感节点的节点标识组成标识集合。
步骤S102:第一传感节点获取标识集合中的标识成员i的邻居标识,并组成邻居集合,其中,邻居标识属于标识集合中的标识成员,并且是标识集合中的标识成员i所对应传感节点的邻居节点的节点标识,i为标识集合中的标识成员的编号;
传感节点的邻居节点指在传感节点的感知半径范围内的其他传感节点。第一传感节点和至少一个第二传感节点可预先分别与其相邻的传感节点交换邻节点表,其中,邻节点表包括邻居节点的节点标识及邻居节点的位置,或者,第一传感节点在步骤S102之前,向至少一个第二传感节点发送信号,使至少一个第二传感节点分别向第一传感节点发送其自身的邻节点表,使得第一传感节点就可根据自身的邻节点表及邻居节点的邻节点表确定标识集合中的标识成员i的邻居节点的节点标识。
步骤S103:第一传感节点判断邻居集合是否为空,若是,则进入步骤S104,否则进入步骤S105;
步骤S104:第一传感节点判断标识集合的标识成员i的测量距离是否小于或者等于感知半径,若是,则进入步骤S107;
在步骤S103判断到邻居集合为空时,则说明标识集合中的标识成员i对应的传感节点的邻居节点均没有感知到目标,则可直接判断标识集合中的标识成员i的测量距离是否小于或者等于感知半径即可。
步骤S105:第一传感节点分别为邻居集合中的成员构建限定区域,其中,限定区域重叠部份为估计区域;
在本发明实施方式中,限定区域为以邻居集合中的成员对应的位置为中心,以感知半径R为半径的圆的外接正方形的区域。如图2所示,若邻居集合中的成员对应为传感节点A、传感节点B及传感节点C,则分别为传感节点A、传感节点B及传感节点C构建限定区域,填充部份为估计区域。当然,限定区域的构造方式不限上述方式,例如:限定区域也可以为以邻居集合中的成员对应的位置为中心,以感知半径R为半径的圆形的区域。如图3所示,若邻居集合中的成员对应为传感节点A、传感节点B及传感节点C,则分别为传感节点A、传感节点B及传感节点C构建限定区域,填充部份为估计区域。
步骤S106:第一传感节点判断标识集合中的标识成员i对应的测量距离是否小于或者等于估计区域内两点间的最大距离和感知半径之间的最小值,若是,则进入步骤S107;
邻居集合中的成员均为标识集合中的标识成员i对应传感节点的邻居节点的节点标识,估计区域为标识成员i对应传感节点的邻居节点的限定区域的重叠部份,则标识集合中的标识成员i对应的传感节点必定在估计区域内。邻居集合中的成员对应的传感节点均在同一时刻感知到目标,则目标也必定在估计区域内。因此,目标与标识集合中的标识成员i对应的传感节点的距离必定小于或者等于估计区域内两点间的最大距离,并且小于或者等于感知半径。
步骤S107:第一传感节点将标识集合中的标识成员i对应的测量距离加入测量距离集合。
第一传感节点筛选出可靠的测量距离,并将不可靠的测量距离排除在对目标的定位计算之外。
步骤S108:第一传感节点根据测量距离集合的成员的数量及测量距离集合的成员对应的位置,计算当前时刻目标所在的估计位置;
在本发明实施方式中,获取传感节点的邻居节点,并从邻居节点获取与传感节点同一时刻感知到的目标的节点,并组成邻居集合;判断邻居集合是否空,若是,则判断传感节点的测量距离是否小于或者等于感知半径。由于传感节点的最大测量距离为感知半径的长度,若传感节点的测量距离大于感知半径,则说明该传感节点的测量距离不可靠,可直接排除在定位计算之外。若判断到邻居集合非空,则可分别为邻居节点的成员构建限定区域,限定区域的重叠部份为估计区域,判断传感节点的测量距离是否小于或者等于估计区域内两点间的最大距离与感知半径之间的最小值。由于传感节点与邻居集合的成员均相邻,则传感节点必定在估计区域内,邻居节点的成员均感知到目标,则目标也必定在估计区域内。因传感节点的测量距离必定小于或者等于估计区域内两点间的最大值,并小于或者等于感知半径。若传感节点的测量距离大于估计区域内两点间的最大距离或者感知半径,则说明该传感节点的测量距离不可靠,可直接排除在对目标的定位计算之外。仅使用可靠的测量距离进行目标定位计算,提高目标定位的准确性。并且在目标定位计算之前,就把不可靠的测量距离筛选掉,不需要在目标定位计算之后,再对目标的位置进行修正,减少传感节点的计算工作量,节约传感节点的计算资源。
请参阅图4,图4是本发明传感网络目标定位方法第二实施方式的流程图。如图所示,所述方法包括:
步骤S200:第一传感节点根据自身电能和或自身到目标的预测位置的距离,广播通知,以使至少一个第二传感节点接收通知后,标记第一传感节点为主节点,自身为从属节点。
电能为第一传感节点的电量。第一传感节点感知到目标后,查询是否有目标的预测位置,若有,则计算自身到目标的预测位置的距离和或自身电量,并在完成计算后,广播通知,至少一个第二传感节点接收到通知后,停止计算,并标记第一传感节点为主节点,自身为从属节点。
步骤S201:第一传感节点接收来自至少一个第二传感节点的信息,其中,信息包括至少一个第二传感节点的节点标识及至少一个第二传感节点到目标的测量距离。
传感节点为传感网络中的基本单元,并且传感节点具有计算、存储和通信功能。传感节点可根据接收到的信号强度RSSI值,计算自身到目标的距离。当然,传感节点也可通过激光测距离、声波测距离等方式,计算传感节点与目标的距离。
步骤S202:第一传感节点将自身的节点标识和至少一个第二传感节点的节点标识组成标识集合;
步骤S203:第一传感节点获取标识集合中的标识成员i的邻居标识,并组成邻居集合,其中,邻居标识属于标识集合中的标识成员,并且是标识集合中的标识成员i所对应的传感节点的邻居节点的节点标识,i为标识集合的标识成员的编号;
若传感节点与另一传感节点的距离小于或者等于感知半径,则传感节点与另一传感节点互为邻居节点。其中,可使第一传感节点和至少一个第二传感节点预先分别与其相邻的传感节点交换邻节点表,或者,至少一个第二传感节点分别将自身的邻节点表发送到第一传感节点,使得第一传感节点就可根据自身的邻节点表及邻居节点的邻节点表确定标识集合中的标识成员i对应的传感节点的邻居节点的节点标识。
步骤S204:第一传感节点判断邻居集合是否为空,若是,则进入步骤S205,否则,进入步骤S206;
步骤S205:第一传感节点判断标识集合中的标识成员i对应的测量距离是否小于或者等于感知半径,若是,则进入步骤S208;
传感节点的最大测量距离必定小于或者等于感知半径,若传感节点的测量距离大于感知半径,则说明该传感节点的测量距离有误,如果采用该传感节点的测量距离进行定位计算,会造成定位偏差。
步骤S206:第一传感节点分别为邻居集合中的成员构建限定区域,其中,限定区域重叠部份为估计区域;
其中,限定区域可以为以邻居集合中的成员对应的位置为中心,以感知半径R为半径的圆的外接正方形的区域,如图2所示。当然,限定区域的构造方式不仅限于上述方式,例如:限定区域也可以为以邻居集合中的成员对应的位置为中心,以感知半径R为半径的圆形的区域,如图3所示。
步骤S207:第一传感节点判断标识集合中的标识成员i对应的测量距离是否小于或者等于估计区域内两点间的最大距离和感知半径之间的最小值,若是,则进入步骤S208;
标识集合的成员i与目标必定在估计区域内,因此,目标与标识集合的成员i的距离必定小于或者等于估计区域内两点间的最大距离,并且小于或者等于感知半径。
步骤S208:第一传感节点将标识集合中的标识成员i对应的测量距离加入测量距离集合。
第一传感节点筛选出可靠的测量距离,并将不可靠的测量距离排除在对目标的定位计算之外。
步骤S209:第一传感节点判断测量距离集合的成员的数量,若测量距离集合的成员的数量为一个,则进入步骤S210,若测量距离集合的成员的数量为两个,则进入步骤S211,若测量距离集合的成员的数量为三个或者三个以上,则进入步骤S212;
步骤S210:第一传感节点以测量距离集合的成员对应的估计区域的中心作为估计位置,并标记估计位置的参与度为一;
取邻居集合中成员的横坐标与感知半径之差的最小值为估计区域的左下角横坐标,取邻居集合中成员的纵坐标与感知半径之差的最大值为估计区域的左下角纵坐标,取邻居集合中成员的横坐标与感知半径之和的最小值为估计区域的右上角横坐标,取邻居集合中成员的纵坐标与感知半径之和的最小值为估计区域的右上角纵坐标。请再次参阅图2,若测量距离集合的成员对应的邻居集合的成员为A,B,C,并且成员A的坐标为(XA,YA),成员B的坐标为(XB,YB),成员C的坐标为(XC,YC),则估计区域的左下角坐标(X1,Y1)及右上角坐标(X2,Y2)通过以下计算方式得到:
X1=Max(XA-R,XB-R,XC-R)
Y1=Max(YA-R,YB-R,YC-R)
X2=Min(XA+R,XB+R,XC+R)
Y2=Min(YA+R,YB+R,YC+R)
则估计区域的中心位置为(X,Y)通过以下的计算方式得到:
步骤S211:第一传感节点分别以测量距离集合中的成员对应的位置和测量距离进行双边定位,获得两个定位位置,并计算定位位置与测量距离集合中的成员对应的估计区域的中心之间的距离,并以距离最小的定位位置作为估计位置,并标记估计位置的参与度为二;
步骤S212:第一传感节点以测量距离集合的成员对应的位置和测量距离进行三边定位或者多边定位,获得估计位置,并标记估计位置的参与度为测量距离集合的成员的数量。
步骤S213:第一传感节点根据估计位置的参与度,计算目标下一时刻所在的预测位置;
在本发明实施方式中,步骤S213又可包括:
子步骤S2131:第一传感节点判断估计位置的参与度,若参与度大于或者等于三,则进入子步骤S2132,否则,进入子步骤S2133;
子步骤S2132:第一传感节点获取目标的三个历史时刻的估计位置,所述三个历史时刻的估计位置包括当前时刻目标的估计位置及前两个时刻的目标的估计位置;
传感网络内的传感节点完成对目标定位后,会广播相关的参数,例如:目标的坐标、当前时间等等。因此,第一传感节点能够获取目标的历史数据。其中,第一传感节点获取到目标前两个时刻的估计位置,与当前估计位置组成估计位置组,估计位置组中的估计位置的时间间隔均相同,并且为标准时间间隔。
子步骤S2133:第一传感节点获取目标三个历史时刻的估计位置,三个历史时刻的估计位置均为参与度大于三,参与度都高于其他估计位置的参与度的估计位置;
三个历史时刻的估计位置中的估计位置间的时间间隔均相同。
子步骤S2134:第一传感节点根据三个历史时刻的估计位置及时间间隔计算目标下一个时刻所在的预测位置。
在本发明实施方式中,子步骤S2134又包括:
子步骤S21341:第一传感节点根据三个历史时刻的估计位置及时间间隔,获取目标的对应时间间隔内的纵向平均速度和横向平均速度,其中,纵向平均速度和横向平均速度通过以下计算方式得到:
(x1,y1)、(x2,y2)和(x3,y3)分别为先取三个估计位置的坐标,并且估计位置(x3,y3)对应的时刻离目标当前时刻最近,估计位置(x1,y1)对应的时刻离目标当前时刻最远,Δt1为时间间隔,v′x为目标在估计位置(x1,y1)和估计位置(x2,y2)之间的平均横向速度,v″x为目标在估计位置(x3,y3)和估计位置(x2,y2)之间的平均横向速度,y′x为目标在估计位置(x1,y1)和估计位置(x2,y2)之间的平均纵向速度,y″x为目标在估计位置(x3,y3)和估计位置(x2,y2)之间的平均纵向速度。
子步骤S21342:第一传感节点根据目标的纵向平均速度和横向平均速度,获取目标的纵向加速度和横向加速度,其中,纵向加速度和横向加速度通过以下计算方式得到:
ax和ay分别为目标的横向加速度和纵向加速;
子步骤S21343:第一传感节点根据目标的纵向加速度和横向加速度,计算目标下一个时刻所在的预测位置,其中,预测位置通过以下计算方式得到:
x和y分别预测位置的横坐标和纵坐标,Δt2为目标一下时刻与目标在估计位置(x3,y3)的时刻之间的时间间隔。
步骤S214:第一传感节点广播目标的估计位置和下一个时刻所在的预测位置。
第一传感节点广播预测位置,使得下一个感知到目标的区域内的传感节点根据预测位置和或自身电能选定主节点。进一步的,通过预测位置确定目标下一个时刻所在区域,并在目标尚未到该区域之前,根据传感节点到预测位置的距离和传感节点自身电能,选定主节点,并使主节点及从属节点均进入对目标感知、测量距离的工作,避免目标进入该区域之后,才进行主节点选定工作,影响传感节点对目标的测量距离的工作。
在本发明实施方式中,从传感节点的邻居节点中,获取感知到目标的节点,并组成邻居集合。若邻居集合为空,说明传感节点的邻居节点均没有感知到目标,而传感节点能够感知到目标的最大距离为传感节点的感知半径,因此,可通过判断传感节点的测量距离是否小于或者等于感知半径的方式,来判断传感节点的测量距离是否可靠,并把不可靠的测量距离排除在对目标的定位计算之外。若邻居集合非空,则可分别为邻居集合的成员构建限定区域,限定区域的重叠部份为估计区域。传感节点为邻居集合的成员的邻居节点,则传感节点必定在估计区域内。邻居集合的成员均感知到目标,则目标也必定在估计区域内。因此,可通过判断传感节点的测量距离是否小于或者等于估计区域内两点间的最大距离,并且小于或者等于感知半径的方式,来判断传感节点的测量距离是否可靠,并把不可靠的测量距离排除在目标定位计算之外。仅使用可靠的测量距离进行目标定位计算,提高目标定位的准确性。并且在目标定位计算之前,就把不可靠的测量距离筛选掉,不需要在目标定位计算之后,再对目标的位置进行修正,减少传感节点的计算工作量,节约传感节点的计算资源。进一步的,根据可靠的测量距离的数量,选定合适的定位计算方式,使得目标的定位更准确。
请参阅图7,图7是本发明传感节点第一实施方式的结构示意图。如图所示,传感节点30包括接收模块301、组合模块302,第一获取模块303、第一判断模块304、第二判断模块305、限定区域构建模块306、第三判断模块307、添加模块308及计算模块309。
接收模块301接收来自至少一个第二传感节点的信息其中,信息包括至少一个第二传感节点的节点标识和至少一个第二传感节点自身到目标的测量距离。传感节点为传感网络中的基本单元,并且传感节点具有计算、存储和通信功能。传感节点可根据接收到的信号强度RSSI值,计算传感节点到目标的距离。
组合模块302将传感节点30的节点标识与至少一个第二传感节点的节点标识组成标识集合。
第一获取模块303获取标识集合中的标识成员i的邻居标识,并组成邻居集合,其中,邻居标识属于标识集合中的标识成员,并且是标识集合中的标识成员i所对应传感节点的邻居节点的节点标识,i为标识集合中的标识成员的编号,并且编号可为自然数或者其他特定的标记。邻居节点指在传感节点的感知范围内的其他传感节点。
第一判断模块304用于判断邻居集合是否为空。第二判断模块305在第一判断模块304判断到邻居集合为空时,判断标识集合中的标识成员i对应的测量距离是否小于或者等于感知半径。其中,传感节点的最大测量距离为感知半径,若传感节点的测量距离大于半径,则说明该传感节点的测量距离的不可靠。
限定区域构建模块306分别为邻居集合的成员构建限定区域,限定区域的重叠部份为估计区域。在本发明实施方式中,限定区域为以邻居集合中的成员对应的位置为中心,以感知半径R为半径的圆的外接正方形的区域,如图2所示。当然,限定区域的构造方式不限于上述方式,例如:限定区域也可以为以邻居集合中的成员对应的位置为中心,以感知半径R为半径的圆形的区域,如图3所示。
第三判断模块307判断标识集合中的标识成员i对应的测量距离是否小于或者等于估计区域内两点间的最大距离和感知半径之间的最小值。标识集合中的标识成员i对应的传感节点为邻居集合的成员对应传感节点的邻居节点,并且邻居集合的成员对应的传感节点均感知到目标,因此标识集合中的标识成员i对应的传感节点和目标必定在估计区域内。
添加模块308在第二判断模块305判断到标识集合中的标识成员i对应的测量距离小于或者等于感知半径时,或者第三判断模块307判断到标识集合中的标识成员i的测量距离小于或者等于估计区域内两点间的最大距离和感知半径之间的最小值时,将标识成员i对应的测量距离加入测量距离集合。
计算模块309根据测量距离集合的成员的数量以及测量距离集合的成员对应的位置,计算当前时刻目标所在的估计位置。在本发明实施方式中,计算模块309又可包括:第四判断单元3091、第一计算单元3092、第二计算单元3093及第三计算单元3094。
第四判断单元3091判断测量距离集合中的成员的数量。
第一计算单元3092在第四判断单元3091判断到距离集合中的成员的数量为一个时,则计算测量距离集合的成员对应的估计区域的中心,并以估计区域的中心作为估计位置,并标记估计位置的参与度为一。
第二计算单元3093在第四判断单元3091判断到测量距离集合中的成员的数量为两个时,则分别以测量距离集合的成员对应的位置和测量距离进行双边定位,获得两个定位位置,并计算定位位置与测量距离集合中的成员对应的估计区域的中心之间的距离,以距离最小的一个定位位置作为估计位置,并标记估计位置的参与度为二。
第三计算单元3094在第四判断单元3091判断到测量距离集合的成员的数量大于或者等于三个时,则以测量距离集合的成员的位置和测量距离进行三边定位或者多边定位,获得估计位置,并标记估计位置的参与度为测量距离集合的成员的数量。
进一步的,传感节点30还包括第五判断模块310、第二获取模块311、第三获取模块312及第四计算模块313。
第五判断模块310判断估计位置的参与度。第二获取模块311在第五判断模块310判断到参与度大于或者等于三时,获取目标的三个历史时刻的估计位置,三个历史时刻的估计位置包括当前时刻目标的估计位置及前两个时刻的目标的估计位置。第三获取模块312在第五判断模块310判断到参与度小于三时,获取目标的三个历史时刻的估计位置,该三个历史时刻的历史估计位置均为参与度大于三,参与度都高于其他估计位置的参与度的估计位置。第四计算模块313用于三个历史时刻的估计位置及时间间隔计算目标下一个时刻所在的预测位置。
在本发明实施方式中,第四计算模块313又可包括平均速度计算单元3131、加速度计算单元3132及位置计算单元3133。
平均速度计算单元3131根据三个历史时刻的估计位置及时间间隔,获取目标的对应时间间隔内的纵向平均速度和横向平均速度,其中,纵向平均速度和横向平均速度通过以下计算方式得到:
(x1,y1)、(x2,y2)和(x3,y3)分别为所选取三个估计位置的坐标,并且估计位置(x3,y3)对应的时刻离目标当前时刻最近,估计位置(x1,y1)对应的时刻离目标当前时刻最远,Δt1为时间间隔,v′x为目标在估计位置(x1,y1)和估计位置(x2,y2)之间的平均横向速度,v″x为目标在估计位置(x3,y3)和估计位置(x2,y2)之间的平均横向速度,y′x为目标在估计位置(x1,y1)和估计位置(x2,y2)之间的平均纵向速度,y″x为目标在估计位置(x3,y3)和估计位置(x2,y2)之间的平均纵向速度;
加速度计算单元3132用于根据目标的纵向平均速度和横向平均速度,获取目标的纵向加速度和横向加速度,其中,纵向加速度和横向加速度通过以下计算方式得到:
ax和ay分别为目标的横向加速度和纵向加速;
预测位置计算单元3133用于根据目标的纵向加速度和横向加速度,计算目标下一个时刻所在的预测位置,其中,预测位置通过以下计算方式得到:
x和y分别预测位置的横坐标和纵坐标,Δt2为目标一下时刻与目标在估计位置(x3,y3)的时刻之间的时间间隔。
传感节点30还包括广播模块314及通知模块300。广播模块314广播目标的估计位置及目标下一个时刻所在的预测位置。在接收模块301之前,通知模块300根据自身到目标的预测位置的距离与自身能量之和或者自身能量,广播通知,以使所述至少一个第二传感节点接收通知后,标记所述第一传感节点为主节点,自身为从属节点。
在本发明实施方式中,通过第一获取模块从传感节点的邻居节点中,获取感知到目标的节点,并组成邻居集合。第一判断模块判断邻居集合是否为空。若邻居集合为空,说明传感节点的邻居节点均没有感知到目标,而传感节点能够感知到目标的最大距离为传感节点的感知半径,则可通过第二判断模块判断传感节点的测量距离是否小于或者等于邻居,若是,则说明传感节点的测量可靠,保留该传感节点的测量距离。若邻居集合非空,限定区域构建模块分别为邻居集合的成员构建限定区域,限定区域的重叠部份为估计区域。而传感节点为邻居集合的成员的邻居节点,邻居集合的成员均感知到目标,因此,传感节点及目标必定在估计区域内。第三判断模块判断传感节点的测量距离是否小于或者等于估计区域内两点间的最大距离和感知半径之间的最小值,若是,则说明传感节点的测量可靠,保留该传感节点的测量距离。仅使用可靠的测量距离进行目标定位计算,提高目标定位的准确性。并且在目标定位计算之前,就把不可靠的测量距离筛选掉,不需要在目标定位计算之后,再对目标的位置进行修正,减少传感节点的计算工作量,节约传感节点的计算资源。
请参阅图8,图8是本发明传感节点第二实施方式的结构示意图。如图所示,传感节点40包括处理器401及存储器402。
处理器401用于接收来自至少一个第二传感节点的信息,并将自身与至少一个第二传感节点组成标识集合,其中,信息包括至少一个第二传感节点的标识及至少一个第二传感节点到目标的测量距离;并从标识集合中获取标识集合的成员i的邻居节点,并组成邻居集合,其中,i为标识集合的成员的编号;并判断邻居集合是否为空;若邻居集合为空,则判断标识集合的成员i的测量距离是否小于或者等于感知半径,若是,则将标识集合的成员i的测量距离加入测量距离集合;若邻居集合非空,则分别为邻居集合中的成员构建限定区域,限定区域重叠部份为估计区域,并判断标识集合的成员i的测量距离是否小于或者等于估计区域内两点间的最大距离和感知半径之间的最小值,若是,则将标识集合的成员i的测量距离加入测量距离集合;并根据测量距离集合的成员的数量以及测量距离集合的成员的位置,计算当前时刻目标所在的估计位置。
其中,处理器401执行的上述处理过程通常是由一段程序控制完成,程序存放于存储器402中,当需要进行上述动作时,将程序调入处理器401,由处理器401控制完成。当然,上述处理过程还可以是由硬件完成。
以上所述仅为本发明的实施方式,并非因此限制本发明的专利范围,凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本发明的专利保护范围内。

Claims (12)

1.一种传感网络目标定位方法,其特征在于,所述方法包括:
第一传感节点接收来自至少一个第二传感节点的信息,其中,所述信息包括所述至少一个第二传感节点的节点标识及所述至少一个第二传感节点到目标的测量距离;
所述第一传感节点将自身的节点标识和所述至少一个第二传感节点的节点标识组成标识集合;
所述第一传感节点获取标识集合中的标识成员i的邻居标识,并组成邻居集合,其中,所述邻居标识属于标识集合中的标识成员,并且是标识集合中的标识成员i所对应传感节点的邻居节点的节点标识,所述i为标识集合中的标识成员的编号;
所述第一传感节点判断所述邻居集合是否为空;
若所述邻居集合为空,则所述第一传感节点判断标识集合中的标识成员i对应的测量距离是否小于或者等于感知半径,若是,则将所述标识集合中的标识成员i对应的测量距离加入测量距离集合,
若所述邻居集合非空,则分别为所述邻居集合中的成员构建限定区域,所述限定区域重叠部份为估计区域,并且所述第一传感节点判断标识集合中的标识成员i对应的测量距离是否小于或者等于估计区域内两点间的最大距离和感知半径之间的最小值,若是,则将所述标识集合的成员i对应的测量距离加入测量距离集合;
所述第一传感节点根据所述测量距离集合的成员的数量以及测量距离集合的成员对应的位置,计算当前时刻目标所在的估计位置;
其中,所述第一传感节点根据所述测量距离集合的成员的数量以及测量距离集合的成员对应的位置,计算当前时刻目标所在的估计位置的步骤包括:
所述第一传感节点判断所述测量距离集合的成员的数量;
若所述测量距离集合的成员的数量为一个,则所述第一传感节点以所述测量距离集合中的成员对应的估计区域的中心作为估计位置,并标记所述估计位置的参与度为一,
若所述测量距离集合中的成员的数量为两个,则所述第一传感节点分别以测量距离集合中的成员对应的位置和测量距离进行双边定位,获得两个定位位置,并计算所述定位位置与测量距离集合中的成员对应的估计区域的中心之间的距离,并标记所述估计位置的参与度为二,
若所述测量距离集合中的成员的数量大于或者等于三个,则所述第一传感节点以测量距离集合的成员对应的位置和测量距离进行三边定位或者多边定位,获得所述估计位置,并标记所述估计位置的参与度为测量距离集合的成员的数量。
2.根据权利要求1所述的方法,其特征在于,所述限定区域为以邻居集合中的成员对应的位置为中心,以感知半径为半径的圆的外接正方形的区域。
3.根据权利要求1所述的方法,其特征在于,所述第一传感节点计算当前时刻目标所在的估计位置,标记所述估计位置的参与度的步骤之后,还包括:
所述第一传感节点判断估计位置的参与度;
若所述参与度大于或者等于三,则所述第一传感节点获取目标的三个历史时刻的估计位置,所述三个历史时刻的估计位置包括当前时刻目标的估计位置及前两个时刻的目标的估计位置;
若所述参与度小于三,则所述第一传感节点获取目标的三个历史时刻的估计位置,所述三个历史时刻的估计位置均为参与度大于三,且参与度都高于其他估计位置的参与度的估计位置;
所述第一传感节点根据所述三个历史时刻的估计位置及时间间隔计算目标下一个时刻所在的预测位置。
4.根据权利要求3所述的方法,其特征在于,所述计算所述目标下一个时刻所在的预测位置的步骤包括:
所述第一传感节点根据所述三个历史时刻的估计位置及时间间隔,获取所述目标的对应时间间隔内的纵向平均速度和横向平均速度,其中,所述纵向平均速度和横向平均速度通过以下计算方式得到:
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <msubsup> <mi>v</mi> <mi>x</mi> <mo>&amp;prime;</mo> </msubsup> <mo>=</mo> <mfrac> <mrow> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> </mrow> <mrow> <msub> <mi>&amp;Delta;t</mi> <mn>1</mn> </msub> </mrow> </mfrac> </mtd> </mtr> <mtr> <mtd> <mrow> <msubsup> <mi>v</mi> <mi>y</mi> <mo>&amp;prime;</mo> </msubsup> <mo>=</mo> <mfrac> <mrow> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> </mrow> <mrow> <msub> <mi>&amp;Delta;t</mi> <mn>1</mn> </msub> </mrow> </mfrac> </mrow> </mtd> </mtr> </mtable> </mfenced>
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <msubsup> <mi>v</mi> <mi>x</mi> <mrow> <mo>&amp;prime;</mo> <mo>&amp;prime;</mo> </mrow> </msubsup> <mo>=</mo> <mfrac> <mrow> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> </mrow> <mrow> <msub> <mi>&amp;Delta;t</mi> <mn>1</mn> </msub> </mrow> </mfrac> </mtd> </mtr> <mtr> <mtd> <mrow> <msubsup> <mi>v</mi> <mi>y</mi> <mrow> <mo>&amp;prime;</mo> <mo>&amp;prime;</mo> </mrow> </msubsup> <mo>=</mo> <mfrac> <mrow> <msub> <mi>y</mi> <mn>3</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mn>2</mn> </msub> </mrow> <mrow> <msub> <mi>&amp;Delta;t</mi> <mn>1</mn> </msub> </mrow> </mfrac> </mrow> </mtd> </mtr> </mtable> </mfenced>
所述(x1,y1)、(x2,y2)和(x3,y3)分别为所选取三个历史时刻的估计位置的坐标,并且所述估计位置(x3,y3)对应的时刻离目标当前时刻最近,所述估计位置(x1,y1)对应的时刻离目标当前时刻最远Δt1,所述v′x为目标在估计位置(x1,y1)和估计位置(x2,y2)之间的平均横向速度,所述v″x为目标在估计位置(x3,y3)和估计位置(x2,y2)之间的平均横向速度,所述y′x为目标在估计位置(x1,y1)和估计位置(x2,y2)之间的平均纵向速度,所述y″x为目标在估计位置(x3,y3)和估计位置(x2,y2)之间的平均纵向速度;
所述第一传感节点根据目标的纵向平均速度和横向平均速度,获取所述目标的纵向加速度和横向加速度,其中,所述纵向加速度和横向加速度通过以下计算方式得到:
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <msub> <mi>a</mi> <mi>x</mi> </msub> <mo>=</mo> <mfrac> <mrow> <msubsup> <mi>v</mi> <mi>x</mi> <mrow> <mo>&amp;prime;</mo> <mo>&amp;prime;</mo> </mrow> </msubsup> <mo>-</mo> <msubsup> <mi>v</mi> <mi>x</mi> <mo>&amp;prime;</mo> </msubsup> </mrow> <mrow> <msub> <mi>&amp;Delta;t</mi> <mn>1</mn> </msub> </mrow> </mfrac> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>a</mi> <mi>y</mi> </msub> <mo>=</mo> <mfrac> <mrow> <msubsup> <mi>v</mi> <mi>y</mi> <mrow> <mo>&amp;prime;</mo> <mo>&amp;prime;</mo> </mrow> </msubsup> <mo>-</mo> <msubsup> <mi>v</mi> <mi>y</mi> <mo>&amp;prime;</mo> </msubsup> </mrow> <mrow> <msub> <mi>&amp;Delta;t</mi> <mn>1</mn> </msub> </mrow> </mfrac> </mrow> </mtd> </mtr> </mtable> </mfenced>
所述ax和ay分别为目标的横向加速度和纵向加速;
所述第一传感节点根据目标的纵向加速度和横向加速度,计算所述目标下一个时刻所在的预测位置,其中,所述预测位置通过以下计算方式得到:
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mi>x</mi> <mo>=</mo> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>+</mo> <msubsup> <mi>v</mi> <mi>x</mi> <mrow> <mo>&amp;prime;</mo> <mo>&amp;prime;</mo> </mrow> </msubsup> <mi>&amp;Delta;</mi> <msub> <mi>t</mi> <mn>2</mn> </msub> <mo>+</mo> <mn>0.5</mn> <msub> <mi>a</mi> <mi>x</mi> </msub> <mi>&amp;Delta;</mi> <msup> <msub> <mi>t</mi> <mn>2</mn> </msub> <mn>2</mn> </msup> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>y</mi> <mo>=</mo> <msub> <mi>y</mi> <mn>3</mn> </msub> <mo>+</mo> <msubsup> <mi>v</mi> <mi>y</mi> <mrow> <mo>&amp;prime;</mo> <mo>&amp;prime;</mo> </mrow> </msubsup> <msub> <mi>&amp;Delta;t</mi> <mn>2</mn> </msub> <mo>+</mo> <mn>0.5</mn> <msub> <mi>a</mi> <mi>y</mi> </msub> <msup> <msub> <mi>&amp;Delta;t</mi> <mn>2</mn> </msub> <mn>2</mn> </msup> </mrow> </mtd> </mtr> </mtable> </mfenced>
所述x和y分别预测位置的横坐标和纵坐标,所述Δt2为目标一下时刻与目标在估计位置(x3,y3)的时刻之间的时间间隔。
5.根据权利要求3所述的方法,其特征在于,所述第一传感节点计算所述目标下一个时刻的预测位置的步骤之后,还包括:
所述第一传感节点广播目标的估计位置及下一个时刻所在的预测位置。
6.根据权利要求1所述的方法,其特征在于,所述第一传感节点接收来自至少一个第二传感节点的信息的步骤之前,还包括:
所述第一传感节点根据自身电能和或自身到目标的预测位置的距离,广播通知,以使所述至少一个第二传感节点接收通知后,标记所述第一传感节点为主节点,自身为从属节点。
7.一种传感节点,其特征在于,所述传感节点包括:
接收模块,用于接收来自至少一个第二传感节点的信息,其中,所述信息包括至少一个第二传感节点的节点标识和至少一个第二传感节自身到目标的测量距离;
组合模块,用于将所述传感节点的节点标识与所述至少一个第二传感节点的节点标识组成标识集合;
第一获取模块,用于获取标识集合中的标识成员i的邻居标识,并组成邻居集合,其中,所述邻居标识属于标识集合中的标识成员,并且是标识集合中的标识成员i所对应传感节点的邻居节点的节点标识,所述i为标识集合中的标识成员的编号;
第一判断模块,用于判断所述邻居集合是否为空;
第二判断模块,用于在所述第一判断模块判断到邻居集合为空时,判断所述标识集合中的标识成员i对应的测量距离是否小于或者等于感知半径;
限定区域构建模块,用于在所述第一判断模块判断到邻居集合非空时,分别为所述邻居集合的成员构建限定区域,所述限定区域重叠的部份为估计区域;
第三判断模块,用于判断标识集合中的标识成员i对应的测量距离是否小于或者等于估计区域内两点间的最大距离和感知半径之间的最小值;
添加模块,用于在所述第二判断模块判断到标识集合中的标识成员i对应的测量距离小于或者等于感知半径时,或者第三判断模块判断到标识集合中的标识成员i的测量距离小于或者等于估计区域内两点间的最大距离和感知半径之间的最小值时,将所述标识成员i对应的测量距离加入测量距离集合;
计算模块,用于根据所述测量距离集合的成员的数量以及测量距离集合的成员对应的位置,计算当前时刻目标所在的估计位置;
其中,所述计算模块包括:
第四判断单元,用于判断所述测量距离集合中的成员的数量;
第一计算单元,用于在所述第四判断单元判断到距离集合中的成员的数量为一个时,则计算所述测量距离集合的成员对应的估计区域的中心,并以所述估计区域的中心作为估计位置,并标记所述估计位置的参与度为一;
第二计算单元,用于在所述第四判断单元判断到距离集合中的成员的数量为两个时,则分别以测量距离集合中的成员对应的位置和测量距离进行双边定位,获得两个定位位置,并计算所述定位位置与测量距离集合中的成员对应的估计区域的中心之间的距离,且以所述距离最小的一个定位位置作为估计位置,并标记所述估计位置的参与度为二;
第三计算单元,用于在所述第四判断单元判断到测量距离集合的成员的数量大于或者等于三个时,则以测量距离集合的成员对应的位置和测量距离进行三边定位或者多边定位,获得所述估计位置,并标记所述估计位置的参与度为测量距离集合的成员的数量。
8.根据权利要求7所述的传感节点,其特征在于,所述限定区域为以邻居集合的成员对应的位置为中心,以感知半径为半径的圆的外接正方形的区域。
9.根据权利要求7所述的传感节点,其特征在于,所述传感节点还包括:
第五判断模块,用于判断所述估计位置的参与度;
第二获取模块,用于在所述第五判断模块判断到所述参与度大于或者等于三时,获取所述目标的三个历史时刻的估计位置,所述三个历史时刻的估计位置包括当前时刻目标的估计位置及前两个时刻的目标的估计位置;
第三获取模块,用于在所述第五判断模块判断到所述参与度小于三时,获取目标的三个历史时刻的估计位置,所述三个历史时刻的估计位置均为参与度大于三,且参与度都高于其他估计位置的参与度的估计位置;
第四计算模块,用于根据所述三个历史时刻的估计位置及时间间隔计算目标下一个时刻所在的预测位置。
10.根据权利要求9所述的传感节点,其特征在于,所述第四计算模块具体包括:
平均速度计算单元,用于根据所述选取三个估计位置及时间间隔,获取所述目标的对应时间间隔内的纵向平均速度和横向平均速度,其中,所述纵向平均速度和横向平均速度通过以下计算方式得到:
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <msubsup> <mi>v</mi> <mi>x</mi> <mo>&amp;prime;</mo> </msubsup> <mo>=</mo> <mfrac> <mrow> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> </mrow> <mrow> <msub> <mi>&amp;Delta;t</mi> <mn>1</mn> </msub> </mrow> </mfrac> </mtd> </mtr> <mtr> <mtd> <mrow> <msubsup> <mi>v</mi> <mi>y</mi> <mo>&amp;prime;</mo> </msubsup> <mo>=</mo> <mfrac> <mrow> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> </mrow> <mrow> <msub> <mi>&amp;Delta;t</mi> <mn>1</mn> </msub> </mrow> </mfrac> </mrow> </mtd> </mtr> </mtable> </mfenced>
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <msubsup> <mi>v</mi> <mi>x</mi> <mrow> <mo>&amp;prime;</mo> <mo>&amp;prime;</mo> </mrow> </msubsup> <mo>=</mo> <mfrac> <mrow> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> </mrow> <mrow> <msub> <mi>&amp;Delta;t</mi> <mn>1</mn> </msub> </mrow> </mfrac> </mtd> </mtr> <mtr> <mtd> <mrow> <msubsup> <mi>v</mi> <mi>y</mi> <mrow> <mo>&amp;prime;</mo> <mo>&amp;prime;</mo> </mrow> </msubsup> <mo>=</mo> <mfrac> <mrow> <msub> <mi>y</mi> <mn>3</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mn>2</mn> </msub> </mrow> <mrow> <msub> <mi>&amp;Delta;t</mi> <mn>1</mn> </msub> </mrow> </mfrac> </mrow> </mtd> </mtr> </mtable> </mfenced>
所述(x1,y1)、(x2,y2)和(x3,y3)分别为所述三个历史时刻的估计位置的坐标,并且所述估计位置(x3,y3)对应的时刻离目标当前时刻最近,所述估计位置(x1,y1)对应的时刻离目标当前时刻最远,所述Δt1为时间间隔,所述v′x为目标在估计位置(x1,y1)和估计位置(x2,y2)之间的平均横向速度,所述v″x为目标在估计位置(x3,y3)和估计位置(x2,y2)之间的平均横向速度,所述y′x为目标在估计位置(x1,y1)和估计位置(x2,y2)之间的平均纵向速度,所述y″x为目标在估计位置(x3,y3)和估计位置(x2,y2)之间的平均纵向速度;
加速度计算单元,用于根据所述目标的纵向平均速度和横向平均速度,获取所述目标的纵向加速度和横向加速度,其中,所述纵向加速度和横向加速度通过以下计算方式得到:
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <msub> <mi>a</mi> <mi>x</mi> </msub> <mo>=</mo> <mfrac> <mrow> <msubsup> <mi>v</mi> <mi>x</mi> <mrow> <mo>&amp;prime;</mo> <mo>&amp;prime;</mo> </mrow> </msubsup> <mo>-</mo> <msubsup> <mi>v</mi> <mi>x</mi> <mo>&amp;prime;</mo> </msubsup> </mrow> <mrow> <msub> <mi>&amp;Delta;t</mi> <mn>1</mn> </msub> </mrow> </mfrac> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>a</mi> <mi>y</mi> </msub> <mo>=</mo> <mfrac> <mrow> <msubsup> <mi>v</mi> <mi>y</mi> <mrow> <mo>&amp;prime;</mo> <mo>&amp;prime;</mo> </mrow> </msubsup> <mo>-</mo> <msubsup> <mi>v</mi> <mi>y</mi> <mo>&amp;prime;</mo> </msubsup> </mrow> <mrow> <msub> <mi>&amp;Delta;t</mi> <mn>1</mn> </msub> </mrow> </mfrac> </mrow> </mtd> </mtr> </mtable> </mfenced>
所述ax和ay分别为目标的横向加速度和纵向加速;
预测位置计算单元,用于根据所述目标的纵向加速度和横向加速度,计算所述目标下一个时刻所在的预测位置,其中,所述预测位置通过以下计算方式得到:
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mi>x</mi> <mo>=</mo> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>+</mo> <msubsup> <mi>v</mi> <mi>x</mi> <mrow> <mo>&amp;prime;</mo> <mo>&amp;prime;</mo> </mrow> </msubsup> <mi>&amp;Delta;</mi> <msub> <mi>t</mi> <mn>2</mn> </msub> <mo>+</mo> <mn>0.5</mn> <msub> <mi>a</mi> <mi>x</mi> </msub> <mi>&amp;Delta;</mi> <msup> <msub> <mi>t</mi> <mn>2</mn> </msub> <mn>2</mn> </msup> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>y</mi> <mo>=</mo> <msub> <mi>y</mi> <mn>3</mn> </msub> <mo>+</mo> <msubsup> <mi>v</mi> <mi>y</mi> <mrow> <mo>&amp;prime;</mo> <mo>&amp;prime;</mo> </mrow> </msubsup> <msub> <mi>&amp;Delta;t</mi> <mn>2</mn> </msub> <mo>+</mo> <mn>0.5</mn> <msub> <mi>a</mi> <mi>y</mi> </msub> <msup> <msub> <mi>&amp;Delta;t</mi> <mn>2</mn> </msub> <mn>2</mn> </msup> </mrow> </mtd> </mtr> </mtable> </mfenced>
所述x和y分别预测位置的横坐标和纵坐标,所述Δt2为目标一下时刻与目标在估计位置(x3,y3)的时刻之间的时间间隔。
11.根据权利要求7所述的传感节点,其特征在于,所述传感节点还包括:
广播模块,用于广播所述目标的估计位置及目标下一个时刻所在的预测位置。
12.根据权利要求7所述的传感节点,其特征在于,所述传感节点还包括通知模块,用于根据自身到目标的预测位置的距离与自身能量之和或者自身能量,广播通知,以使所述至少一个第二传感节点接收通知后,标记所述第一传感节点为主节点,自身为从属节点。
CN201210468237.3A 2012-11-19 2012-11-19 一种传感网络目标定位方法及传感节点 Active CN103826297B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201210468237.3A CN103826297B (zh) 2012-11-19 2012-11-19 一种传感网络目标定位方法及传感节点

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201210468237.3A CN103826297B (zh) 2012-11-19 2012-11-19 一种传感网络目标定位方法及传感节点

Publications (2)

Publication Number Publication Date
CN103826297A CN103826297A (zh) 2014-05-28
CN103826297B true CN103826297B (zh) 2017-12-15

Family

ID=50761060

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201210468237.3A Active CN103826297B (zh) 2012-11-19 2012-11-19 一种传感网络目标定位方法及传感节点

Country Status (1)

Country Link
CN (1) CN103826297B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105704664A (zh) * 2015-03-06 2016-06-22 济南大学 一种在噪声环境下稀疏无线传感器网络的定位方法

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101424737A (zh) * 2008-12-15 2009-05-06 北京航空航天大学 一种基于信号强度距离的无线传感器网络信号图定位方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CA2705335C (en) * 2007-11-13 2015-06-30 Novatel Inc. System for determining position over a network

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101424737A (zh) * 2008-12-15 2009-05-06 北京航空航天大学 一种基于信号强度距离的无线传感器网络信号图定位方法

Also Published As

Publication number Publication date
CN103826297A (zh) 2014-05-28

Similar Documents

Publication Publication Date Title
CN102665277B (zh) 一种对无线传感器网络中节点进行定位的方法
Deng et al. Confident information coverage hole healing in hybrid industrial wireless sensor networks
CN102608571B (zh) 一种面向野生动物的无线传感器网络的目标定位方法
CN102361514B (zh) 具有移动节点的监测区域空洞修复方法
CN106257301B (zh) 基于统计推断的分布式时空关联模型轨迹跟踪方法
Yi et al. Confident information coverage hole detection in sensor networks for uranium tailing monitoring
CN101873691A (zh) 基于连通性的无需测距的无线传感器网络节点定位方法
Asmaa et al. Localization algorithms research in wireless sensor network based on Multilateration and Trilateration techniques
CN101938832A (zh) 基于分治求精的无线传感器网络节点自身定位方法
CN103491591B (zh) 无线传感器网络复杂区域划分方法和节点定位方法
CN105025572A (zh) 一种基于rssi测距的井下人员定位的改进方法
CN103529427A (zh) 无线传感网随机部署下的目标定位方法
CN103415072A (zh) 一种无线传感网络中基于估距的定位方法
CN103630876A (zh) 基于RSSI的ZigBee节点定位方法
Zhai et al. Coverage hole detection and recovery in wireless sensor networks based on RSSI-based localization
CN101772013A (zh) 一种基于投票机制的wsn抗攻击节点定位方法
CN104994579B (zh) 一种适用于事件触发的分布式移动目标跟踪方法
CN103826297B (zh) 一种传感网络目标定位方法及传感节点
CN102958153A (zh) 一种基于无线传感器网络的定位方法
Ren et al. Energy efficient tracking in uncertain sensor networks
CN102143580B (zh) 一种基于轮状图的无线网络终端的定位方法
CN106937298B (zh) 一种改进的无线传感器网络三维定位方法
CN103037503A (zh) 一种无线传感器网络定位方法及系统
CN102164406B (zh) 用于无线传感器节点定位的非视距路径鉴别装置及其工作方法
CN102238724A (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
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20191211

Address after: 314415 within huangwan town government, Jiaxing City, Zhejiang Province

Patentee after: Haining huangwan town Asset Management Co.,Ltd.

Address before: 510000 unit 2414-2416, building, No. five, No. 371, Tianhe District, Guangdong, China

Patentee before: GUANGDONG GAOHANG INTELLECTUAL PROPERTY OPERATION Co.,Ltd.

Effective date of registration: 20191211

Address after: 510000 unit 2414-2416, building, No. five, No. 371, Tianhe District, Guangdong, China

Patentee after: GUANGDONG GAOHANG INTELLECTUAL PROPERTY OPERATION Co.,Ltd.

Address before: 518129 Bantian HUAWEI headquarters office building, Longgang District, Guangdong, Shenzhen

Patentee before: HUAWEI TECHNOLOGIES Co.,Ltd.