基于自组网链路的班组协同定位方法、系统及终端技术方案

本发明专利技术涉及个体精确定位技术领域，尤其涉及基于自组网链路的班组协同定位方法、系统及终端，将协同定位终端配备给班组所有单兵个体，协同定位终端通过融合自组网通信、自组网定位、RTK定位及Mems定位技术，在班组自组网链路中广播定位成功的单兵个体自身位置信息，为受到环境干扰而不能采用卫星干扰的其余单兵个体的定位终端提供定位参考信息，协同定位终端通过自组网定位技术计算距离差，反算出受干扰单兵个体的经纬度坐标，通过气压计得到海拔信息，完成班组对所有受干扰的单兵个体精确定位，实现在复杂的环境完成班组间协同多模高精度定位，解决个体定位易受环境干扰及定位精度低的问题。低的问题。低的问题。

【技术实现步骤摘要】
基于自组网链路的班组协同定位方法、系统及终端


[0001]本专利技术涉及个体精确定位
，尤其涉及一种基于自组网链路的班组协同定位方法、系统及终端。

技术介绍

[0002]传统单兵智能装备采用单卫星定位的方式且单兵个体间独立，在城市环境中单兵定位易受环境干扰，导致单兵出现定位不准确，态势不清晰的情况，对于后台指挥人员制定是种巨大的挑战。
[0003]为确保班组在城市环境中具有实时高精度位置信息，提供了一种具备自组网通信、多模高精度协同定位方法，协助班组成员间完成高精度定位。

技术实现思路

