CN113848543B - 网络节点的测距定位方法、系统、电子设备及存储介质 - Google Patents

网络节点的测距定位方法、系统、电子设备及存储介质 Download PDF

Info

Publication number
CN113848543B
CN113848543B CN202111427576.2A CN202111427576A CN113848543B CN 113848543 B CN113848543 B CN 113848543B CN 202111427576 A CN202111427576 A CN 202111427576A CN 113848543 B CN113848543 B CN 113848543B
Authority
CN
China
Prior art keywords
node
active
response
ranging
monitoring
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
CN202111427576.2A
Other languages
English (en)
Other versions
CN113848543A (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.)
South China University of Technology SCUT
Original Assignee
South China University of Technology SCUT
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 South China University of Technology SCUT filed Critical South China University of Technology SCUT
Priority to CN202111427576.2A priority Critical patent/CN113848543B/zh
Publication of CN113848543A publication Critical patent/CN113848543A/zh
Application granted granted Critical
Publication of CN113848543B publication Critical patent/CN113848543B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S11/00Systems for determining distance or velocity not using reflection or reradiation
    • G01S11/02Systems for determining distance or velocity not using reflection or reradiation using radio waves
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W64/00Locating users or terminals or network equipment for network management purposes, e.g. mobility management
    • H04W64/006Locating users or terminals or network equipment for network management purposes, e.g. mobility management with additional information processing, e.g. for direction or speed determination

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Signal Processing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

本发明提出一种网络节点的测距定位方法、系统、电子设备及存储介质网络节点的测距定位方法。其中,方法包括:由网络节点中选择出的主动节点选择其它任一节点,为响应节点,主动节点未选择的其它节点,为监听节点;应用双边双向测距方法,得到主动节点与响应节点的距离和测距过程的数据;监听节点监听主动节点和响应节点之间的测距过程,记录测距过程的数据和主动节点和响应节点发送的通信帧到达监听节点的时间戳;根据测距过程的数据和主动节点和响应节点发送的通信帧到达监听节点的时间戳,计算出监听节点与响应节点之间的距离。本发明提出的方案能够极大地减少了系统测距周期,能够适合规模较大的网络。

Description

