[发明专利]一种基于最小误差传播的锚节点优化选择的最小二乘定位方法

说明书

技术领域

本发明涉及高精度的距离估计和定位技术。

背景技术

实际无线通信环境中，由于噪声、环境和测量误差等不良因素的影响，引起通信距离估计具有较大的误差，导致最小二乘定位结果误差较大。针对上述问题，本发明对锚节点冗余定位环境下，评估各个锚节点到未知节点间通信距离估计统计均值及统计标准差的乘积值，并以此来优化选择定位方程组构造过程中所需的距离值和锚节点，实现减小距离估计误差对定位结果的影响，从而改善最小二乘定位精度的目的。

发明内容

本发明的目的是为了解决通信距离估计误差导致定位精度较低的问题，提供一种基于最小误差传播的锚节点优化选择的最小二乘定位方法。

本发明所述的一种基于最小误差传播的锚节点优化选择的最小二乘定位方法包括以下步骤：

步骤一、系统中有I+1个无线传感器节点，分别为I个定位的锚节点和1个未知节点，它们都具有nanoLOC无线射频收发器，并可以采用双边对等方法测量得到任意两个节点间的距离估计值，其中，I为用户设定的正整数，且4≤I≤10，本发明中I取值为10；

步骤二、系统中各个节点进行初始化，未知节点首先建立无线网络，并等待其它节点申请加入网络；

步骤三、I个锚节点初始化成功后，分别采用射频收发器扫描发现未知节点建立的无线网络，并通过射频收发器发送网络加入请求数据包，申请加入该无线网络，如果加入网络成功，则执行步骤四，否则，执行步骤三；

步骤四、初始化变量i为1，i为正整数，且1≤i≤I；

步骤五、未知节点通过其无线射频收发器向第i个锚节点发送定位请求数据包，第i个锚节点收到定位请求数据包后，采用双边对等测距方法，通过与未知节点间的4J次数据包交互，获得第i个锚节点与未知节点间的距离d_i的J次测量值：{d_i1,d_i2,d_i3,…,d_ij,…,d_iJ}，并进行统计计算，将测量值的统计均值d_i_u作为距离d_i估计结果，将测量值的统计标准差d_i_σ作为距离d_i估计结果的不确定性，i＝i+1，j为正整数，且1≤j≤J，J为用户设定的正整数，且50≤J≤150，本发明中，J取值为100；

步骤六、判断i的值是否大于I，若是，则执行步骤七，否则执行步骤五；

步骤七、系统获得未知节点与I个锚节点间的距离估计结果{d₁_u,d₂_u,d₃_u，…，d_i_u，…，d_I_u}，以及它们对应的不确定度序列{d₁_σ,d₂_σ,d₃_σ，…，d_i_σ，…，d_I_σ}，定义误差传播序列Q＝{d₁_σ*d₁_u,d₂_σ*d₂_u,d₃_σ*d₃_u，…，d_i_σ*d_i_u，…，d_I_σ*d_I_u}，定义估计质量参数滑动窗口w＝{w₁,w₂,w₃,…,w_k,…,w_K}，其中1≤i≤I，1≤k≤K，i和k初始化值为1，其中K为用户定义的正整数，且3≤K≤I，本专利中，K取值为8，定义变量l，且1≤l≤K,l初始值为K；

步骤八、系统判断k是否大于K，如果是，k值置为1，执行步骤十，否则执行步骤九；

步骤九、w_k的值置为Inf，其中Inf为最大实数，k＝k+1，执行步骤八；

步骤十、系统判断i是否大于I，如果是，执行步骤十五，否则执行步骤十一；

步骤十一、系统判断k是否大于K，如果是，k值置为1，i＝i+1，执行步骤十，否则执行步骤十二；

步骤十二、系统判断d_i_σ是否小于w_k，若是，执行步骤十三，否则，k＝k+1，执行步骤十一；