[0004]针对上述班组中的单兵在城市环境下，定位不准确的问题，提供将自组网通信、自组网定位与RTK定位技术进行融合应用于高精度班组的基于自组网链路的班组协同定位方法、系统及终端。
[0005]为解决上述技术问题，本专利技术提供基于自组网链路的班组协同定位方法，包括以下步骤：
[0006]S1、班组中的所有单兵个体使用协同定位终端搜索并锁定卫星，不满足卫星定位条件的协同定位终端通过自组网接收定位成功的协同定位终端广播的信息；
[0007]S2、对班组中至少3个单兵个体完成定位，将定位成功的单兵个体的经纬度信息及海拔值信息作为定位参考信息，对定位参考信息实时通过协同定位终端的自组网在小组内进行广播；
[0008]S3、未定位成功的单兵个体的协同定位终端通过自组网接收所述定位参考信息，将数个定位参考信息作为数个锚节点，将未定位成功的单兵个体信息作为未知节点，筛选所有锚节点中RSSI值最强的3个，计算得到未知节点与3个锚节点之间的三维直线距离；
[0009]S4、通过气压计得到未知节点的海拔值；通过加权质心算法消除所述锚节点与未知节点的高度不位于同一水平平面的影响，得到锚节点与未知节点之间的二维直线距离；
[0010]S5、根据三边定位算法计算得到未知节点的经纬度坐标，结合未知节点的海拔值，完成对未知节点的精确定位。
[0011]本专利技术将自组网通信、自组网定位与RTK定位技术进行融合应用于高精度班组，高精度班组的自组网络中存在少量锚节点，其锚节点的位置通过卫星定位的方式获取，通过自组网将锚节点自身定位的经纬度信息及海拔值信息在自组网内广播，其余未成功通过卫星定位的未知节点通过自组网广播接收锚节点的定位信息，并依据自组网RSSI技术与三边定位算法完成自身定位，从而完成班组内所有成员定位，协同定位终端采用OFDM+LDPC调制编码技术，具备绕射性能好和传输距离远的特性，即使锚节点与未知节点相隔5km，都能成功定位，摆脱单独依靠北斗定位干扰等问题。
[0012]进一步的，所述步骤S1中，卫星定位条件包括协同定位终端锁定卫星的颗数大于或等于4及卫星的信噪比大于或等于40dB。
[0013]进一步的，所述步骤S3中，通过自组网RSSI技术得到未知节点与已知锚节点之间的三维直线距离的公式如下：
[0014][0015]其中，d为未知节点与已知锚节点之间的三维直线距离，单位为米；P
t
为锚节点的发射信号功率；P
r(d)
为未知节点接收到的锚节点的发射信号功率；G
t
为发射天线的增益；G
r
为接收天线的增益；L为系统损耗因子；λ为波长，单位为米。
[0016]进一步的，所述步骤S4中，通过气压计得到未知节点的海拔值为h，则3 个锚节点对应的海拔值分别为h1、h2及h3；未知节点与3个锚节点的三维直接距离分别为d1、d2、d3，得到数个锚节点与未知节点之间的二维直线距离分别为d
′1、d
′2及d
′3，公式如下：
[0017][0018][0019]。
[0020]进一步的，所述步骤S5，
[0021]基于步骤S4得到的未知节点与3个锚节点二维距离分别为d
′1、d
′2及d
′3，3个锚节点的经纬度坐标分别为(x1，y1)、(x2，y2)及 (x3，y3)，通过三边定位算法得到未知节点经纬度信息，由：
[0022]d
′
12
＝(x1‑
x)2+(y1‑
y)2[0023]d
′
22
＝(x2‑
x)2+(y2‑
y)2[0024]d
′
32
＝(x3‑
x)2+(y3‑
y)2[0025]其中，将3个锚节点与未知节点的经纬度坐标信息建立二维三边模型，计算得到未知节点的经纬度坐标(x，y)，公式如下：
[0026][0027][0028]基于未知节点的经纬度坐标(x，y)及海拔值h，完成对未知节点的定位。
[0029]本专利技术实施例还提供一种基于自组网链路的班组协同定位系统，包括：用于组建自组网链路的若干协同定位终端，搜索并锁定卫星，判断是否满足卫星定位条件，若满足，则定位成功，定位成功的协同定位终端将自身经纬度信息及海拔值信息作为定位参考信息实时在自组网内进行广播；若不满足，未定位成功的协同定位终端通过自组网接收所述定位参考信息，将数个定位参考信息作为数个锚节点，未定位成功的协同定位终端作为未知节点，筛选所有锚节点中RSSI值最强的3个，计算得到自身与3个锚节点之间的三维直线距
离；通过气压计得到未知节点的海拔值；未知节点通过加权质心算法消除所述锚节点与自身的高度不位于同一水平平面的影响，得到锚节点与自身之间的二维直线距离；并根据三边定位算法计算得到自身的经纬度坐标，结合未知节点的海拔值，完成对自身位置的精确定位。
[0030]本专利技术实施例还提供基于自组网链路的班组协同定位终端，所述协同定位终端用于搜索并锁定卫星，判断是否满足卫星定位条件，若满足，则定位成功，将自身经纬度信息及海拔值信息作为定位参考信息，实时在自组网小组内进行广播；若不满足，则通过自组网接收班组中至少3个定位成功的协同定位终端所广播的所述定位参考信息，将数个定位参考信息作为数个锚节点，将自身作为未知节点，筛选所有锚节点中RSSI值最强的3个，计算得到自身与3个锚节点之间的三维直线距离；通过气压计得到未知节点的海拔值；未知节点通过加权质心算法消除所述锚节点与自身的高度不位于同一水平平面的影响，得到锚节点与自身之间的二维直线距离；并根据三边定位算法计算得到自身的经纬度坐标，结合自身的海拔值，完成对自身位置的精确定位。
[0031]相比于现有技术，本专利技术的优点及有益效果在于：本专利技术将自组网通信、自组网定位技术及RTK定位技术进行融合，实现在复杂的环境完成班组间协同多模高精度定位，解决个体定位易受环境干扰及定位精度低的问题。
附图说明
[0032]图1为本专利技术的方法工作流程示意图；
[0033]图2为本专利技术中未知节点与锚节点之间三维高度差关系示意图；
[0034]图3为本专利技术的二维三边定位模型示意图。
具体实施方式
[0035]为了使本专利技术的目的、技术方案及优本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于自组网链路的班组协同定位方法，其特征在于，包括以下步骤：S1、班组中的所有单兵个体使用协同定位终端搜索并锁定卫星，不满足卫星定位条件的协同定位终端通过自组网接收定位成功的协同定位终端广播的信息；S2、对班组中至少3个单兵个体完成定位，将定位成功的单兵个体的经纬度信息及海拔值信息作为定位参考信息，对定位参考信息实时通过协同定位终端的自组网在小组内进行广播；S3、未定位成功的单兵个体的协同定位终端通过自组网接收所述定位参考信息，将数个定位参考信息作为数个锚节点，将未定位成功的单兵个体信息作为未知节点，筛选所有锚节点中RSSI值最强的3个，计算得到未知节点与3个锚节点之间的三维直线距离；S4、通过气压计得到未知节点的海拔值；通过加权质心算法消除所述锚节点与未知节点的高度不位于同一水平平面的影响，得到锚节点与未知节点之间的二维直线距离；S5、根据三边定位算法计算得到未知节点的经纬度坐标，结合未知节点的海拔值，完成对未知节点的精确定位。2.根据权利要求1所述的基于自组网链路的班组协同定位方法，其特征在于：所述步骤S1中，卫星定位条件包括协同定位终端锁定卫星的颗数大于或等于4及卫星的信噪比大于或等于40dB。3.根据权利要求1所述的基于自组网链路的班组协同定位方法，其特征在于：所述步骤S3中，通过自组网RSSI技术得到未知节点与已知锚节点之间的三维直线距离的公式如下：其中，d为未知节点与已知锚节点之间的三维直线距离，单位为米；P
t
为锚节点的发射信号功率；P
r(d)
为未知节点接收到的锚节点的发射信号功率；G
t
为发射天线的增益；G
r
为接收天线的增益；L为系统损耗因子；λ为波长，单位为米。4.根据权利要求3所述的基于自组网链路的班组协同定位方法，其特征在于：所述步骤S4中，通过气压计得到未知节点的海拔值为h，则3个锚节点对应的海拔值分别为h1、h2及h3；未知节点与3个锚节点的三维直接距离分别为d1、d2、d3，得到数个锚节点与未知节点之间的二维直线距离分别为d
′1、d
′2及d
′3，公式如下：，公式如下：，公式如下：5.根据权利要求4所述的基于自组网链路的班组协同定位方法，其特征在于：所述步骤S5，基于步骤S4得到的未知节点与3个锚节点二维距离分别为d
′1、d
′2及d...

【专利技术属性】
技术研发人员：肖争，陈泉欣，陈宏，奚祥海，张力，董明剑，
申请(专利权)人：重庆高新区飞马创新研究院，
类型：发明
国别省市：