CN107479027A - 一种基于最小误差传播的锚节点优化选择的最大似然定位方法 - Google Patents

Abstract

一种基于最小误差传播的锚节点优化选择的最大似然定位方法，涉及锚节点优化选择的最大似然改进定位方法。本发明是为了有效解决通信距离估计误差导致定位精度较低的问题。本发明所述的一种基于最小误差传播的锚节点优化选择的最大似然定位方法，首先采用双边对等距离估计的方法获得未知节点到各个锚节点间距离估计的多个样本值，并统计分析，得到各个距离估计值的统计均值和统计标准差；然后采用动态滑动窗口和单遍扫描的方法获得距离估计统计均值及统计标准差乘积值最小的几个距离估计结果，并选择对应的锚节点构造最大似然定位方程组；最后采用最小二乘准则获得高精度的定位结果。

Description

一种基于最小误差传播的锚节点优化选择的最大似然定位 方法

技术领域

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

背景技术

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

发明内容

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

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

步骤一、系统中有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，执行步骤十一；

步骤十三、系统判断l是否小于k，如果是，l的值置为K，w_l＝d_i_σ*d_i_u，执行步骤十一，否则，执行步骤十四；

步骤十四、w_l＝w_l-1，l＝l-1，执行步骤十三；

步骤十五、系统获得滑动窗口序列w＝{w₁,w₂,w₃,…,w_k,…,w_K}，将其对应的距离估计值序列作为优化选择的距离估计结果d’＝{d’₁_u,d’₂_u,d’₃_u，…，d’_k_u，…，d’_K_u}，将优化选择的距离估计结果对应的锚节点A’＝{A’₁,A’₂,A’₃,…,A’_k,…,A’_K}作为优化选择的锚节点，执行步骤十六；

步骤十六、系统根据距离估计结果{d’₁_u,d’₂_u,d’₃_u，…，d’_k_u，…，d’_K_u}，以及对应的K个锚节点坐标的坐标信息(x’₁，y’₁)，(x’₂，y’₂)，(x’₃，y’₃)，…,(x’_k，y’_k)，…，(x’_K，y’_K)，并结合最小二乘准则，未知节点的坐标(x，y)按公式(1)进行计算：

其中

步骤十七、判断最大似然定位计算任务是否完成，如果是，执行步骤十八，否则，在下一个定位点上，执行步骤四；

步骤十八、结束基于最小误差传播的锚节点优化选择的最大似然定位任务。

附图说明

图1为一种基于最小误差传播的锚节点优化选择的最大似然定位方法的流程图。

具体实施方式

具体实施方式一：结合图1说明本实施方式，本实施方式所述的一种基于最小误差传播的锚节点优化选择的最大似然定位方法包括以下步骤：

步骤一、系统中有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，执行步骤十一；

步骤十三、系统判断l是否小于k，如果是，l的值置为K，w_l＝d_i_σ*d_i_u，执行步骤十一，否则，执行步骤十四；

步骤十四、w_l＝w_l-1，l＝l-1，执行步骤十三；

步骤十五、系统获得滑动窗口序列w＝{w₁,w₂,w₃,…,w_k,…,w_K}，将其对应的距离估计值序列作为优化选择的距离估计结果d’＝{d’₁_u,d’₂_u,d’₃_u，…，d’_k_u，…，d’_K_u}，将优化选择的距离估计结果对应的锚节点A’＝{A’₁,A’₂,A’₃,…,A’_k,…,A’_K}作为优化选择的锚节点，执行步骤十六；

步骤十六、系统根据距离估计结果{d’₁_u,d’₂_u,d’₃_u，…，d’_k_u，…，d’_K_u}，以及对应的K个锚节点坐标的坐标信息(x’₁，y’₁)，(x’₂，y’₂)，(x’₃，y’₃)，…,(x’_k，y’_k)，…，(x’_K，y’_K)，并结合最小二乘准则，未知节点的坐标(x，y)按公式(1)进行计算：

其中

步骤十七、判断最大似然定位计算任务是否完成，如果是，执行步骤十八，否则，在下一个定位点上，执行步骤四；

步骤十八、结束基于最小误差传播的锚节点优化选择的最大似然定位任务。

具体实施方案二，本实施方式是对具体实施方式一所述的一种基于最小误差传播的锚节点优化选择的最大似然定位方法作进一步说明，本实施方式中，采用动态滑动窗口和单遍扫描的方法，能够在距离估计统计均值和统计标准差乘积的序列中高效率选择出统计均值和统计标准差乘积值最小的几个，为锚节点的优化选择提供支持。

