一种飞行器自组织网络协同定位方法技术

本发明专利技术公开了一种飞行器自组织网络协同定位方法，涉及飞行器协同定位领域，利用两跳链路内飞行器间相对距离和相对角度测量结果和两跳内可观测锚节点位置，构建多跳链路联合观测量，结合测距误差和测角误差对定位误差的影响构建权重矩阵，基于加权线性最小二乘算法完成飞行器在自组织网络中的协同定位。相对于常规协同定位方法，本方法无需将所有链路测量结果汇总至中心计算节点进行位置计算，只需收集两跳链路内的测量结果即可自主完成自身节点的位置计算，飞行器间通信开销小、定位时延低。低。低。

【技术实现步骤摘要】
一种飞行器自组织网络协同定位方法


[0001]本专利技术涉及飞行器协同定位领域，具体涉及一种飞行器自组织网络协同定位方法。

技术介绍

[0002]协同定位可以使飞行器在GNSS拒止环境中依靠器间数据链获得与其它飞行器的相对位置信息进行自身定位，是飞行器定位技术发展的一个重要方向。然而在锚节点较少的场景中，待定位飞行器难以只依靠测距信息进行定位解算。联合利用测距测角信息的协同定位是指飞行器通过数据链同时获得与其它飞行器的相对距离和相对角度信息进行定位解算的方法，可以应用于锚节点较少的定位场景，具有重要的研究意义。
[0003]常规的协同定位方法需要汇总网络中全部的测量信息到指定的中心计算设备，同时完成所有节点的定位解算，其通信开销大，定位时延高，不适合没有中心节点的自组织飞行器网络。一些联合测距测角协同定位通过构建二维环境下多跳链路线性最小二乘方程，可实现二维网络中节点的分布式定位，但这类方法不适用在三维空间中机动的飞行器定位。
[0004]与线性最小二乘定位解算方法相比，加权最小二乘定位解算方法具有更高的定位精度。一些加权最小二本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种飞行器自组织网络协同定位方法，其特征在于，飞行器协同定位过程中，待定位飞行器s两跳范围内的可见锚节点集合为其中a
i
表示编号为i的锚节点；待定位飞行器s一跳邻居节点集合为其中u
j
表示编号为j的一跳邻居节点；待定位飞行器s利用锚节点a的位置p
a
＝[x
a
,y
a
,z
a
]
T
、一跳邻居节点u与锚节点a的测距结果d
au
、水平角测角结果θ
au
、高程角测角结果φ
au
、自身与一跳邻居节点的测距结果d
us
、水平角测角结果θ
us
、高程角测角结果φ
us
以及自身与锚节点的测距结果d
as
、水平角测角结果θ
as
、高程角测角结果φ
as
确定自身位置p
s
＝[x
s
,y
s
,z
s
]
T
；采用相对距离测量模块、相对角度测量模块、通信数据解调模块、多跳链路联合观测量构建模块、权重计算模块以及位置解算模块执行如下步骤；(1)所述相对距离测量模块通过接收到的通信信号测量待定位节点s与直接可见的锚节点a的相对距离d
as
、待定位节点s与一跳邻居节点u的相对距离d
us
，获得测距结果后，将测距结果传递给多跳链路联合观测量构建模块和权重计算模块；(2)所述相对角度测量模块通过接收到的通信信号测量待定位节点s与直接可见的锚节点a的相对水平角θ
as
、待定位节点s与直接可见的锚节点a相对高程角φ
as
、待定位节点s与一跳邻居节点u的的相对水平角θ
us
、待定位节点s与一跳邻居节点u的相对高程角φ
us
，获得测角结果后，将测角结果传递给多跳链路联合观测量构建模块和权重计算模块；(3)所述通信数据解调模块解调出通信信号中调制的锚节点a的位置p
a
＝[x
a
,y
a
,z
a
]
T
、一跳邻居节点u与锚节点a的测距结果d
au
、水平角测角结果θ
au
、高程角测角结果φ
au
，并将解调出的信息传递给多跳链路联合观测量构建模块和权重计算模块；(4)所述多跳链路联合观测量构建模块根据输入的锚节点位置和各链路测距测角结果，构建锚节点到待定位节点s的两跳内链路集合其中l
i
表示编号为i的链路，i取值为[1,L]范围内的整数；链路集合包含锚节点a到待定位节点s的单跳链路和锚节点a经一跳邻居节点u中继到待定位节点s的两跳链路；在完成链路集合构建的基础上，对集合中的第i条链路l
i
，分别构建其x轴、y轴、z轴的联合观测量b
x,i
、b
y,i
、b
z,i
；在获得各链路联合观测量后，组合成联合观测向量b＝[b
x,1
,b
x,2
,...,b
x,L
,b
y,1
,b
y,2
,...,b
y,L
,b
z,1
,b
z,2
,...,b
z,L
]
T
，将联合观测向量送入位置解算模块，将链路集合送入权重计算模块；(5)所述权重计算模块根据输入的锚节点位置和各链路测距测角结果，计算链路l
i
由测距误差带来的定位误差
△
p
idistance
和测角误差带来的定位误差
△
p
iangle
；计算链路l
i
上的权重w
i
，计算方法为计算得到全部链路的权重后，计算权重矩阵W，计算方法为W＝diag([w1,...,w
L
,w1,...,w
L
,w1,...,w
L
])
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(12)得到权重矩阵W后，将权重矩阵传递给位置解算单元；(6)所述位置解算单元首先计算系数矩阵Q，其计算方法为
其中1
L
×1为L个1组成的列矩阵，0
L
×1为L个0组成的列矩阵；得到系数矩阵后，根据输入的联合观测向量和权重矩阵计算待定位节点s的位置p
s
＝[x
s
,y
s
,z
s
]
T
，计算方法为p
s
＝(Q
T
W
T
WQ)
‑1Q
T
W
T
Wb

【专利技术属性】
技术研发人员：申宇瑶，刘一明，王永庆，史学森，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：