一种大范围复杂室内环境中精确定位的方法

本发明属于室内定位技术领域，具体为一种大范围复杂室内环境中精确定位的方法。

背景技术：

随着我国经济的发展，物联网技术的进步，人们面临的环境越来越复杂、室内空间越来越庞大、出行方式越来越多样化。这就意味着基于位置的服务深入到生活的方方面面，有着极大的市场与机遇。现有的基于bluetooth，wifi、红外线、惯导、地磁等室内定位技术，定位精度不是很高。而超宽带(uwb)定位技术，采用无载波通信，利用超窄脉冲的方式发送数据，具有很高的传输速率、多径分辨率、时间分辨率和定位精度，利用其独特的通信机制和特点，可为室内位置服务提供很好的解决方案，实现更精确的定位。

基于tdoa的uwb定位方法中，时钟同步是与定位技术的准确性直接相关的关键因素。在绝对时间同步方案中指出，时钟同步既要做到脉冲的同步，也要实现频率的一致。为无线传感器网络领域开发的现有时间同步协议有两种，分别为文献“elsonj.fine-grainednetworktimesynchronizationusingreferencebroadcasts[j].acmsigopsoperatingsystemsreview,2002,36.”提出的参考广播同步(rbs)算法和文献“ganeriwawal,s.&kumar,r.&srivastava,m..(2003).timing-syncprotocolforsensornetworks.hefirstacmconferenceonembeddednetworkedsensorsystems(sensys).138-149”提出的传感器网络定时同步协议(tpsn)。在rbs中，参考消息被广播，接收机在接收参考广播时记录其本地时间，并相互交换记录的时间。rbs的主要优点是它消除了发送方不确定性。该方法的缺点在于，需要额外的消息交换来在节点之间传递本地时间戳。该算法尚未扩展到大型多跳网络。tpsn算法首先创建网络的生成树，然后沿边缘执行成对同步。每个节点通过与层次结构中较高一级的时钟参考节点交换两个同步消息来进行同步。tpsn可以实现比rbs好两倍的性能。tpsn的缺点是它不估计节点的时钟漂移，这限制了它的准确性，并且不处理动态拓扑变化。

技术实现要素：

本发明的目的是，在基于uwb的大规模无线网络的定位系统中，用tpsn算法创建网络的生成树进行全局网络时钟同步，然后对每个定位基站的累积时钟误差进行校正，从而提高定位的准确性，实现高精度的定位。如图1所示，通过构建分层结构(生成树)可以直接扩展到网络范围的时钟同步，并在相邻级之间执行成对的同步。如图2所示，使用校正方法进行时钟累积误差的校正，在传统tdoa定位方法基础上，增加一个已知自身实际位置坐标的参考点，该参考点可以是定位基站也可以是标签。参考点与待定位标签都可以通过发送定位信息进行定位。在各定位基站得到参考点和待定位标签发送的定位信息后，通过tdoa算法(如chan算法、fang算法等)即可解得目标位置。

本发明的技术方案是：首先用tpsn算法创建网络的时钟生成树进行全局网络时钟同步；然后对同步时钟的累积误差进行分析，通过引入校正方法，在收到待定位标签发送的定位信息时，先对参考点进行定位测量，然后对参考点的真实位置进行处理得到定位基站的累积时钟误差校正值，再对待定位标签用修正补偿后的定位基站数据进行定位，包括以下步骤(参考点设为定位基站)：

s1、将定位基站按照其规定的通信距离进行布置，将室内环境完全覆盖，且保证该环境下任意位置能收到待定位标签信息的基站数量不少于4个。然后用tpsn规划实现基站的全局网络时钟的同步。

进一步地，步骤s1实现基站的全局网络的时钟的同步的具体步骤为：

s11、构建时钟模型，如图3所示。网络中的每个基站都有自己的时钟，理想情况下，基站的时钟应配置为c(t)＝t，t代表理想或参考时间，但是由于时钟振荡器的不完善，即使时钟偏移最初已经完美调整，它也将偏离理想时间。通常，将第i个基站的时钟函数建模为