具体实施方案三，本实施方式是对具体实施方式一所述的一种基于最小误差传播的锚节点优化选择的最大似然定位方法作进一步说明，本实施方式中，采用基于最小误差传播的锚节点优化选择，减小距离估计误差对最小二乘定位的影响，实现高精度的最小二乘定位。

具体实施方案四，本实施方式是对具体实施方式一所述的一种基于最小误差传播的锚节点优化选择的最大似然定位方法作进一步说明，本实施方式中，采用的距离估计方法也可以采用基于RSSI、TOA、TDOA和AOA等其它距离估计方法。

具体实施方案五，本实施方式是对具体实施方式一所述的一种基于最小误差传播的锚节点优化选择的最大似然定位方法作进一步说明，本实施方式中，采用的排序方法也可采用其它高效的排序方法。

具体实施方案六，本实施方式是对具体实施方式一所述的一种基于最小误差传播的锚节点优化选择的最大似然定位方法作进一步说明，本实施方式中，采用的最大似然定位改进定位方法也可以适用于三维情况下的最大似然定位方法。

Claims (6)

1.一种基于最小误差传播的锚节点优化选择的最大似然定位方法，其特征在于所述方法包括以下步骤：

步骤一、系统中有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，执行步骤十一；

步骤十三、系统判断l是否小于k，如果是，l的值置为K，w_l＝d_i_σ*d_i_u，执行步骤十一，否则，执行步骤十四；

步骤十四、w_l＝w_l-1，l＝l-1，执行步骤十三；

步骤十五、系统获得滑动窗口序列w＝{w₁,w₂,w₃,…,w_k,…,w_K}，将其对应的距离估计值序列作为优化选择的距离估计结果d'＝{d'₁_u,d'₂_u,d'₃_u，…，d'_k_u，…，d'_K_u}，将优化选择的距离估计结果对应的锚节点A'＝{A'₁,A'₂,A'₃,…,A'_k,…,A'_K}作为优化选择的锚节点，执行步骤十六；

步骤十六、系统根据距离估计结果{d'₁_u,d'₂_u,d'₃_u，…，d'_k_u，…，d'_K_u}，以及对应的K个锚节点坐标的坐标信息(x'₁，y'₁)，(x'₂，y'₂)，(x'₃，y'₃)，…,(x'_k，y'_k)，…，(x'_K，y'_K)，并结合最小二乘准则，未知节点的坐标(x，y)按公式(1)进行计算：

<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>x</mi> </mtd> </mtr> <mtr> <mtd> <mi>y</mi> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <msup> <mrow> <mo>(</mo> <msup> <mi>A</mi> <mi>T</mi> </msup> <mi>A</mi> <mo>)</mo> </mrow> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <msup> <mi>A</mi> <mi>T</mi> </msup> <mi>B</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>

其中

步骤十七、判断最大似然定位计算任务是否完成，如果是，执行步骤十八，否则，在下一个定位点上，执行步骤四；

步骤十八、结束基于最小误差传播的锚节点优化选择的最大似然定位任务。

2.根据权利要求1所述的一种基于最小误差传播的锚节点优化选择的最大似然定位方法作进一步说明，其特征在于采用动态滑动窗口和单遍扫描的方法，能够在距离估计统计均值和统计标准差乘积的序列中高效率选择出统计均值和统计标准差乘积值最小的几个，为锚节点的优化选择提供支持。

3.根据权利要求1所述的一种基于最小误差传播的锚节点优化选择的最大似然定位方法作进一步说明，其特征在于采用基于最小误差传播的锚节点优化选择，减小距离估计误差对最小二乘定位的影响，实现高精度的最小二乘定位。

4.根据权利要求1所述的一种基于最小误差传播的锚节点优化选择的最大似然定位方法作进一步说明，其特征在于本发明中的距离估计方法也可以采用基于RSSI、TOA、TDOA和AOA等其它距离估计方法。

5.根据权利要求1所述的一种基于最小误差传播的锚节点优化选择的最大似然定位方法作进一步说明，其特征在于本发明采用的排序方法，也可采用其它高效的排序方法。

6.根据权利要求1所述的一种基于最小误差传播的锚节点优化选择的最大似然定位方法作进一步说明，其特征在于发明中的定位方法也可以适用于三维情况下的最大似然定位方法。