混合视距和非视距环境中基于到达时间的目标定位方法与流程

本发明涉及一种目标定位方法，尤其是涉及一种混合视距和非视距环境中基于到达时间的目标定位方法。

背景技术：

近年来，无线传感器网络中的目标定位技术在导航、通信和目标跟踪等领域中已得到了广泛应用。随着技术的发展与社会的进步，高精度的目标定位技术在各个领域展现出了广泛的应用前景。因此，对无线传感器网络中高精度的目标定位方法的研究十分有必要。

根据接收信号的特征参数和应用环境的不同，人们提出了各种目标定位方法，分别有到达时间(toa)、到达时间差(tdoa)、到达角度(aoa)、接收信号强度(rss)以及各种定位技术的混合定位等方法。这些传统的目标定位方法一般是假设信号源与传感器之间的传播是视距(los)传播，且视距链路分布已知，然而在复杂的城市或室内等恶劣的环境中常存在障碍物的阻碍，直接使用这些目标定位方法会导致定位精度非常低。因此，需要寻找一种适用于视距(los)和非视距(nlos)环境的高性能目标定位方法。

为了解决上述问题，人们提出了多种适用于视距(los)和非视距(nlos)环境的目标定位方法。如：zhangs提出了一种鲁棒二阶锥松弛(socp)方法，该方法对非视距误差不敏感，需要知道非视距误差的上限。又如：tomics通过将定位问题转换为广义信任区域子问题(gtrs)框架，虽然问题仍然是非凸的，但是通过二分法可以解决这类问题，具有较低的复杂度。上述两种定位方法的复杂度都有一定程度的降低，但定位性能有较大损失。

技术实现要素：

本发明所要解决的技术问题是提供一种混合视距和非视距环境中基于到达时间的目标定位方法，其定位精度高。

本发明解决上述技术问题所采用的技术方案为：一种混合视距和非视距环境中基于到达时间的目标定位方法，其特征在于包括以下步骤：

步骤一：设定无线传感器网络中存在一个未知的目标节点和n个已知的锚节点，并设定无线传感器网络中的视距链路和非视距链路的分布情况已知；为无线传感器网络建立一个平面坐标系作为参考坐标系，将目标节点在参考坐标系中的坐标位置记为x，将第i个锚节点在参考坐标系中的坐标位置记为si；其中，n为正整数，n≥3，i为正整数，i的初始值为1，1≤i≤n；

步骤二：令ωlos表示无线传感器网络中的所有视距链路对应的锚节点的序号构成的集合，令ωnlos表示无线传感器网络中的所有非视距链路对应的锚节点的序号构成的集合；然后建立目标节点与每个锚节点之间的距离测量模型，如果目标节点与第i个锚节点之间为视距传播，即目标节点与第i个锚节点之间的链路为视距链路，则i∈ωlos，将目标节点与第i个锚节点之间的距离测量模型描述为：di＝||x-si||+ni；如果目标节点与第i个锚节点之间为非视距传播，即目标节点与第i个锚节点之间的链路为非视距链路，则i∈ωnlos，将目标节点与第i个锚节点之间的距离测量模型描述为：di＝||x-si||+bi+ni；其中，di表示目标节点与第i个锚节点之间的距离测量值，符号“||||”为范数符号，||x-si||表示目标节点与第i个锚节点之间的真实距离，ni表示服从均值为0且方差为σi²的高斯分布的测量噪声，bi表示目标节点与第i个锚节点之间的非视距链路中的非视距偏差，bi在[0,ρ]范围内服从均匀分布，ρ表示无线传感器网络中的非视距链路中的非视距误差最大值，在di＝||x-si||+bi+ni中bi＞＞ni且bi≤ρ；

步骤三：对针对i∈ωlos时的等式di＝||x-si||+ni两边进行平方，得到并对针对i∈ωnlos时的等式di＝||x-si||+bi+ni两边进行平方，得到然后将针对i∈ωlos时的中的高阶项舍去，整理后得到ni的近似表达式为同样将针对i∈ωnlos时的中的高阶项舍去，整理后得到ni的近似表达式为再根据针对i∈ωlos时的和针对i∈ωnlos时的并采用最坏情况下的鲁棒最小二乘方法，得到最小化问题，描述为：其中，min()为最小值函数，max()为最大值函数；

步骤四：针对i∈ωnlos时令f(bi)在[0,ρ]范围内单调递减；然后将转化为接着将转化为max(|f(0)|,|f(ρ)|)，进而将转化为目标函数，描述为：其中，f(bi)为引入的中间变量，符号“||”为取绝对值符号，f(0)表示取bi＝0时f(bi)的值，f(ρ)表示取bi＝ρ时f(bi)的值，