ci(t)＝θi+fi·t

其中参数θi和fi分别称为时钟偏移(相位差)和时钟偏斜(频率比值)。t为参考时间。

s12、每对基站时钟同步方式与数据测量。对于任意两个基站a1与a2，因为a1与a2的晶振频率不完全相同，所以我们假设a1的计数时钟频率为a2的计数时钟频率为在相同时间内(在此选为一个同步周期t)，独立测量基站a1与a2的计时时长，分别为和可以得到时钟频率的比值(即时钟偏斜)，如公式：

以如图4为例分析任意时刻定位信息的到达时间表达式。在实现两个基站的时钟同步时，基站a1在时刻发送第一帧同步帧，经过时间(包含基站a1的延时发送时间、基站a1到基站a2之间的无线信号传播时间、基站a2的延时接收时间，布置基站时就已确定，用dw1000的延时发送技术实现)后，基站a2接收到同步帧消息，接收到的时刻为经过时钟同步周期t后，重复进行该过程。对于第n次时钟同步，将作为每次同步后a2基站计时起始时刻，此时基站a1与a2的时钟偏移此时，我们得到了两个基站时钟的时钟偏移和时钟偏斜，由此可以将全局网络中所有的基站的时间相对于同一时钟参考基站的时间进行时钟同步。

基站a1在时刻发送同步帧，经过时间后，从基站a2接收到同步帧消息，接收到的时刻为且作为每次同步后a2基站计时起始时刻。基站a1在时刻，基站a2在(a2的本地时间)时刻收到来自定位标签的定位帧消息，则以基站a1时间为参考，表示如公式：

其中，和分别是第n次同步a1和a2的时间；是a2第n次时钟同步后至收到定位点的定位帧消息的时长，且有

s13、实现全局域网络时钟同步，关键在于实现同步时钟树的构建，并减少该过程中同步时钟误差的积累。以如图5所示基站布置为例分析同步时钟误差的积累。全局网络时钟同步基站分为主(根)基站、中继基站、从基站。主(根)基站为提供全局时钟标准时间的基站；中继基站有两个作用，一是接收上级基站的时钟同步信息，二是向下一级基站发送时钟同步信息；从基站是只接收上级基站时钟同步信息的基站。全局域网络中任意两基站之间的时钟同步方式与上文s1-2同步方式相同。要注意全局域网络时钟同步中的所有基站都是相对同一时钟参考基站进行同步，即任意基站(非时钟参考基站)的时钟模型中时钟偏斜都是相对该时钟参考基站进行测量，而时钟偏移量是同步路径上所有时钟偏移的和。

当标签在如图5中位置时，以图中的a1和a2、a1和a3、a2和b1、a2和b2进行时钟同步为例分析定位信息的到达时刻表达式。

对于a2和a3，其实现时钟同步过程与图4相同，定位信息的到达时刻表达式分别表示为：

a2和b1、a2和b2时钟同步过程相似，以a1→a2→b1同步为例，其过程如图6所示。对于b1和b2，定位信息的到达时刻表达式分别表示为：

tdoa技术使用的是时间差，一般取定位信息到达时间最小的基站为定位参考基准做为被减数得时间差，此处取为有时间差：

由(2)、(3)、(4)、(5)式可知随着时钟同步的分级进行，各基站的tof值也是从主基站到最后一级基站的累计量。

对于时间差，由(6)、(7)、(8)式可知其tof累积量与同步路径相关。对于主基站为m、参与定位的两个基站a和b，可以得到推广公式：

其中ca(t)和cb(t)分别表示定位信息的到达时刻；tof累积量为tofab＝tofmb-tofma，tofmb和tofma分别为由主基站m到两个定位基站a和b的tof累计量；fmb和fma分别为主基站与两个定位基站a和b的时钟偏斜。和分别为两个定位基站a和b，在其第n个时钟周期的计时时间转化为主基站m第n个时钟周期的时间对应的值。