网络节点的测距定位方法、系统、电子设备及存储介质
技术领域
本发明属于无线网络中节点之间的测距与定位领域,尤其涉及一种网络节点的测距定位方法、系统、电子设备及计算机可读存储介质。
背景技术
UWB(Ultra Wide Band,超宽带)技术是一种全新的通信技术,它不采用正弦载波,而是利用纳秒级的非正弦窄脉冲传输数据。由于UWB脉冲的时间宽度极短,因此配上高精度定时可以实现高精度距离测算,其定位精度可达厘米级。采用UWB技术进行距离测算是以测量飞行时间(Time of flight)为基础,即通过测量电磁波在两节点之间传播所需的时间,将其与光速相乘便可得出两节点间的距离。该方法只能实现两节点之间的测距,当网络中节点较多时,若使用该方法实现任意两节点之间的测距,一个完整测量周期需进行较大的通信量,存在造成更新周期过长,测量数据不及时。
双边双向测距(Double Sided Two-way Ranging, DS-TWR)是一种常用的实现两 节点之间的测距方法。在DS-TWR方法中,两节点之间的一次测距通过4次通信完成,将4次通 信依次称为poll、resp、final、ack。在多节点UWB网络中,假设节点总数为n,在该网络中每 一节点都需测量与其他节点之间的距离。在每一轮距离更新周期中,每一节点都需与其他 节点进行一次DS-TWR方法测距,则完成所有节点之间的测距所需要的DS-TWR测距次数为
Figure 224808DEST_PATH_IMAGE001
,显然,该值随n增大而以平方关系快速增加,如n=10时,N=45;n=20时,N=190。 因此,随着n的增长,采用DS-TWR测距方法的系统距离更新周期急剧增长,该测距定位方法 不适合规模稍微大一些的网络。
发明内容
为解决上述技术问题,本发明提出一种适合大规模UWB网络节点的测距定位的技术方案,把原有DS-TWR方法的网络测距时间随节点个数增长的平方幂关系变为线性增长关系的方法以解决上述技术问题。
本发明第一方面公开了一种网络节点的测距定位方法,适用于大规模UWB网络节点,所述方法包括:
由网络节点中选择出的主动节点选择其它任一节点,为响应节点,所述主动节点未选择的其它节点,为监听节点;
应用双边双向测距方法,得到所述主动节点与响应节点的距离和测距过程的数据;
所述监听节点监听所述主动节点和响应节点之间的测距过程,记录所述测距过程的数据和所述主动节点和响应节点发送的通信帧到达监听节点的时间戳;
根据所述测距过程的数据和所述主动节点和响应节点发送的通信帧到达监听节点的时间戳,计算出所述监听节点与所述响应节点之间的距离。
根据本发明第一方面的方法,应用双边双向测距方法,得到所述主动节点与响应节点的距离,包括:
所述主动节点与所述响应节点共发生4次通信,分别为poll帧、resp帧、final帧和ack帧,每次通信中,所述主动节点和所述响应节点分别记录自身发出或者收到信息的时间戳,并记录设置的延时发送参数,根据所述时间戳和所述延时发送参数计算所述主动节点与响应节点的距离。
根据本发明第一方面的方法,记录所述测距过程的数据的步骤中,该数据包括:
测距过程计算数据和所述延时发送参数。
根据本发明第一方面的方法,在所述步骤S3中,所述测距过程计算数据包括:
所述主动节点与响应节点之间的电磁波的飞行时间tof;
前次飞行时间tof_to_Initiator,所述前次飞行时间tof_to_Initiator为,所述监听节点前次作为响应节点时,应用双边双向测距方法计算出的所述监听节点与所述主动节点之间的飞行时间。
根据本发明第一方面的方法,所述延时发送参数包括:
所述响应节点发送resp帧设置的第一延时时间D1;
所述主动节点发送final帧设置的第二延时时间D2;
所述响应节点发送ack帧设置的第三延时时间D3。
根据本发明第一方面的方法,记录所述主动节点和响应节点发送的通信帧到达监听节点的时间戳的方法包括:
收到来自所述主动节点发送的poll帧后,记录所述poll帧到达所述监听节点的天线的时间戳,第一时间戳t1;
收到来自所述响应节点发送的resp帧后,记录所述resp帧到达所述监听节点的天线的时间戳,第二时间戳t2;
收到来自所述主动节点发送的final帧后,记录所述final帧到达所述监听节点的天线的时间戳,第三时间戳t3;
收到来自所述响应节点发送的ack帧后,记录所述ack帧到达所述监听节点的天线的时间戳,第四时间戳t4。
根据本发明第一方面的方法,所述根据所述测距过程的数据和所述主动节点和响应节点发送的通信帧到达监听节点的时间戳,计算出所述监听节点与所述响应节点之间的距离的具体计算公式为:
Figure 257486DEST_PATH_IMAGE002
其中,
Figure 582289DEST_PATH_IMAGE003
:表示求两时间戳t2与t1之间的时间差;
Figure 889773DEST_PATH_IMAGE004
:表示求两时间戳t3与t2之间的时间差;
Figure 452473DEST_PATH_IMAGE005
:表示求两时间戳t4与t3之间的时间差;
c:表示电磁波在空气中的传播速度;
T1、T2、T3分别表示得到的三次与响应节点之间的飞行时间,
Figure 921631DEST_PATH_IMAGE006
表示监听节点与响 应节点之间的距离计算值。
本发明第二方面公开了一种网络节点的测距定位方法系统,适用于大规模UWB网络节点,所述系统包括:
第一处理模块,被配置为,由网络节点中选择出的主动节点选择其它任一节点,为响应节点,所述主动节点未选择的其它节点,为监听节点;
第二处理模块,被配置为,应用双边双向测距方法,得到所述主动节点与响应节点的距离和测距过程的数据;
第三处理模块,被配置为,所述监听节点监听所述主动节点和响应节点之间的测距过程,记录所述测距过程的数据和所述主动节点和响应节点发送的通信帧到达监听节点的时间戳;
第四处理模块,被配置为,根据所述测距过程的数据和所述主动节点和响应节点发送的通信帧到达监听节点的时间戳,计算出所述监听节点与所述响应节点之间的距离。
根据本发明第二方面的系统,所述第二处理模块具体被配置为,应用双边双向测距方法,得到所述主动节点与响应节点的距离具体方法包括:
所述主动节点与所述响应节点共发生4次通信,分别为poll帧、resp帧、final帧和ack帧,每次通信中,所述主动节点和所述响应节点分别记录自身发出或者收到信息的时间戳,并记录设置的延时发送参数,根据所述时间戳和所述延时发送参数计算所述主动节点与响应节点的距离。
根据本发明第二方面的系统,所述第三处理模块具体被配置为,记录所述测距过程的数据的步骤中,该数据包括:
测距过程计算数据和所述延时发送参数。
所述测距过程计算数据包括:
所述主动节点与响应节点之间的电磁波的飞行时间tof;
前次飞行时间tof_to_Initiator,所述前次飞行时间tof_to_Initiator为,所述监听节点前次作为响应节点时,应用双边双向测距方法计算出的所述监听节点与所述主动节点之间的飞行时间。
所述延时发送参数包括:
所述响应节点发送resp帧设置的第一延时时间D1;
所述主动节点发送final帧设置的第二延时时间D2;
所述响应节点发送ack帧设置的第三延时时间D3。
记录所述主动节点和响应节点发送的通信帧到达监听节点的时间戳的方法包括:
收到来自所述主动节点发送的poll帧后,记录所述poll帧到达所述监听节点的天线的时间戳,第一时间戳t1;
收到来自所述响应节点发送的resp帧后,记录所述resp帧到达所述监听节点的天线的时间戳,第二时间戳t2;
收到来自所述主动节点发送的final帧后,记录所述final帧到达所述监听节点的天线的时间戳,第三时间戳t3;
收到来自所述响应节点发送的ack帧后,记录所述ack帧到达所述监听节点的天线的时间戳,第四时间戳t4。
根据本发明第二方面的系统,所述第四处理模块具体被配置为,所述根据所述测距过程的数据和所述主动节点和响应节点发送的通信帧到达监听节点的时间,计算出所述监听节点与所述响应节点之间的距离的具体计算公式为:
Figure 468150DEST_PATH_IMAGE002
其中,
Figure 313746DEST_PATH_IMAGE003
:表示求两时间戳t2与t1之间的时间差;
Figure 262111DEST_PATH_IMAGE004
:表示求两时间戳t3与t2之间的时间差;
Figure 902171DEST_PATH_IMAGE005
:表示求两时间戳t4与t3之间的时间差;
c:表示电磁波在空气中的传播速度;
T1、T2、T3分别表示得到的三次与响应节点之间的飞行时间,
Figure 935986DEST_PATH_IMAGE006
表示监听节点与响 应节点之间的距离计算值。
本发明第三方面公开了一种电子设备,电子设备包括存储器和处理器,存储器存储有计算机程序,处理器执行计算机程序时,实现本公开第一方面中任一项的一种网络节点的测距定位方法中的步骤。
本发明第四方面公开了一种计算机可读存储介质。计算机可读存储介质上存储有计算机程序,计算机程序被处理器执行时,实现本公开第一方面中任一项的一种网络节点的测距定位方法中的步骤。
可见,本发明提出的方案,
(1)全网DS-TWR的测距方法所消耗的测距次数与网络中节点的个数的平方成正比,而本发明的测距方法所需的测距次数与网络中节点的个数成线性关系,极大地减少了测距次数,采用本发明的测距方法可以应用于大规模网络测距和组网。
(2)相对于现有的全网DS-TWR测距方法,本发明的基于监听测距可以大大减少了一轮测距所需的通信量和通信时间,缩短了距离数据的更新周期,提高了系统的实时性。
(3)本发明易于实现,在不增加原有系统的硬件成本的基础上,只要增加软件的监听机制即可实现,利于改进现有的UWB无线网络节点测距和推广。
综上,本发明提出的方案能够极大地减少了系统测距周期,能够适合规模较大的网络。
附图说明
为了更清楚地说明本发明具体实施方式或现有技术中的技术方案,下面将对具体实施方式或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施方式,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为根据本发明实施例的一种网络节点的测距定位方法的流程图;
图2为根据本发明实施例的网络节点UWB通信硬件结构图;
图3为根据本发明实施例的双边双向测距(DS-TWR)原理图;
图4为根据本发明实施例的主动节点与响应节点的测距过程中,监听节点完成监听测距图;
图5为根据本发明实施例的监听测距原理中T1和T3的计算方法示意图;
图6为根据本发明实施例的监听测距原理中T2的计算方法示意图;
图7为根据本发明实施例的一种网络节点的测距定位方法系统的结构图;
图8为根据本发明实施例的一种电子设备的结构图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例只是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
图2为网络节点的UWB通信部分结构图,由电源电路、UWB收发电路和MCU及其外围 电路组成。电源电路为系统提供电能,MCU采用STM32G431CB,UWB收发芯片采用DW1000,MCU 通过SPI总线与UWB芯片进行芯片之间的有线通信,节点之间的无线UWB通信采用 IEEE802.15.4-2011 数据链路层协议。在MCU进行DS-TWR测距过程中,UWB芯片在发送数据 时,加上数据帧的发送时间戳;在接收数据帧时,获得接收数据时刻的时间戳和对方发送时 的时间戳;MCU根据收发的时间戳计算出收发双方之间的距离。电磁波的飞行时间测距法是 根据节点A发送到节点B的电磁波的飞行时间tof按照公式
Figure 585273DEST_PATH_IMAGE007
计算得到,其中c为电 磁波在空中的速度为3×108米/秒,d为节点A和节点B之间的距离。
本发明第一方面公开了一种网络节点的测距定位方法。图1为根据本发明实施例的一种网络节点的测距定位方法的流程图,如图1所示,适用于大规模UWB网络节点,所述方法包括:
步骤S1、由网络节点中选择出的主动节点选择其它任一节点,为响应节点,所述主动节点未选择的其它节点,为监听节点;
步骤S2、应用双边双向测距方法,得到所述主动节点与响应节点的距离和测距过程的数据;
步骤S3、所述监听节点监听所述主动节点和响应节点之间的测距过程,记录所述测距过程的数据和所述主动节点和响应节点发送的通信帧到达监听节点的时间戳;
步骤S4、根据所述测距过程的数据和所述主动节点和响应节点发送的通信帧到达监听节点的时间戳,计算出所述监听节点与所述响应节点之间的距离。
在步骤S1,在网络节点中选择一节点为主动节点,所述主动节点选择其它任一节点,为响应节点,所述主动节点未选择的其它节点,为监听节点。
具体地,在网络节点中选择一节点为主动节点,主动节点再对其他节点轮流发起测距,主动节点为测距的发起方,主动节点称为Initiator;主动节点选择的其它任一节点为响应节点,响应节点称为Responder;主动节点未选择的其它节点监听节点,监听节点称为Listener。
在步骤S2,应用双边双向测距方法,得到所述主动节点与响应节点的距离和测距过程的数据。
在一些实施例中,在所述步骤S2中,应用双边双向测距方法,得到所述主动节点与响应节点的距离具体方法包括:
如图3所示,所述主动节点与所述响应节点共发生4次通信,分别为poll帧、resp帧、final帧和ack帧,每次通信中,所述主动节点和所述响应节点分别记录自身发出或者收到信息的时间戳,并记录设置的延时发送参数,根据所述时间戳和所述延时发送参数计算所述主动节点与响应节点的距离。
具体地,Step 0, 主动节点发出poll帧,并在本地记录无线电信号离开天线时的时间戳poll_tx_ts;
Step 1, 响应节点收到来自主动节点的poll帧后,在本地记录信号到达天线时的时间戳poll_rx_ts;
Step 2, 响应节点设置延时发送,使得它的时间戳在poll_rx_ts基础上流过D1单位后,resp帧离开天线,记录此时的时间戳resp_tx_ts;
Step 3, 主动节点收到resp帧后,记录resp信息到达天线时的时间戳resp_rx_ts;
Step 4, 主动节点设置延时发送,使得它的时间戳在resp_rx_ts基础上流过D2单位后,final帧离开天线,记录此时的时间戳final_tx_ts,在final帧中,主动节点将本地的poll_tx_ts、resp_rx_ts、final_tx_ts以及D2发送至响应节点,以便响应节点计算距离;
Step 5, 响应节点收到final帧后,记录fina帧到达天线时的时间戳final_rx_ts, 按照下式计算两节点间的距离:
Figure 653723DEST_PATH_IMAGE008
(1)
其中,算子
Figure 730264DEST_PATH_IMAGE009
表示求两时间戳之间的时间差,
Figure 251375DEST_PATH_IMAGE010
表示电磁波在空气中的传播速度,
Figure 438774DEST_PATH_IMAGE006
表示两节点之间的距离;tof为主动节点到响应节点的飞行时间;R1为主动节点发送poll帧 到其收到resp帧的时间差;R2为响应节点发送resp帧到其收到final帧的时间差;
Step 6, 响应节点计算结束后,发送ack帧,该帧同样采用延时发送,使得它的时间戳在final_rx_ts基础上流过D3单位后,ack帧离开天线,记录此时的时间戳为ack_tx_ts,此外,在该帧中将计算结果发送给主动节点。
在步骤S3,所述监听节点监听所述主动节点和响应节点之间的测距过程,记录所述测距过程的数据和所述主动节点和响应节点发送的通信帧到达监听节点的时间戳。
在一些实施例中,在所述步骤S3中,所记录所述测距过程的数据包括:
测距过程计算数据和所述延时发送参数。
在一些实施例中,在所述步骤S3中,所述测距过程计算数据包括:
所述主动节点与响应节点之间的电磁波的飞行时间tof;
前次飞行时间tof_to_Initiator,所述前次飞行时间tof_to_Initiator为,所述监听节点前次作为响应节点时,应用双边双向测距方法计算出的所述监听节点与所述主动节点之间的飞行时间。
在一些实施例中,在所述步骤S3中,所述延时发送参数包括:
所述响应节点发送resp帧设置的第一延时时间D1;
所述主动节点发送final帧设置的第二延时时间D2;
所述响应节点发送ack帧设置的第三延时时间D3。
在一些实施例中,在所述步骤S3中,记录所述主动节点和响应节点发送的通信帧到达监听节点的时间戳的方法包括:
收到来自所述主动节点发送的poll帧后,记录所述poll帧到达所述监听节点的天线的时间戳,第一时间戳t1;
收到来自所述响应节点发送的resp帧后,记录所述resp帧到达所述监听节点的天线的时间戳,第二时间戳t2;
收到来自所述主动节点发送的final帧后,记录所述final帧到达所述监听节点的天线的时间戳,第三时间戳t3;
收到来自所述响应节点发送的ack帧后,记录所述ack帧到达所述监听节点的天线的时间戳,第四时间戳t4。
具体地,图4是整个网络内主动节点与其它节点的DS-TWR通信示意图,当主动节点与其它一个作为响应节点进行DS-TWR测距时,剩余的节点作为监听节点(图中只画出了一个监听节点)完成监听测距。
在图4的一次主动节点与响应节点的DS-TWR测距过程中,在ack帧中,需将D1、D2、D3以及计算得出的tof一并发出,而且响应节点在测距完成后应更新与主动节点之间的飞行时间tof_to_Initiator。在DS-TWR测距过程中,除主动节点和响应节点以外的节点均称为监听节点,监听节点监听主动节点和响应节点之间的测距过程,记录各个帧时的时间戳和接收D1、D2、D3、tof和tof_to_Initiator等数据,记录各个帧时的时间戳的方法包括:
收到来自所述主动节点发送的poll帧后,记录所述poll帧到达所述监听节点的天线的时间戳,第一时间戳t1;
收到来自所述响应节点发送的resp帧后,记录所述resp帧到达所述监听节点的天线的时间戳,第二时间戳t2;
收到来自所述主动节点发送的final帧后,记录所述final帧到达所述监听节点的天线的时间戳,第三时间戳t3;
收到来自所述响应节点发送的ack帧后,记录所述ack帧到达所述监听节点的天线的时间戳,第四时间戳t4。
在步骤S4,根据所述测距过程的数据和所述主动节点和响应节点发送的通信帧到达监听节点的时间戳,计算出所述监听节点与所述响应节点之间的距离。
在一些实施例中,在所述步骤S4中,所述根据所述测距过程的数据和所述主动节点和响应节点发送的通信帧到达监听节点的时间戳,计算出所述监听节点与所述响应节点之间的距离的具体计算公式为:
Figure 627310DEST_PATH_IMAGE011
其中,
Figure 874751DEST_PATH_IMAGE012
:表示求两时间戳t2与t1之间的时间差;
Figure 883159DEST_PATH_IMAGE013
:表示求两时间戳t3与t2之间的时间差;
Figure 139827DEST_PATH_IMAGE014
:表示求两时间戳t4与t3之间的时间差;
c:表示电磁波在空气中的传播速度;
T1、T2、T3分别表示得到的三次与响应节点之间的飞行时间,
Figure 917291DEST_PATH_IMAGE006
表示监听节点与响 应节点之间的距离计算值。
具体的,图5是一次DS-TWR中,监听节点与响应节点飞行时间T1和T3的测量;图6是一次DS-TWR中,监听节点与响应节点飞行时间T2的测量。
在步骤S3中,监听节点一共可求出三次与响应节点之间的飞行时间,对三次计算结果求平均值可减小测距误差。
计算公式如下:
Figure 335634DEST_PATH_IMAGE002
其中,
Figure 831337DEST_PATH_IMAGE003
:表示求两时间戳t2与t1之间的时间差;
Figure 626118DEST_PATH_IMAGE004
:表示求两时间戳t3与t2之间的时间差;
Figure 258087DEST_PATH_IMAGE005
:表示求两时间戳t4与t3之间的时间差;
c:表示电磁波在空气中的传播速度。
采用传统的DS-TWR方法,要实现节点数为n的网络中每两个节点之间距离的测量,完成所有节点之间的测距所需要的DS-TWR测距次数为 ,N随n的平方关系快速增加,如n=20时,N=190,测量次数随网络节点个数增长太快,不适合规模稍微大网络内部节点之间的测距。
与传统的DS-TWR相比,主动节点和响应节点只要增加发送tof、D1、D2、D3,这些数 据很容易在IEEE802.15.4数据链路层的数据帧中通过夹带方式实现,并不增加通信次数, 而监听节点只要接收DS-TWR通信过程的时间数据即可实现监听节点与响应节点的测距。在 具有n个节点的网络中,一个完整网络测距更新周期内只需进行
Figure 847332DEST_PATH_IMAGE015
次DS-TWR测距就可 以完成所有节点两两测距,测距次数与节点个数呈线性关系,如在n=20时,N=19,与传统方 法(N=190)相比,大大减少了更新时间。本发明还可以通过一定机制(如令牌机制、选举竞争 机制等)周期更换主动节点,具有很大的灵活性,可满足不同应用需求,具有推广应用价值。
本发明第二方面公开了一种网络节点的测距定位方法系统。图7为根据本发明实施例的一种网络节点的测距定位方法系统的结构图;如图7所示,所述系统100包括:
第一处理模块101,被配置为,在网络节点中选择一节点为主动节点,所述主动节点选择其它任一节点,为响应节点,所述主动节点未选择的其它节点,为监听节点;
第二处理模块102,被配置为,应用双边双向测距方法,得到所述主动节点与响应节点的距离和测距过程的数据;
第三处理模块103,被配置为,所述监听节点监听所述主动节点和响应节点之间的测距过程,记录所述测距过程的数据和所述主动节点和响应节点发送的通信帧到达监听节点的时间戳;
第四处理模块104,被配置为,根据所述测距过程的数据和所述主动节点和响应节点发送的通信帧到达监听节点的时间戳,计算出所述监听节点与所述响应节点之间的距离。
根据本发明第二方面的系统,所述第二处理模块102具体被配置为,应用双边双向测距方法,得到所述主动节点与响应节点的距离具体方法包括:
所述主动节点与所述响应节点共发生4次通信,分别为poll帧、resp帧、final帧和ack帧,每次通信中,所述主动节点和所述响应节点分别记录自身发出或者收到信息的时间戳,并记录设置的延时发送参数,根据所述时间戳和所述延时发送参数计算所述主动节点与响应节点的距离。
根据本发明第二方面的系统,所述第三处理模块103具体被配置为,所述记录所述测距过程的数据包括:
测距过程计算数据和所述延时发送参数。
所述测距过程计算数据包括:
所述主动节点与响应节点之间的电磁波的飞行时间tof;
前次飞行时间tof_to_Initiator,所述前次飞行时间tof_to_Initiator为,所述监听节点前次作为响应节点时,应用双边双向测距方法计算出的所述监听节点与所述主动节点之间的飞行时间。
所述延时发送参数包括:
所述响应节点发送resp帧设置的第一延时时间D1;
所述主动节点发送final帧设置的第二延时时间D2;
所述响应节点发送ack帧设置的第三延时时间D3。
记录所述主动节点和响应节点发送的通信帧到达监听节点的时间戳的方法包括:
收到来自所述主动节点发送的poll帧后,记录所述poll帧到达所述监听节点的天线的时间戳,第一时间戳t1;
收到来自所述响应节点发送的resp帧后,记录所述resp帧到达所述监听节点的天线的时间戳,第二时间戳t2;
收到来自所述主动节点发送的final帧后,记录所述final帧到达所述监听节点的天线的时间戳,第三时间戳t3;
收到来自所述响应节点发送的ack帧后,记录所述ack帧到达所述监听节点的天线的时间戳,第四时间戳t4。
根据本发明第二方面的系统,所述第四处理模块104具体被配置为,所述根据所述测距过程的数据和所述主动节点和响应节点发送的通信帧到达监听节点的时间,计算出所述监听节点与所述响应节点之间的距离的具体计算公式为:
Figure 830331DEST_PATH_IMAGE002
其中,
Figure 428803DEST_PATH_IMAGE012
:表示求两时间戳t2与t1之间的时间差;
Figure 180858DEST_PATH_IMAGE016
:表示求两时间戳t3与t2之间的时间差;
Figure 206583DEST_PATH_IMAGE014
:表示求两时间戳t4与t3之间的时间差;
c:表示电磁波在空气中的传播速度。
本发明第三方面公开了一种电子设备。电子设备包括存储器和处理器,存储器存储有计算机程序,处理器执行计算机程序时,实现本发明公开第一方面中任一项的一种网络节点的测距定位方法中的步骤。
图8为根据本发明实施例的一种电子设备的结构图,如图8所示,电子设备包括通过系统总线连接的处理器、存储器、通信接口、显示屏和输入装置。其中,该电子设备的处理器用于提供计算和控制能力。该电子设备的存储器包括非易失性存储介质、内存储器。该非易失性存储介质存储有操作系统和计算机程序。该内存储器为非易失性存储介质中的操作系统和计算机程序的运行提供环境。该电子设备的通信接口用于与外部的终端进行有线或无线方式的通信,无线方式可通过WIFI、运营商网络、近场通信(NFC)或其他技术实现。该电子设备的显示屏可以是液晶显示屏或者电子墨水显示屏,该电子设备的输入装置可以是显示屏上覆盖的触摸层,也可以是电子设备外壳上设置的按键、轨迹球或触控板,还可以是外接的键盘、触控板或鼠标等。
本领域技术人员可以理解,图8中示出的结构,仅仅是与本发明公开的技术方案相关的部分的结构图,并不构成对本申请方案所应用于其上的电子设备的限定,具体的电子设备可以包括比图中所示更多或更少的部件,或者组合某些部件,或者具有不同的部件布置。
本发明第四方面公开了一种计算机可读存储介质。计算机可读存储介质上存储有计算机程序,计算机程序被处理器执行时,实现本发明公开第一方面中任一项的一种网络节点的测距定位方法中的步骤中的步骤。
请注意,以上实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。以上实施例仅表达了本申请的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请构思的前提下,还可以做出若干变形和改进,这些都属于本申请的保护范围。因此,本申请专利的保护范围应以所附权利要求为准。