步骤五：在目标函数中引入辅助变量t，将目标函数转化为然后在中引入辅助变量h和r，并令h中的第i个元素hi＝||x-si||²，r中的第i个元素ri＝||x-si||，将转化为非凸问题，描述为：接着利用凸松弛技术对非凸问题中的约束条件hi＝||x-si||²进行松弛，对应得到其中进而将非凸问题转化为其中，ti表示t中的第i个元素，“s.t.”表示“受约束于……”，为的转置，i2表示维数为2×2的单位矩阵，z为常数变量；

步骤六：在中引入一组权值ω，转化为针对i∈ωnlos时根据di＝||x-si||+bi+ni、bi＞＞ni，且bi为正，得到然后根据hi＝||x-si||²和得到针对i∈ωlos时根据di＝||x-si||+ni，得到在ni＞0时成立，而在ni＜0时不成立；再在中引入惩罚项u，u中的第i个元素ui≥0，得到并根据和ui≥0，得到进而得到凸优化问题，描述为：其中，ωi表示ω中的第i个元素，

步骤七：对凸优化问题进行求解，得到x的值。

所述的步骤七中，使用cvx工具箱对凸优化问题进行求解。

与现有技术相比，本发明的优点在于：

1)本发明方法根据混合视距和非视距环境中的距离测量模型，采用最坏情况下的鲁棒最小二乘方法建立一个最小化的定位问题，并将这个非凸的定位问题转化为凸的定位问题即凸优化问题，而凸的定位问题易于求解。

2)本发明方法根据混合视距和非视距环境中视距链路和非视距链路的分布情况，在非凸问题中引入一组权值，降低了非视距链路对目标定位结果的影响，从而提高了目标定位精度。

3)本发明方法的凸优化问题中引入有惩罚项，使得目标函数更逼近原非凸定位问题，提高了目标定位精度。

附图说明

图1为本发明方法的总体实现框图；

图2为在非视距链路有4条的情况下，本发明方法、现有的鲁棒加权最小二乘(r-wls)方法、现有的鲁棒二阶锥(r-socp)方法的rmse随噪声标准差的变化曲线；

图3为在噪声标准差为0.6米的情况下，本发明方法、现有的鲁棒加权最小二乘(r-wls)方法、现有的鲁棒二阶锥(r-socp)方法的rmse随非视距(nlos)链路数量的变化曲线；

图4为在非视距链路有4条且噪声标准差为0.6米的情况下，本发明方法、现有的鲁棒加权最小二乘(r-wls)方法、现有的鲁棒二阶锥(r-socp)方法的累计分布函数(cdf)随估计误差的变化曲线。

具体实施方式

以下结合附图实施例对本发明作进一步详细描述。

本发明提出的一种混合视距和非视距环境中基于到达时间的目标定位方法，其总体实现框图如图1所示，其包括以下步骤：

步骤一：设定无线传感器网络中存在一个未知的目标节点和n个已知的锚节点，并设定无线传感器网络中的视距链路和非视距链路的分布情况已知；为无线传感器网络建立一个平面坐标系作为参考坐标系，将目标节点在参考坐标系中的坐标位置记为x，将第i个锚节点在参考坐标系中的坐标位置记为si；其中，n为正整数，n≥3，在本实施例中取n＝8，i为正整数，i的初始值为1，1≤i≤n。

步骤二：令ωlos表示无线传感器网络中的所有视距链路对应的锚节点的序号构成的集合，令ωnlos表示无线传感器网络中的所有非视距链路对应的锚节点的序号构成的集合；然后建立目标节点与每个锚节点之间的距离测量模型，如果目标节点与第i个锚节点之间为视距传播，即目标节点与第i个锚节点之间的链路为视距链路，则i∈ωlos，将目标节点与第i个锚节点之间的距离测量模型描述为：di＝||x-si||+ni；如果目标节点与第i个锚节点之间为非视距传播，即目标节点与第i个锚节点之间的链路为非视距链路，则i∈ωnlos，将目标节点与第i个锚节点之间的距离测量模型描述为：di＝||x-si||+bi+ni；其中，di表示目标节点与第i个锚节点之间的距离测量值，di已知，符号“||||”为范数符号，||x-si||表示目标节点与第i个锚节点之间的真实距离，ni表示服从均值为0且方差为σi²的高斯分布的测量噪声，bi表示目标节点与第i个锚节点之间的非视距链路中的非视距偏差，bi在[0,ρ]范围内服从均匀分布，ρ表示无线传感器网络中的非视距链路中的非视距误差最大值，ρ一般根据具体的无线传感器网络进行设定，如将ρ设定为5米，在di＝||x-si||+bi+ni中bi＞＞ni且bi≤ρ。