对于公式(9)，全局网络时钟同步误差来源为：晶振计时误差ε△t；时钟偏斜的误差εf；时钟同步飞行时间测量累计的误差∑εtof。

对于晶振计时误差ε△t，是定位信息到达基站时刻相对上一次同步时刻变化量测量值△t'的误差，包含有真值△t，可变误差ε△t，即△t'＝△t+ε△t。全局网络时钟同步时，会有上级同步但下级没同步时，定位帧消息到达的情况。而考虑到uwb定位基站的传输距离取为30～300m。所以时钟同步路径传播时间最大为：tmax＝300m/c≈1000ns。其中c为光速。同时，对于一个同步帧的信息，基站信息处理时间是十几微秒级。在一个时钟同步周期(t＝0.1s)内，时钟同步花费的时间(信息处理时间与时钟同步路径传播时间的和)可以忽略，即将问题简化为定位帧消息在不同基站的同一个同步时钟周期内接收。市场上的uwb定位芯片计时误差在1s内时间稳定性在10ps以内，即在一个时钟同步周期内，ε△t≤1ps。时钟偏斜与使用芯片的频率稳定度密切相关。使用两个0.5ppm的dw1000芯片，表示为a和b，测量其时钟偏斜fab随时间的变化情况，得到时钟偏斜的误差εf在10^-8量级。晶振计时误差与时钟偏斜的误差可以表示为：

(△t+ε△t)×(f+εf)＝△t×f+△t×εf+ε△t×f+ε△t×εf(10)

其中△t×εf、ε△t×f、ε△t×εf为产生误差的项。△t最大为0.1s，对应的△t×εf最大误差为十厘米级；ε△t×f和ε△t×εf都小于10^-12s，在此可以忽略。

对于时钟同步飞行时间测量累计的误差∑εtof，使用对称双边双程测距的每一项tof的误差εtof可以控制在厘米级，时钟同步飞行时间测量累计的误差∑εtof会随着同步级数的增加而累加，能达到几十厘米的量级。所以在进行定位前，需要对参与定位的基站的累积误差进行校正，才能实现高精度的定位。

s2、使用chan算法进行定位，并对同步累积误差进行校正。对一个待定位标签进行定位前，先对能收到该待定位标签信息的n个定位基站进行时钟误差的校正。在所有接收到定位信息的基站中，各基站位置已提前知道，我们选择接收定位信息最早的基站为定位参考基准。我们让该定位参考基准发送校正信息，其余n-1个参与定位的基站接收信息后，通过tdoa算法求解出定位参考基准坐标，然后与定位参考基准的准确位置坐标进行差分，形成校正信息。

进一步地，s2解算校正信息的具体步骤为：

s21、定位参考基准发送校正信息，如果定位参考基准的实际位置坐标是(x1,y1)，可以计算出定位参考基准到第i个定位基站的真实距离：

其中，(xi,yi)是第i个定位基站的坐标，且i＝2,3,…,n。

s22、假设通过tdoa算法得到了定位参考基准的定位坐标是可以求得定位参考基准与第i个定位基站之间的伪距：

s23、由于存在时钟同步误差累积量，即di≠di。假设△di是第i个定位基站在定位过程中的时钟同步误差累积量的等效测距误差，则校正信息为：

△di＝di-di,i＝2,3,…,n(11)

s3、一般情况下，在全网时钟同步过程中，由基站间时钟同步过程引起的时钟同步累积误差远大于系统的测量噪声引起的误差，定位精度受其影响会严重降低。然而，在定位过程中，对待定位标签和定位参考基准而言，每个基站的△di均相同。

s31、对于待定位标签(x,y)，其与第i个定位基站的伪距可表示为：

s32、对于待定位标签(x,y)，其与第i个定位基站的修正后的真实距离可表示为：