Claims (10)

1.一种网络节点的测距定位方法,其特征在于,适用于大规模UWB网络节点,所述方法包括:
由网络节点中选择出的主动节点选择其它任一节点,为响应节点,所述主动节点未选择的其它节点,为监听节点;
应用双边双向测距方法,得到所述主动节点与响应节点的距离和测距过程的数据;
所述监听节点监听所述主动节点和响应节点之间的测距过程,记录所述测距过程的数据和所述主动节点和响应节点发送的通信帧到达监听节点的时间戳;
根据所述测距过程的数据和所述主动节点和响应节点发送的通信帧到达监听节点的时间戳,计算出所述监听节点与所述响应节点之间的距离。
2.根据权利要求1所述的一种网络节点的测距定位方法,其特征在于,所述应用双边双向测距方法,得到所述主动节点与响应节点的距离,包括:
所述主动节点与所述响应节点共发生4次通信,分别为poll帧、resp帧、final帧和ack帧,每次通信中,所述主动节点和所述响应节点分别记录自身发出或者收到信息的时间戳,并记录设置的延时发送参数,根据所述时间戳和所述延时发送参数计算所述主动节点与响应节点的距离。
3.根据权利要求2所述的一种网络节点的测距定位方法,其特征在于,记录所述测距过程的数据的步骤中,该数据包括:
测距过程计算数据和所述延时发送参数。
4.根据权利要求3所述的一种网络节点的测距定位方法,其特征在于,所述测距过程计算数据包括:
所述主动节点与响应节点之间的电磁波的飞行时间tof;
前次飞行时间tof_to_Initiator,所述前次飞行时间tof_to_Initiator为,所述监听节点前次作为响应节点时,应用双边双向测距方法计算出的所述监听节点与所述主动节点之间的飞行时间。
5.根据权利要求4所述的一种网络节点的测距定位方法,其特征在于,所述延时发送参数包括:
所述响应节点发送resp帧设置的第一延时时间D1;
所述主动节点发送final帧设置的第二延时时间D2;
所述响应节点发送ack帧设置的第三延时时间D3。
6.根据权利要求5所述的一种网络节点的测距定位方法,其特征在于,记录所述主动节点和响应节点发送的通信帧到达监听节点的时间戳的方法包括:
收到来自所述主动节点发送的poll帧后,记录所述poll帧到达所述监听节点的天线的时间戳,即第一时间戳t1;
收到来自所述响应节点发送的resp帧后,记录所述resp帧到达所述监听节点的天线的时间戳,即第二时间戳t2;
收到来自所述主动节点发送的final帧后,记录所述final帧到达所述监听节点的天线的时间戳,即第三时间戳t3;
收到来自所述响应节点发送的ack帧后,记录所述ack帧到达所述监听节点的天线的时间戳,即第四时间戳t4。
7.根据权利要求6所述的一种网络节点的测距定位方法,其特征在于,所述根据所述测距过程的数据和所述主动节点和响应节点发送的通信帧到达监听节点的时间戳,计算出所述监听节点与所述响应节点之间的距离的具体计算公式为:
Figure 408736DEST_PATH_IMAGE001
其中,
Figure 731264DEST_PATH_IMAGE002
:表示求两时间戳t2与t1之间的时间差;
Figure 124199DEST_PATH_IMAGE003
:表示求两时间戳t3与t2之间的时间差;
Figure 961705DEST_PATH_IMAGE004
:表示求两时间戳t4与t3之间的时间差;
c:表示电磁波在空气中的传播速度;
T1、T2、T3分别表示得到的三次与响应节点之间的飞行时间,
Figure 668761DEST_PATH_IMAGE005
表示监听节点与响应节 点之间的距离计算值。
8.一种网络节点的测距定位方法系统,其特征在于,适用于大规模UWB网络节点,所述系统包括:
第一处理模块,被配置为,由网络节点中选择出的主动节点选择其它任一节点,为响应节点,所述主动节点未选择的其它节点,为监听节点;
第二处理模块,被配置为,应用双边双向测距方法,得到所述主动节点与响应节点的距离和测距过程的数据;
第三处理模块,被配置为,所述监听节点监听所述主动节点和响应节点之间的测距过程,记录所述测距过程的数据和所述主动节点和响应节点发送的通信帧到达监听节点的时间戳;
第四处理模块,被配置为,根据所述测距过程的数据和所述主动节点和响应节点发送的通信帧到达监听节点的时间戳,计算出所述监听节点与所述响应节点之间的距离。
9.一种电子设备,其特征在于,所述电子设备包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时,实现权利要求1至7中任一项所述的网络节点的测距定位方法中的步骤。
10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时,实现权利要求1至7中任一项所述的网络节点的测距定位方法中的步骤。
CN202111427576.2A 2021-11-29 2021-11-29 网络节点的测距定位方法、系统、电子设备及存储介质 Active CN113848543B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111427576.2A CN113848543B (zh) 2021-11-29 2021-11-29 网络节点的测距定位方法、系统、电子设备及存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111427576.2A CN113848543B (zh) 2021-11-29 2021-11-29 网络节点的测距定位方法、系统、电子设备及存储介质

