本发明涉及高精度的距离估计和定位技术。
背景技术：
实际无线通信环境中，由于噪声、环境和测量误差等不良因素的影响，引起距离估计具有较大的误差，导致三边测量定位精度较低。针对上述问题，本发明对锚节点冗余定位环境下，评估各个锚节点到未知节点间距离估计的统计标准差，并以此来优化选择定位方程组构造过程中所需的距离估计值和锚节点，减小距离估计误差对定位结果的影响，从而改善三边测量定位精度的目的。
技术实现要素：
本发明的目的是为了解决通信距离估计误差导致定位精度较低的问题，提供一种基于最小标准差的锚节点优化选择的三边测量定位方法。
本发明所述的一种基于最小标准差的锚节点优化选择的三边测量定位方法包括以下步骤：
步骤一、系统中有i+1个无线传感器节点，分别为i个定位的锚节点和1个未知节点，它们都具有nanoloc无线射频收发器，并可以采用双边对等方法测量得到任意两个节点间的距离估计值，其中，i为用户设定的正整数，且4≤i≤10，本发明中i取值为10；
步骤二、系统中各个节点进行初始化，未知节点首先建立无线网络，并等待其它节点申请加入网络；
步骤三、i个锚节点初始化成功后，分别采用射频收发器扫描发现未知节点建立的无线网络，并通过射频收发器发送网络加入请求数据包，申请加入该无线网络，如果加入网络成功，则执行步骤四，否则，执行步骤三；
步骤四、初始化变量i为1，i为正整数，且1≤i≤i；
步骤五、未知节点通过其无线射频收发器向第i个锚节点发送定位请求数据包，第i个锚节点收到定位请求数据包后，采用双边对等测距方法，通过与未知节点间的4j次数据包交互，获得第i个锚节点与未知节点间的距离di的j次测量值：{di1,di2,di3,…,dij,…,dij}，并进行统计计算，将测量值的统计均值di_u作为距离di估计结果，将测量值的统计标准差di_σ作为距离di估计结果的不确定性，i＝i+1，j为正整数，且1≤j≤j，j为用户设定的正整数，且50≤j≤150，本发明中，j取值为100；
步骤六、判断i的值是否大于i，若是，则执行步骤七，否则执行步骤五；
步骤七、系统获得未知节点与i个锚节点间的距离估计结果{d1_u，d2_u，d3_u，…，di_u，…，di_u}，以及它们对应的不确定度q＝{d1_σ，d2_σ，d3_σ，…，di_σ，…，di_σ}；
步骤八、系统定义滑动窗口w＝{q_max,q_med,q_min}，并且初始化为：w＝{q_max＝inf,q_med＝inf,q_min＝inf}，其中q_max∈z，q_med∈z，q_min∈z，inf为最大实数，且i值置为1；
步骤九、如果di_σ<q_min，则执行步骤十，否则，执行步骤十一；
步骤十、q_max＝q_med，q_med＝q_min，q_min＝di_σ，执行步骤十五；
步骤十一、如果di_σ<q_med，则执行步骤十二，否则，执行步骤十三；
步骤十二、q_max＝q_med，q_med＝di_σ，执行步骤十五；
步骤十三、如果di_σ<q_max，则执行步骤十四，否则执行步骤十五；
步骤十四、q_max＝di_σ，执行步骤十五；
步骤十五、i＝i+1，判断i的值是否大于i，若是，则执行步骤十六，否则执行步骤九；
步骤十六、系统获得优化选择的得到三个最小的距离估计标准差{q_max,q_med,q_min}，并将其对应的距离估计结果{d'1_u,d'2_u,d'3_u}，以及距离估计结果对应的三个锚节点坐标(x'1，y'1)，(x'2，y'2)，(x'3，y'3)分别作为优化选择的距离估计值和锚节点信息；
步骤十七、系统根据最小二乘准则，结合优化选择的距离估计值及其对应的锚节点坐标，按公式(1)计算未知节点的坐标(x，y)：
其中
步骤十八、系统判断定位计算任务是否完成，如果是，执行步骤十九，否则，在下一个定位点上，执行步骤四；
步骤十九、系统结束基于最小标准差的锚节点优化选择的三边测量定位任务。
附图说明
图1为一种基于最小标准差的锚节点优化选择的三边测量定位方法的流程图。
具体实施方式
具体实施方式一：结合图1说明本实施方式，本实施方式所述的一种基于最小标准差的锚节点优化选择的三边测量定位方法包括以下步骤：
步骤一、系统中有i+1个无线传感器节点，分别为i个定位的锚节点和1个未知节点，它们都具有nanoloc无线射频收发器，并可以采用双边对等方法测量得到任意两个节点间的距离估计值，其中，i为用户设定的正整数，且4≤i≤10，本发明中i取值为10；
步骤二、系统中各个节点进行初始化，未知节点首先建立无线网络，并等待其它节点申请加入网络；
步骤三、i个锚节点初始化成功后，分别采用射频收发器扫描发现未知节点建立的无线网络，并通过射频收发器发送网络加入请求数据包，申请加入该无线网络，如果加入网络成功，则执行步骤四，否则，执行步骤三；
步骤四、初始化变量i为1，i为正整数，且1≤i≤i；
步骤五、未知节点通过其无线射频收发器向第i个锚节点发送定位请求数据包，第i个锚节点收到定位请求数据包后，采用双边对等测距方法，通过与未知节点间的4j次数据包交互，获得第i个锚节点与未知节点间的距离di的j次测量值：{di1,di2,di3,…,dij,…,dij}，并进行统计计算，将测量值的统计均值di_u作为距离di估计结果，将测量值的统计标准差di_σ作为距离di估计结果的不确定性，i＝i+1，j为正整数，且1≤j≤j，j为用户设定的正整数，且50≤j≤150，本发明中，j取值为100；
步骤六、判断i的值是否大于i，若是，则执行步骤七，否则执行步骤五；
步骤七、系统获得未知节点与i个锚节点间的距离估计结果{d1_u，d2_u，d3_u，…，di_u，…，di_u}，以及它们对应的不确定度q＝{d1_σ，d2_σ，d3_σ，…，di_σ，…，di_σ}；
步骤八、系统定义滑动窗口w＝{q_max,q_med,q_min}，并且初始化为：w＝{q_max＝inf,q_med＝inf,q_min＝inf}，其中q_max∈z，q_med∈z，q_min∈z，inf为最大实数，且i值置为1；
步骤九、如果di_σ<q_min，则执行步骤十，否则，执行步骤十一；
步骤十、q_max＝q_med，q_med＝q_min，q_min＝di_σ，执行步骤十五；
步骤十一、如果di_σ<q_med，则执行步骤十二，否则，执行步骤十三；
步骤十二、q_max＝q_med，q_med＝di_σ，执行步骤十五；
步骤十三、如果di_σ<q_max，则执行步骤十四，否则执行步骤十五；
步骤十四、q_max＝di_σ，执行步骤十五；
步骤十五、i＝i+1，判断i的值是否大于i，若是，则执行步骤十六，否则执行步骤九；
步骤十六、系统获得优化选择的得到三个最小的距离估计标准差{q_max,q_med,q_min}，并将其对应的距离估计结果{d'1_u,d'2_u,d'3_u}，以及距离估计结果对应的三个锚节点坐标(x'1，y'1)，(x'2，y'2)，(x'3，y'3)分别作为优化选择的距离估计值和锚节点信息；
步骤十七、系统根据最小二乘准则，结合优化选择的距离估计值及其对应的锚节点坐标，按公式(1)计算未知节点的坐标(x，y)：
其中
步骤十八、系统判断定位计算任务是否完成，如果是，执行步骤十九，否则，在下一个定位点上，执行步骤四；
步骤十九、系统结束基于最小标准差的锚节点优化选择的三边测量定位任务。
具体实施方案二，本实施方式是对具体实施方式一所述的一种基于最小标准差的锚节点优化选择的三边测量定位方法作进一步说明，本实施方式中，采用动态滑动窗口和单遍扫描的方法，能够在距离估计标准差序列中高效率选择出统计标准差最小的三个，为锚节点的优化选择提供支持。
具体实施方案三，本实施方式是对具体实施方式一所述的一种基于最小标准差的锚节点优化选择的三边测量定位方法作进一步说明，本实施方式中，采用基于统计标准差的通信距离估计和锚节点优化选择，减小距离估计误差对三边测量定位的影响，实现高精度的三边测量定位。
具体实施方案四，本实施方式是对具体实施方式一所述的一种基于最小标准差的锚节点优化选择的三边测量定位方法作进一步说明，本实施方式中，采用的距离估计方法也可以采用基于rssi、toa、tdoa和aoa等其它距离估计方法。
具体实施方案五，本实施方式是对具体实施方式一所述的一种基于最小标准差的锚节点优化选择的三边测量定位方法作进一步说明，本实施方式中，采用的定位方法也可以适用于三维情况下的三边测量定位方法。