s33、以第2个基站为定位参考基站，用校正信息校正定位点的伪定位坐标，最终形成更精确的tdoa算法双曲线方程：

s4、采用校正后的双曲线方程，通过tdoa算法即可解算出更加准确的定位结果。

本发明的有益效果是：实现了在基于uwb的大规模无线网络的定位系统中对时钟同步累积误差的校正，然后实现高精度的定位。通过在相邻级之间执行成对的同步从而构建生成树，进一步实现网络范围的时钟同步；然后引入校正方法进行时钟累积误差的校正，有效降低全局网络时钟同步引入的时间误差，从而实现大范围的定位系统的高精度定位。因此本发明提出了一种在大规模全局网络时钟同步时进行时钟累积误差校正并实现高精度定位的方法。

附图说明

图1为定位基站时钟的分层同步示意图；

图2为时钟误差校正定位方法示意图；

图3为时钟模型示意图；

图4为时钟同步与定位信息时间示意图；

图5为全网同步基站布置图；

图6为a1→a2→b1时钟同步与定位信息时间示意图；

图7为仿真全局网络时钟同步实现结果图；

图8为使用chan算法定位结果与本发明方法定位结果的均方根误差；

图9为使用chan算法定位结果与本发明方法定位累计误差百分比图。

具体实施方式

下面结合附图及实施例，详细描述本发明的技术方案：

步骤1、将定位基站按照其规定的通信距离进行布置，将室内环境完全覆盖，且保证该环境下任意位置能收到待定位标签信息的基站数量不少于4个。然后用tpsn规划实现基站的全局网络时钟的同步。

进一步地，步骤1实现基站的全局网络的时钟的同步的具体步骤为：

步骤11、构建时钟模型。网络中的每个基站都有自己的时钟，理想情况下，基站的时钟应配置为c(t)＝t，代表理想或参考时间，但是由于时钟振荡器的不完善，即使时钟偏移最初已经完美调整，它也将偏离理想时间。通常，将第i个基站的时钟函数建模为

ci(t)＝θi+fi·t

其中参数θi和fi分别称为时钟偏移(相位差)和时钟偏斜(频率比值)。t为参考时间。

步骤12、全局域网络时钟同步中的所有基站都是相对同一时钟参考基站进行同步，即任意基站(非时钟参考基站)的时钟模型中时钟偏斜都是相对该时钟参考基站进行测量，而时钟偏移量是同步路径上所有时钟偏移的和。对于时钟参考基站(即主基站)m与任意基站a，因为m和a的晶振频率不完全相同，所以我们假设m的计数时钟频率为fm，a的计数时钟频率为fa。在相同时间内(在此选为一个同步周期t)，独立测量基站m和a的计时时长分别为△tm和△ta，可以得到时钟频率的比值fma(即时钟偏斜)，如公式：

fma＝△ta/△tm＝fa/fm

时钟偏移θma＝tofma与同步路径相关。

步骤13、实现全局域网络时钟同步，关键在于实现同步时钟树的构建，并减少该过程中同步时钟误差的积累。全局网络时钟同步基站分为主(根)基站、中继基站、从基站。主(根)基站为提供全局时钟标准时间的基站；中继基站有两个作用，一是接收上级基站的时钟同步信息，二是向下一级基站发送时钟同步信息；从基站是只接收上级基站时钟同步信息的基站。全局域网络中任意两基站之间的时钟同步方式与上文步骤1-2同步方式相同。具体实现时按照每一级中继基站选择最少；每个中继基站同步下一级基站个数最多来进行时钟同步。

步骤2、使用chan算法进行定位，并对同步累积误差进行校正。对一个待定位标签进行定位前，先对能收到该待定位标签信息的n个定位基站进行时钟误差的校正。在所有接收到定位信息的基站中，各基站位置已提前知道，我们选择接收定位信息最早的基站为定位参考基准。我们让该定位参考基准发送校正信息，其余n-1个参与定位的基站接收信息后，通过tdoa算法求解出定位参考基准坐标，然后与定位参考基准的准确位置坐标进行差分，形成校正信息。