Publications (2)

Publication Number Publication Date
CN113848543A CN113848543A (zh) 2021-12-28
CN113848543B true CN113848543B (zh) 2022-03-18

Family

ID=78982213

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111427576.2A Active CN113848543B (zh) 2021-11-29 2021-11-29 网络节点的测距定位方法、系统、电子设备及存储介质

Country Status (1)

Country Link
CN (1) CN113848543B (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114265049B (zh) * 2022-03-02 2022-06-14 华南理工大学 一种基于uwb的实时测距方法、网络结构及网络节点
CN114531651B (zh) * 2022-04-24 2022-08-16 华南理工大学 一种基于uwb技术的多智能体无线网络动态组网方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111262755A (zh) * 2020-01-17 2020-06-09 清华大学 一种网络测距方法及装置
CN112887906A (zh) * 2021-02-01 2021-06-01 清华大学 一种无线网络联合定位方法及系统
CN113009461A (zh) * 2021-05-26 2021-06-22 杭州优智联科技有限公司 基于uwb的改进的单边双向测距方法、设备、系统及介质
CN113167879A (zh) * 2018-12-05 2021-07-23 三星电子株式会社 多个设备中单侧/双侧双向测距的优化传输
CN113272674A (zh) * 2019-01-11 2021-08-17 高通股份有限公司 具有监听节点的基于往返时间(rtt)的定位

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113093101A (zh) * 2021-03-10 2021-07-09 Oppo广东移动通信有限公司 一种测距方法及装置、设备、存储介质

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113167879A (zh) * 2018-12-05 2021-07-23 三星电子株式会社 多个设备中单侧/双侧双向测距的优化传输
CN113272674A (zh) * 2019-01-11 2021-08-17 高通股份有限公司 具有监听节点的基于往返时间(rtt)的定位
CN111262755A (zh) * 2020-01-17 2020-06-09 清华大学 一种网络测距方法及装置
CN112887906A (zh) * 2021-02-01 2021-06-01 清华大学 一种无线网络联合定位方法及系统
CN113009461A (zh) * 2021-05-26 2021-06-22 杭州优智联科技有限公司 基于uwb的改进的单边双向测距方法、设备、系统及介质

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
基于AOA降维和同心圆定位的三维传感器网络节点自定位方法;蒋鹏等;《传感技术学报》;20120731;第25卷(第7期);第999-1006页 *
无线传感器网络的RSSI定位技术研究;戴立伟等;《计算机工程与设计》;20091231;第30卷(第19期);第4395-4397页 *

Also Published As

Publication number Publication date
CN113848543A (zh) 2021-12-28

Similar Documents

Publication Publication Date Title
CN113848543B (zh) 网络节点的测距定位方法、系统、电子设备及存储介质
US20200205115A1 (en) Wireless positioning method and system using the same
US11917571B2 (en) Locating method for uplink time difference of arrival, and apparatus thereof
US10595241B2 (en) Access and handover method, network side device and mobile terminal
CN111193997B (zh) 一种uwb定位系统的到达时间差测量与校准方法
CN101951300B (zh) 一种实现以太网精确对时的方法
CN109152005A (zh) 一种上行波束指示方法、ue、基站及存储介质
US20230309042A1 (en) Method and apparatus for correcting transmitting channel delay, and storage medium
WO2022000354A1 (zh) 用于测距的方法和终端设备
CN113655437A (zh) 测距方法、测距装置和存储介质
WO2021046820A1 (zh) 一种测量上报方法及装置
US8289963B2 (en) Process and system for calculating distances between wireless nodes
CN104113849A (zh) 传播模型的校正方法
CN103024822B (zh) 一种节点协同方法及装置
CN104394587A (zh) 基于无线动态自组织网络的群组测距方法
CN113747338B (zh) 一种信息上报方法、装置、设备及可读存储介质
WO2024066569A1 (zh) 定位方法及终端
WO2018035740A1 (zh) 一种基于时间测量的定位方法、相关设备及系统
WO2018112693A1 (zh) 终端定位的方法和装置
WO2021227644A1 (zh) 信息发送、接收方法、装置及设备
JP7478258B2 (ja) 時間決定方法、装置、端末及びネットワーク機器
US20210265998A1 (en) Electronic device and electronic product
CN110691407A (zh) 处理测量报文的方法和设备
CN112866897A (zh) 一种定位测量方法、终端和网络节点
CN113759180B (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