步骤三：对针对i∈ωlos时的等式di＝||x-si||+ni两边进行平方，得到并对针对i∈ωnlos时的等式di＝||x-si||+bi+ni两边进行平方，得到由于高阶项比较小，因此然后将针对i∈ωlos时的中的高阶项舍去，整理后得到ni的近似表达式为同样由于高阶项比较小，因此将针对i∈ωnlos时的中的高阶项舍去，整理后得到ni的近似表达式为再根据针对i∈ωlos时的和针对i∈ωnlos时的并采用最坏情况下的鲁棒最小二乘方法，得到最小化问题，描述为：其中，min()为最小值函数，max()为最大值函数。

步骤四：针对i∈ωnlos时令f(bi)在[0,ρ]范围内单调递减；然后将转化为由于f(bi)在[0,ρ]范围内单调递减，因此接着将转化为max(|f(0)|,|f(ρ)|)，进而将转化为目标函数，描述为：其中，f(bi)为引入的中间变量，符号“||”为取绝对值符号，f(0)表示取bi＝0时f(bi)的值，f(ρ)表示取bi＝ρ时f(bi)的值，

步骤五：为了将目标函数变为标准形式，在目标函数中引入辅助变量t，将目标函数转化为然后在中引入辅助变量h和r，并令h中的第i个元素hi＝||x-si||²，r中的第i个元素ri＝||x-si||，将转化为非凸问题，描述为：接着利用凸松弛技术对非凸问题中的约束条件hi＝||x-si||²进行松弛，对应得到其中进而将非凸问题转化为其中，ti表示t中的第i个元素，“s.t.”表示“受约束于……”，为的转置，i2表示维数为2×2的单位矩阵，z为常数变量。

步骤六：由于在无线传感器网络中的n条链路中存在视距链路和非视距链路，因此为了减小非视距链路对目标定位结果的影响，在中引入一组权值ω，转化为针对i∈ωnlos时根据di＝||x-si||+bi+ni、bi＞＞ni，且bi为正，得到然后根据hi＝||x-si||²和得到针对i∈ωlos时根据di＝||x-si||+ni，得到在ni＞0时成立，而在ni＜0时不成立；再在中引入惩罚项u，u中的第i个元素ui≥0，得到并根据和ui≥0，得到进而得到凸优化问题，描述为：其中，ωi表示ω中的第i个元素，

步骤七：使用cvx工具箱对凸优化问题进行求解，得到x的值。

为了验证本发明方法的可行性和有效性，通过蒙特卡洛仿真实验来比较本发明方法和其它定位算法的性能。

当目标节点与第i个锚节点之间为视距传播时，目标节点与第i个锚节点之间的距离测量模型为di＝||x-si||+ni；当目标节点与第i个锚节点之间为非视距传播时，目标节点与第i个锚节点之间的距离测量模型为di＝||x-si||+bi+ni，利用di＝||x-si||+ni和di＝||x-si||+bi+ni用于生成测量距离。假设锚节点和目标节点随机分布于20米×20米正方形区域内。锚节点数量n＝8，锚节点和目标节点的测量噪声为ni，无线传感器网络中的非视距链路中的非视距误差最大值ρ设定为5米。在此以均方根误差(rmse)来评估定位方法的性能，其定义为：其中，mc表示蒙特卡洛运行次数，mc＝10000，k的初始值为1，1≤k≤mc，表示第k次蒙特卡洛仿真中目标节点在参考坐标系中的估计位置，xk表示第k次蒙特卡洛仿真中目标节点在参考坐标系中的真实位置。

图2给出了在非视距链路有4条的情况下，本发明方法、现有的鲁棒加权最小二乘(r-wls)方法、现有的鲁棒二阶锥(r-socp)方法的rmse随噪声标准差的变化曲线。从图2中可以看出，所有定位方法中，rmse都随着噪声标准差的增大而增大，而本发明方法在噪声标准差较小时性能明显更好。

图3给出了在噪声标准差为0.6米的情况下，本发明方法、现有的鲁棒加权最小二乘(r-wls)方法、现有的鲁棒二阶锥(r-socp)方法的rmse随非视距(nlos)链路数量的变化曲线。从图3中可以看出，随着非视距链路数量的增多，本发明方法和鲁棒二阶锥(r-socp)方法的rmse随之增大，而鲁棒加权最小二乘(r-wls)方法的rmse随之减小；在非视距链路数量较少时，本发明方法的定位性能明显较好。

图4给出了在非视距链路有4条且噪声标准差为0.6米的情况下，本发明方法、现有的鲁棒加权最小二乘(r-wls)方法、现有的鲁棒二阶锥(r-socp)方法的累计分布函数(cdf)随估计误差的变化曲线。从图4中可以看出，在累计分布函数到达90％时，鲁棒加权最小二乘(r-wls)方法的估计误差为6.52米、鲁棒二阶锥(r-socp)方法的估计误差为13.79米，而本发明方法的估计误差为5.74米，可以看出，在相同条件下，本发明方法的定位性能更好。