进一步地，步骤2解算校正信息的具体步骤为：

步骤21、定位参考基准发送校正信息，如果定位参考基准的实际位置坐标是(x1,y1)，可以计算出定位参考基准到第i个定位基站的真实距离：

其中，(xi,yi)是第i个定位基站的坐标，且i＝2,3,/,n。

步骤22、如果用tdoa算法求出的定位参考基准的坐标是可以通过下式求得定位参考基准与第i个定位基站之间的伪距：

步骤23、由于存在时钟同步误差累积量，即di≠di。以△di代表第i个定位基站在定位过程中的时钟同步误差累积量的等效测距误差，则校正信息为：

△di＝di-di,i＝2,3,…,n(15)

步骤3、一般情况下，在全网时钟同步过程中，由基站间时钟同步过程引起的时钟同步累积误差远大于系统的测量噪声引起的误差，定位精度受其影响会严重降低。然而，在定位过程中，对待定位标签和定位参考基准而言，每个基站的△di均相同。

步骤31、对于待定位标签(x,y)，其与第i个定位基站的伪距可表示为：

步骤32、对于待定位标签(x,y)，其与第i个定位基站的修正后的真实距离可表示为：

步骤33、以第2个基站为定位定位参考基站，用校正信息校正定位点的伪定位坐标，最终形成更精确的tdoa算法双曲线方程：

步骤4、采用校正后的双曲线方程，通过tdoa算法即可解算出更加准确的定位结果。

实施例

以此模型在matlab用仿真数据进行实验，仿真的全局网络时钟为10层，基站之间距离设置为100m，基站的通信距离为待定位标签的通信范围为然后对基站进行全局网络时钟同步，时钟同步路径规划和实现效果如图7所示。用10000点的蒙特卡洛实验进行仿真计算定位结果，以chan算法求解定位结果。比较在不使用误差校正方法和使用误差校正方法两种情况下的定位结果。实验中影响较大的因素为信道噪声和每级同步误差，因此设置在这两种因素不同时，比较定位精度的变化，验证模型效果。

本发明设计了两组实验来验证提出算法的优越性。

第一组实验是对比在信道噪声相同情况下，随着每一级同步误差的标准差增大，不使用误差校正方法的chan算法定位结果与本发明方法定位结果的均方根误差，如图8所示。可以看到，随着每一级同步误差的标准差增大，本发明的定位误差比不使用误差校正方法的背景chan方法的定位误差最大降低70％。

第二组实验是对比在信道噪声不相同情况下，使用chan算法定位结果与本发明方法定位结果的均方根误差，结果如表1所示：

表1在测量信道噪声不相同情况下，使用chan算法定位结果与本发明方法定位结果的均方根误差，以及对应的本发明方法精度提升比例

可以看到本发明方法在不同的信道噪声下：在每级同步误差标准差大于信道噪声时，定位误差优化较大，定位精度提升较多，最高可提升74％；在每级同步误差标准差接近信道噪声时，定位误差优化比例为37％间；在每级同步误差标准差小于信道噪声时，定位误差优化比例小于35％。以表中信道噪声-12db时数据做定位累计误差百分比图，对应于74％的定位精度优化占比，如图5所示。在仅存在信道噪声因素影响的情况下，图9中90％样本误差在1m以内，80％数据在0.5m以内，明显优于不使用误差校正方法的chan算法。

两组实验的结果证明，本发明通过在tdoa定位前加入一个校正过程，可以有效降低全局网络时钟同步引入的时间误差，从而提高定位的精度。在每级同步误差较大(大于信道噪声的测量误差)时，增加了对定位基站的时钟同步累积误差校正过程，可以有效降低全网同步过程累积误差对定位结果的影响，提高定位精度，最高提升约74％。