CN116206490A - 一种用于跨域协同导航的导航信息源群优化交互方法 - Google Patents
一种用于跨域协同导航的导航信息源群优化交互方法 Download PDFInfo
- Publication number
- CN116206490A CN116206490A CN202210805370.7A CN202210805370A CN116206490A CN 116206490 A CN116206490 A CN 116206490A CN 202210805370 A CN202210805370 A CN 202210805370A CN 116206490 A CN116206490 A CN 116206490A
- Authority
- CN
- China
- Prior art keywords
- aircraft
- coordinate system
- information source
- axis
- relative
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 47
- 238000005457 optimization Methods 0.000 title claims abstract description 31
- 230000003993 interaction Effects 0.000 title claims abstract description 28
- 239000011159 matrix material Substances 0.000 claims abstract description 59
- 230000004323 axial length Effects 0.000 claims abstract description 31
- 238000005259 measurement Methods 0.000 claims abstract description 13
- 238000004364 calculation method Methods 0.000 claims abstract description 6
- 238000006243 chemical reaction Methods 0.000 claims description 31
- 238000001914 filtration Methods 0.000 claims description 20
- 239000013598 vector Substances 0.000 claims description 12
- 230000005251 gamma ray Effects 0.000 claims description 6
- 230000009466 transformation Effects 0.000 claims description 6
- 238000012937 correction Methods 0.000 claims description 3
- 230000009191 jumping Effects 0.000 claims description 3
- 238000004422 calculation algorithm Methods 0.000 abstract description 4
- 238000005516 engineering process Methods 0.000 description 4
- 230000008859 change Effects 0.000 description 3
- 230000015572 biosynthetic process Effects 0.000 description 2
- 230000001788 irregular Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000008520 organization Effects 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G5/00—Traffic control systems for aircraft, e.g. air-traffic control [ATC]
- G08G5/0043—Traffic management of multiple aircrafts from the ground
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
- G01S19/49—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Computer Networks & Wireless Communication (AREA)
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种用于跨域协同导航的导航信息源群优化交互方法,对待辅助载体的协同导航信息源选择进行了优化,使得待辅助载体与基准信息源间的相对测量及信息交互选择更加合理;通过分割待辅助载体协方差矩阵获取位置误差矩阵,根据误差矩阵求解实际导航位置的误差椭球,获取误差椭球的轴长和方向。本方法优化了协同定位信号源的选择,能够减少协同信息计算处理量,加快协同定位解算;考虑到信号源构型和精度对定位结果的影响,高效利用集群定位信息优化提高了定位精度。和未采用优化的随机信号源选择协同定位算法相比,本发明在不规则分布的集群中能有效提升协同定位效率和精度,适合实际应用。
Description
技术领域
本发明涉及定位与导航技术领域,尤其涉及一种用于跨域协同导航的导航信息源群优化交互方法。
背景技术
近年来,飞行器集群协同技术日益受到国内外的关注。飞行器集群具有工作范围大、可靠性高、可同时执行多重任务、整体效率高等优点,可用于灾害勘测和救援等领域。飞行器集群技术,即多架飞行器为适应任务要求而进行的某种队形排列和任务分配的组织模式,它既包括集群飞行的队形产生、保持和变化,也包括集群飞行任务的规划和组织,是未来飞行器飞行技术发展的一个重要趋势。
传统飞行器集群协同定位方法的性能受到导航信号源的影响较大,只有在集群中飞行器较为密集且均匀时才能得到较好的定位精度,而对于非规则的编组集群情况下定位精度受到较大影响。
发明内容
本发明所要解决的技术问题是针对背景技术中所涉及到的缺陷,提供一种用于跨域协同导航的导航信息源群优化交互方法,对待辅助载体和基准信息源之间的协同定位源选择进行了优化,使得待辅助载体与基准信息源间的测距及信息交互选择更加合理,以扩大集群飞行器定位算法的适用性并提升定位精度,使其在非规则的编组的飞行器集群中也能得到良好的运用。
本发明为解决上述技术问题采用以下技术方案:
一种用于跨域协同导航的导航信息源群优化交互方法,包括以下步骤:
步骤A.1),获取飞行器集群定位导航所需的系统数据;
步骤A.2),根据待辅助飞行器滤波协方差矩阵计算当前位置的误差椭球E0;
步骤A.3),获取各基准信息源飞行器与待辅助飞行器之间相对方位角和相对距离;
步骤A.4),获取误差椭球E0最大轴长所在方向和信号源自身精度,选择最接近最大轴长方向的一架基准信息源飞行器作为基准信号源飞行器,进行辅助定位解算并对原先的位置进行修正,得到新的误差椭球E1;
步骤A.5),判断误差椭球E1最长轴的轴长L1大小是否已满足预设的阈值δ,若轴长L1>δ,令E0=E1、即将误差椭球E1作为误差椭球E0,跳转执行步骤4);若轴长L1<δ,输出当前辅助定位的位置信息。
作为本发明一种用于跨域协同导航的导航信息源群优化交互方法进一步的优化方案,步骤A.1)中所述的飞行器集群包含待辅助定位飞行器和n架基准信息源飞行器,基准信息源飞行器自身定位精度高于待辅助定位飞行器自身定位精度;获取飞行器集群定位导航所需系统测量数据时,首先获取n架基准信息源飞行器的导航系统信息、经纬高数据及卫星导航定位精度,然后获取待辅助定位飞行器的GPS及惯导组合导航数据、姿态角数据、卡尔曼滤波协方差矩阵、经纬高数据、纬度误差、经度误差、高度误差。
作为本发明一种用于跨域协同导航的导航信息源群优化交互方法进一步的优化方案,所述步骤A.2)包括如下具体步骤:
步骤A.2.1),利用卡尔曼滤波的协方差矩阵获得位置的协方差矩阵Ppos,定义如下:
步骤A.2.3),根据转换后的位置误差矢量Ep,进一步获取位置误差协方差矩阵Pp
Ep=[x y z]
步骤A.2.4),求对称协方差矩阵Pp的特征值λ1、λ2和λ3,进一步开方得到椭球的相应轴长:
其中,axisx、axisy、axisz分别为椭球E0的X轴、Y轴、Z轴方向的轴长;
作为本发明一种用于跨域协同导航的导航信息源群优化交互方法进一步的优化方案,所述步骤A.3)包括如下具体步骤:
步骤A.3.1),获得每个基准信息源飞行器和待辅助定位飞行器的相对距离;
步骤A.3.2),将所有飞行器的经度、纬度和高度坐标转换为地球坐标系坐标,RN为地球卯酉圈曲率半径,f为地球扁率,λi为第i个基准信息源飞行器的经度,Li为第i个基准信息源飞行器的纬度,Hi为的基准信息源飞行器的高度,为转换后第i个基准信息源飞行器的地球坐标系坐标,转换公式如下:/>
建立以待辅飞行器为坐标原点的相对坐标系,相对坐标系各坐标轴与ECEF坐标系坐标轴平行,X轴在赤道平面内与零度子午线相交,Z轴与地球自转轴平行,Y轴与X轴、Z轴构成右手直角坐标系,各基准信息源在相对坐标系下的位置坐标转换如下:
λ、L、H分别为待辅助飞行器的经度、纬度、高度,RN为卯酉圈半径,e为地球偏心率;
得到集群系统各基准信息源飞行器在以待辅助飞行器为坐标原点的相对机体坐标系上的坐标:
αi为各基准信息源飞行器与相对机体坐标系Y轴的夹角;βi为各基准信息源飞行器与相对机体坐标系Z轴的夹角;γi为各基准信息源飞行器与相对机体坐标系X轴的夹角;(x,y,z)为待辅助飞行器的相对机体坐标系下的坐标,为基准信息源飞行器在相对机体坐标系下的位置坐标。
作为本发明一种用于跨域协同导航的导航信息源群优化交互方法进一步的优化方案,所述步骤A.4)包括如下具体步骤:
步骤A.4.1),比较λ1、λ2和λ3的大小,确定误差椭球E0的最长轴,根据各基准信号源与以待辅助飞行器为坐标原点的相对机体坐标系各轴的夹角αi、βi、γi,选择与椭球E0最长轴方向最近的基准信息源飞行器作为信号源飞行器;
对相对距离进行分解:
步骤A.4.3),计算得到的辅助定位解算后的待辅助飞行器的位置坐标(x',y',z')和机载传感器位置坐标(x,y,z)差值,并将其作为观测量,通过卡尔曼滤波来对待辅助飞行器机导航位置误差进行修正,修正后得到新的卡尔曼滤波协方差矩阵,根据新的协方差矩阵解算得到新的椭球E1。
本发明还公开了另一种用于跨域协同导航的导航信息源群优化交互方法,包括以下步骤:
步骤B.1),获取飞行器集群定位导航所需的传感器测量数据;
步骤B.2),根据待辅助飞行器卡尔曼滤波协方差矩阵计算当前位置的误差椭球E0;
步骤B.3),获取各基准信息源飞行器与待辅助飞行器之间相对方位角和相对距离;
步骤B.4),比较误差椭球E0三个方向的轴长大小,选择与最大轴长方向夹角最小的两个基准信息源飞行器作为主信号源飞行器,然后在剩余两个轴长方向,各选择一个与相应轴长方向夹角最小的基准信息源飞行器作为次信号源;当出现几架基准信息源飞行器与同一轴长方向夹角相近的情况,优先选择自身定位精度因子高的基准信息源飞行器作为信号源飞行器;
步骤B.5),选择任一主信号源作为主基准信息源,建立以主基准信息源为坐标原点的相对坐标系,得到其余信号源飞行器在相对坐标系下的位置坐标及距离差数据,然后根据TDOA模型,选择球面内插法进行解算得到相对坐标系解算结果和解算误差,并通过卡尔曼滤波对待辅助飞行器位置坐标进行修正。
作为该另一种用于跨域协同导航的导航信息源群优化交互方法进一步的优化方案,步骤B.1)中所述的飞行器集群包含待辅助定位飞行器和n架基准信息源飞行器,基准信息源飞行器自身定位精度高于待辅助定位飞行器自身定位精度;获取飞行器集群定位导航所需系统测量数据时,首先获取n架基准信息源飞行器的导航系统信息、经纬高数据及卫星导航定位精度,然后获取待辅助定位飞行器的GPS及惯导组合导航数据、姿态角数据、卡尔曼滤波协方差矩阵、经纬高数据、纬度误差、经度误差、高度误差。
作为该另一种用于跨域协同导航的导航信息源群优化交互方法进一步的优化方案,所述步骤B.2)包括如下具体步骤:
步骤B.2.1),利用卡尔曼滤波的协方差矩阵获得位置的协方差矩阵Ppos,定义如下:
步骤B.2.3),根据转换后的位置误差矢量Ep,进一步获取位置误差协方差矩阵Pp
Ep=[x y z]
步骤B.2.4),求对称协方差矩阵Pp的特征值λ1、λ2和λ3,进一步开方得到椭球的相应轴长:
其中,axisx、axisy、axisz分别为椭球E0的X轴、Y轴、Z轴方向的轴长;
作为该另一种用于跨域协同导航的导航信息源群优化交互方法进一步的优化方案,所述步骤B.3)包括如下具体步骤:
步骤B.3.1),获得每个基准信息源飞行器和待辅助定位飞行器的相对距离;
步骤B.3.2),将所有飞行器的经度、纬度和高度坐标转换为地球坐标系坐标,RN为地球卯酉圈曲率半径,f为地球扁率,λi为第i个基准信息源飞行器的经度,Li为第i个基准信息源飞行器的纬度,Hi为的基准信息源飞行器的高度,为转换后第i个基准信息源飞行器的地球坐标系坐标,转换公式如下:
建立以待辅飞行器为坐标原点的相对坐标系,相对坐标系各坐标轴与ECEF坐标系坐标轴平行,X轴在赤道平面内与零度子午线相交,Z轴与地球自转轴平行,Y轴与X轴、Z轴构成右手直角坐标系,各基准信息源在相对坐标系下的位置坐标转换如下:
λ、L、H分别为待辅助飞行器的经度、纬度、高度,RN为卯酉圈半径,e为地球偏心率;
得到集群系统各基准信息源飞行器在以待辅助飞行器为坐标原点的相对机体坐标系上的坐标:
αi为各基准信息源飞行器与相对机体坐标系Y轴的夹角;βi为各基准信息源飞行器与相对机体坐标系Z轴的夹角;γi为各基准信息源飞行器与相对机体坐标系X轴的夹角;(x,y,z)为待辅助飞行器的相对机体坐标系下的坐标,为基准信息源飞行器在相对机体坐标系下的位置坐标。
本发明采用以上技术方案与现有技术相比,具有以下技术效果:
本发明公开了一种用于跨域协同导航的导航信息源群优化交互方法,对待辅助载体和基准信息源之间的协同定位源选择进行了优化,使得待辅助载体与基准信息源间的测距及信息交互选择更加合理;考虑到导航信号源的构型和定位精度对定位结果的影响,综合利用集群定位信息优化提高了定位精度。和未采用优化的集群飞行器定位算法相比,本发明在不规则分布的集群中能有效提升协同定位效率和精度,适合实际应用。
附图说明
图1为本发明方法的原理流程示意图;
图2为位置误差椭圆E0整体图;
图3为位置误差椭球E0横剖面图;
图4为位置误差椭球E0纵剖面图;
图5集群飞行器位置分布图;
图6为采用本发明方法优化后和未优化的待辅助飞行器经纬高定位误差对比图;
图7为待辅助飞行器位置误差椭球轴长变化图;
图8为选中的信号源飞行器编号变化图。
具体实施方式
下面结合附图对本发明的技术方案做进一步的详细说明:
本发明可以以许多不同的形式实现,而不应当认为限于这里所述的实施例。相反,提供这些实施例以便使本公开透彻且完整,并且将向本领域技术人员充分表达本发明的范围。在附图中,为了清楚起见放大了组件。
本发明方法通过对集群飞行器中待辅助载体的协同定位信号源选择进行优化,使得待辅助载体与基准信息源间的测距及信息交互选择更加精确合理,从而综合利用集群定位信息优化提高定位精度,同时增强集群飞行器定位算法对于多种集群编组情况的适应性。
如图1所示,本发明公开了一种用于跨域协同导航的导航信息源群优化交互方法,包括以下步骤:
步骤A.1),获取飞行器集群定位导航所需的系统数据;
步骤A.2),如图2、图3、图4所示,根据待辅助飞行器滤波协方差矩阵计算当前位置的误差椭球E0;
步骤A.3),获取各基准信息源飞行器与待辅助飞行器之间相对方位角和相对距离;
步骤A.4),获取误差椭球E0最大轴长所在方向和信号源自身精度,选择最接近最大轴长方向的一架基准信息源飞行器作为基准信号源飞行器,进行辅助定位解算并对原先的位置进行修正,得到新的误差椭球E1;
步骤A.5),判断误差椭球E1最长轴的轴长L1大小是否已满足预设的阈值δ,若轴长L1>δ,令E0=E1、即将误差椭球E1作为误差椭球E0,跳转执行步骤4);若轴长L1<δ,输出当前辅助定位的位置信息。
步骤A.1)中所述的飞行器集群包含待辅助定位飞行器和n架基准信息源飞行器,基准信息源飞行器自身定位精度高于待辅助定位飞行器自身定位精度;获取飞行器集群定位导航所需系统测量数据时,如图5所示,首先获取n架基准信息源飞行器的导航系统信息、经纬高数据及卫星导航定位精度,然后获取待辅助定位飞行器的GPS及惯导组合导航数据、姿态角数据、卡尔曼滤波协方差矩阵、经纬高数据、纬度误差、经度误差、高度误差。
所述步骤A.2)包括如下具体步骤:
步骤A.2.1),利用卡尔曼滤波的协方差矩阵获得位置的协方差矩阵Ppos,定义如下:
步骤A.2.3),根据转换后的位置误差矢量Ep,进一步获取位置误差协方差矩阵Pp
Ep=[x y z]
步骤A.2.4),求对称协方差矩阵Pp的特征值λ1、λ2和λ3,进一步开方得到椭球的相应轴长:
其中,axisx、axisy、axisz分别为椭球E0的X轴、Y轴、Z轴方向的轴长;
所述步骤A.3)包括如下具体步骤:
步骤A.3.1),获得每个基准信息源飞行器和待辅助定位飞行器的相对距离;
步骤A.3.2),将所有飞行器的经度、纬度和高度坐标转换为地球坐标系坐标,RN为地球卯酉圈曲率半径,f为地球扁率,λi为第i个基准信息源飞行器的经度,Li为第i个基准信息源飞行器的纬度,Hi为的基准信息源飞行器的高度,为转换后第i个基准信息源飞行器的地球坐标系坐标,转换公式如下:
建立以待辅飞行器为坐标原点的相对坐标系,相对坐标系各坐标轴与ECEF坐标系坐标轴平行,X轴在赤道平面内与零度子午线相交,Z轴与地球自转轴平行,Y轴与X轴、Z轴构成右手直角坐标系,各基准信息源在相对坐标系下的位置坐标转换如下:
λ、L、H分别为待辅助飞行器的经度、纬度、高度,RN为卯酉圈半径,e为地球偏心率;
得到集群系统各基准信息源飞行器在以待辅助飞行器为坐标原点的相对机体坐标系上的坐标:
αi为各基准信息源飞行器与相对机体坐标系Y轴的夹角;βi为各基准信息源飞行器与相对机体坐标系Z轴的夹角;γi为各基准信息源飞行器与相对机体坐标系X轴的夹角;(x,y,z)为待辅助飞行器的相对机体坐标系下的坐标,为基准信息源飞行器在相对机体坐标系下的位置坐标。
所述步骤A.4)包括如下具体步骤:
步骤A.4.1),比较λ1、λ2和λ3的大小,确定误差椭球E0的最长轴;根据各基准信号源与以待辅助飞行器为坐标原点的相对机体坐标系各轴的夹角αi、βi、γi,选择与椭球E0最长轴方向最近的基准信息源飞行器作为信号源飞行器;
对相对距离进行分解,
步骤A.4.3),计算得到的辅助定位解算后的待辅助飞行器的位置坐标(x',y',z')和机载传感器位置坐标(x,y,z)差值,并将其作为观测量,通过卡尔曼滤波来对待辅助飞行器机导航位置误差进行修正,修正后得到新的卡尔曼滤波协方差矩阵,根据新的协方差矩阵解算得到新的椭球E1。
本发明还公开了另一种用于跨域协同导航的导航信息源群优化交互方法,包括以下步骤:
步骤B.1),获取飞行器集群定位导航所需的传感器测量数据;
步骤B.2),根据待辅助飞行器卡尔曼滤波协方差矩阵计算当前位置的误差椭球E0;
步骤B.3),获取各基准信息源飞行器与待辅助飞行器之间相对方位角和相对距离;
步骤B.4),比较误差椭球E0三个方向的轴长大小,选择与最大轴长方向夹角最小的两个基准信息源飞行器作为主信号源飞行器,然后在剩余两个轴长方向,各选择一个与相应轴长方向夹角最小的基准信息源飞行器作为次信号源;当出现几架基准信息源飞行器与同一轴长方向夹角相近的情况,优先选择自身定位精度因子高的基准信息源飞行器作为信号源飞行器;
步骤B.5),选择任一主信号源作为主基准信息源,建立以主基准信息源为坐标原点的相对坐标系,得到其余信号源飞行器在相对坐标系下的位置坐标及距离差数据,然后根据TDOA模型,选择球面内插法进行解算得到相对坐标系解算结果和解算误差,并通过卡尔曼滤波对待辅助飞行器位置坐标进行修正。
步骤B.1)中所述的飞行器集群包含待辅助定位飞行器和n架基准信息源飞行器,基准信息源飞行器自身定位精度高于待辅助定位飞行器自身定位精度;获取飞行器集群定位导航所需系统测量数据时,首先获取n架基准信息源飞行器的导航系统信息、经纬高数据及卫星导航定位精度,然后获取待辅助定位飞行器的GPS及惯导组合导航数据、姿态角数据、卡尔曼滤波协方差矩阵、经纬高数据、纬度误差、经度误差、高度误差。
所述步骤B.2)包括如下具体步骤:
步骤B.2.1),利用卡尔曼滤波的协方差矩阵获得位置的协方差矩阵Ppos,定义如下:
步骤B.2.3),根据转换后的位置误差矢量Ep,进一步获取位置误差协方差矩阵Pp
Ep=[x y z]
步骤B.2.4),求对称协方差矩阵Pp的特征值λ1、λ2和λ3,进一步开方得到椭球的相应轴长:
其中,axisx、axisy、axisz分别为椭球E0的X轴、Y轴、Z轴方向的轴长;
所述步骤B.3)包括如下具体步骤:
步骤B.3.1),获得每个基准信息源飞行器和待辅助定位飞行器的相对距离;
步骤B.3.2),将所有飞行器的经度、纬度和高度坐标转换为地球坐标系坐标,RN为地球卯酉圈曲率半径,f为地球扁率,λi为第i个基准信息源飞行器的经度,Li为第i个基准信息源飞行器的纬度,Hi为的基准信息源飞行器的高度,为转换后第i个基准信息源飞行器的地球坐标系坐标,转换公式如下:
建立以待辅飞行器为坐标原点的相对坐标系,相对坐标系各坐标轴与ECEF坐标系坐标轴平行,X轴在赤道平面内与零度子午线相交,Z轴与地球自转轴平行,Y轴与X轴、Z轴构成右手直角坐标系,各基准信息源在相对坐标系下的位置坐标转换如下:
λ、L、H分别为待辅助飞行器的经度、纬度、高度,RN为卯酉圈半径,e为地球偏心率;
得到集群系统各基准信息源飞行器在以待辅助飞行器为坐标原点的相对机体坐标系上的坐标:
αi为各基准信息源飞行器与相对机体坐标系Y轴的夹角;βi为各基准信息源飞行器与相对机体坐标系Z轴的夹角;γi为各基准信息源飞行器与相对机体坐标系X轴的夹角;(x,y,z)为待辅助飞行器的相对机体坐标系下的坐标,为基准信息源飞行器在相对机体坐标系下的位置坐标。
为了验证本发明所提出的一种用于跨域协同导航的导航信息源群优化交互方法的有效性,进行模拟仿真分析。如图6所示,仿真结果,经过信号源选择优化后,集群飞行器协同定位精度基本优于随机选取信号源进行定位的情况。如图7所示,为待辅助飞行器位置误差椭球轴长变化情况;如图8所示,为选中的信号源飞行器编号变化情况。
本技术领域技术人员可以理解的是,除非另外定义,这里使用的所有术语(包括技术术语和科学术语)具有与本发明所属领域中的普通技术人员的一般理解相同的意义。还应该理解的是,诸如通用字典中定义的那些术语应该被理解为具有与现有技术的上下文中的意义一致的意义,并且除非像这里一样定义,不会用理想化或过于正式的含义来解释。
以上所述的具体实施方式,对本发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施方式而已,并不用于限制本发明,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (9)
1.一种用于跨域协同导航的导航信息源群优化交互方法,其特征在于,包括以下步骤:
步骤A.1),获取飞行器集群定位导航所需的系统数据;
步骤A.2),根据待辅助飞行器滤波协方差矩阵计算当前位置的误差椭球E0;
步骤A.3),获取各基准信息源飞行器与待辅助飞行器之间相对方位角和相对距离;
步骤A.4),获取误差椭球E0最大轴长所在方向和信号源自身精度,选择最接近最大轴长方向的一架基准信息源飞行器作为基准信号源飞行器,进行辅助定位解算并对原先的位置进行修正,得到新的误差椭球E1;
步骤A.5),判断误差椭球E1最长轴的轴长L1大小是否已满足预设的阈值δ,若轴长L1>δ,令E0=E1、即将误差椭球E1作为误差椭球E0,跳转执行步骤4);若轴长L1<δ,输出当前辅助定位的位置信息。
2.根据权利要求1所述的用于跨域协同导航的导航信息源群优化交互方法,其特征在于,步骤A.1)中所述的飞行器集群包含待辅助定位飞行器和n架基准信息源飞行器,基准信息源飞行器自身定位精度高于待辅助定位飞行器自身定位精度;获取飞行器集群定位导航所需系统测量数据时,首先获取n架基准信息源飞行器的导航系统信息、经纬高数据及卫星导航定位精度,然后获取待辅助定位飞行器的GPS及惯导组合导航数据、姿态角数据、卡尔曼滤波协方差矩阵、经纬高数据、纬度误差、经度误差、高度误差。
3.根据权利要求2所述的用于跨域协同导航的导航信息源群优化交互方法,其特征在于,所述步骤A.2)包括如下具体步骤:
步骤A.2.1),利用卡尔曼滤波的协方差矩阵获得位置的协方差矩阵Ppos,定义如下:
步骤A.2.3),根据转换后的位置误差矢量Ep,进一步获取位置误差协方差矩阵Pp
Ep=[x y z]
步骤A.2.4),求对称协方差矩阵Pp的特征值λ1、λ2和λ3,进一步开方得到椭球的相应轴长:
其中,axisx、axisy、axisz分别为椭球E0的X轴、Y轴、Z轴方向的轴长。
4.根据权利要求3所述的用于跨域协同导航的导航信息源群优化交互方法,其特征在于,所述步骤A.3)包括如下具体步骤:
步骤A.3.1),获得每个基准信息源飞行器和待辅助定位飞行器的相对距离;
步骤A.3.2),将所有飞行器的经度、纬度和高度坐标转换为地球坐标系坐标,RN为地球卯酉圈曲率半径,f为地球扁率,λi为第i个基准信息源飞行器的经度,Li为第i个基准信息源飞行器的纬度,Hi为的基准信息源飞行器的高度,为转换后第i个基准信息源飞行器的地球坐标系坐标,转换公式如下:
建立以待辅飞行器为坐标原点的相对坐标系,相对坐标系各坐标轴与ECEF坐标系坐标轴平行,X轴在赤道平面内与零度子午线相交,Z轴与地球自转轴平行,Y轴与X轴、Z轴构成右手直角坐标系,各基准信息源在相对坐标系下的位置坐标转换如下:
λ、L、H分别为待辅助飞行器的经度、纬度、高度,RN为卯酉圈半径,e为地球偏心率;
得到集群系统各基准信息源飞行器在以待辅助飞行器为坐标原点的相对机体坐标系上的坐标:
5.根据权利要求4所述的用于跨域协同导航的导航信息源群优化交互方法,其特征在于,所述步骤A.4)包括如下具体步骤:
步骤A.4.1),比较λ1、λ2和λ3的大小,确定误差椭球E0的最长轴,根据各基准信号源与以待辅助飞行器为坐标原点的相对机体坐标系各轴的夹角αi、βi、γi,选择与椭球E0最长轴方向最近的基准信息源飞行器作为信号源飞行器;
对相对距离进行分解:
步骤A.4.3),计算得到的辅助定位解算后的待辅助飞行器的位置坐标(x',y',z')和机载传感器位置坐标(x,y,z)差值,并将其作为观测量,通过卡尔曼滤波来对待辅助飞行器机导航位置误差进行修正,修正后得到新的卡尔曼滤波协方差矩阵,根据新的协方差矩阵解算得到新的椭球E1。
6.一种用于跨域协同导航的导航信息源群优化交互方法,其特征在于,包括以下步骤:
步骤B.1),获取飞行器集群定位导航所需的传感器测量数据;
步骤B.2),根据待辅助飞行器卡尔曼滤波协方差矩阵计算当前位置的误差椭球E0;
步骤B.3),获取各基准信息源飞行器与待辅助飞行器之间相对方位角和相对距离;
步骤B.4),比较误差椭球E0三个方向的轴长大小,选择与最大轴长方向夹角最小的两个基准信息源飞行器作为主信号源飞行器,然后在剩余两个轴长方向,各选择一个与相应轴长方向夹角最小的基准信息源飞行器作为次信号源;当出现几架基准信息源飞行器与同一轴长方向夹角相近的情况,优先选择自身定位精度因子高的基准信息源飞行器作为信号源飞行器;
步骤B.5),选择任一主信号源作为主基准信息源,建立以主基准信息源为坐标原点的相对坐标系,得到其余信号源飞行器在相对坐标系下的位置坐标及距离差数据,然后根据TDOA模型,选择球面内插法进行解算得到相对坐标系解算结果和解算误差,并通过卡尔曼滤波对待辅助飞行器位置坐标进行修正。
7.根据权利要求6所述的用于跨域协同导航的导航信息源群优化交互方法,其特征在于,步骤B.1)中所述的飞行器集群包含待辅助定位飞行器和n架基准信息源飞行器,基准信息源飞行器自身定位精度高于待辅助定位飞行器自身定位精度;获取飞行器集群定位导航所需系统测量数据时,首先获取n架基准信息源飞行器的导航系统信息、经纬高数据及卫星导航定位精度,然后获取待辅助定位飞行器的GPS及惯导组合导航数据、姿态角数据、卡尔曼滤波协方差矩阵、经纬高数据、纬度误差、经度误差、高度误差。
8.根据权利要求7所述的用于跨域协同导航的导航信息源群优化交互方法,其特征在于,所述步骤B.2)包括如下具体步骤:
步骤B.2.1),利用卡尔曼滤波的协方差矩阵获得位置的协方差矩阵Ppos,定义如下:
步骤B.2.3),根据转换后的位置误差矢量Ep,进一步获取位置误差协方差矩阵Pp
Ep=[x y z]
步骤B.2.4),求对称协方差矩阵Pp的特征值λ1、λ2和λ3,进一步开方得到椭球的相应轴长:
其中,axisx、axisy、axisz分别为椭球E0的X轴、Y轴、Z轴方向的轴长;
9.根据权利要求8所述的用于跨域协同导航的导航信息源群优化交互方法,其特征在于,所述步骤B.3)包括如下具体步骤:
步骤B.3.1),获得每个基准信息源飞行器与待辅助定位飞行器的相对距离;
步骤B.3.2),将所有飞行器的经度、纬度和高度坐标转换为地球坐标系坐标,RN为地球卯酉圈曲率半径,f为地球扁率,λi为第i个基准信息源飞行器的经度,Li为第i个基准信息源飞行器的纬度,Hi为的基准信息源飞行器的高度,为转换后第i个基准信息源飞行器的地球坐标系坐标,转换公式如下:
建立以待辅飞行器为坐标原点的相对坐标系,相对坐标系各坐标轴与ECEF坐标系坐标轴平行,X轴在赤道平面内与零度子午线相交,Z轴与地球自转轴平行,Y轴与X轴、Z轴构成右手直角坐标系,各基准信息源在相对坐标系下的位置坐标转换如下:
λ、L、H分别为待辅助飞行器的经度、纬度、高度,RN为卯酉圈半径,e为地球偏心率;
得到集群系统各基准信息源飞行器在以待辅助飞行器为坐标原点的相对机体坐标系上的坐标:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210805370.7A CN116206490A (zh) | 2022-07-08 | 2022-07-08 | 一种用于跨域协同导航的导航信息源群优化交互方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210805370.7A CN116206490A (zh) | 2022-07-08 | 2022-07-08 | 一种用于跨域协同导航的导航信息源群优化交互方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN116206490A true CN116206490A (zh) | 2023-06-02 |
Family
ID=86506570
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210805370.7A Pending CN116206490A (zh) | 2022-07-08 | 2022-07-08 | 一种用于跨域协同导航的导航信息源群优化交互方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116206490A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117082617A (zh) * | 2023-08-17 | 2023-11-17 | 北京慧清科技有限公司 | 一种不依赖高精度位置基准的相对定位方法 |
CN117082617B (zh) * | 2023-08-17 | 2024-06-07 | 北京慧清科技有限公司 | 一种不依赖高精度位置基准的相对定位方法 |
-
2022
- 2022-07-08 CN CN202210805370.7A patent/CN116206490A/zh active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117082617A (zh) * | 2023-08-17 | 2023-11-17 | 北京慧清科技有限公司 | 一种不依赖高精度位置基准的相对定位方法 |
CN117082617B (zh) * | 2023-08-17 | 2024-06-07 | 北京慧清科技有限公司 | 一种不依赖高精度位置基准的相对定位方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107990821B (zh) | 一种桥梁形变监测方法、存储介质及桥梁形变监测接收机 | |
WO2009152262A1 (en) | Method for geofencing | |
US10422882B1 (en) | ARAIM subset selection method and system based on BeiDou constellation | |
CN108681617B (zh) | 一种航天器多星敏感器布局优化设计方法 | |
CN113466903B (zh) | 一种顾及观测值系统误差的部分模糊度固定算法 | |
CN110031001B (zh) | 一种重力辅助惯性导航的适配区选取方法 | |
CN110243377A (zh) | 一种基于分层式结构的集群飞行器协同导航方法 | |
CN112230247A (zh) | 一种用于城市复杂环境下gnss完好性监测方法 | |
CN113189541B (zh) | 一种定位方法、装置及设备 | |
CN102052925A (zh) | 基于空间关系约束的适配区景象匹配方法 | |
CN116206490A (zh) | 一种用于跨域协同导航的导航信息源群优化交互方法 | |
CN109001770A (zh) | 多模卫星导航系统用户层几何精度因子最小值计算方法 | |
CN115793002A (zh) | 基于测向误差权重的双星联合无源定位方法 | |
CN112463899A (zh) | 一种车辆轨迹点纠偏方法、系统、服务器和存储介质 | |
CN117452333A (zh) | 一种基于双测量站的方位时差组合的定位方法 | |
CN103837130B (zh) | 用于机载激光扫描系统的数据处理方法及装置 | |
CN116089784A (zh) | 一种基于云计算的数据挖掘实现方法 | |
CN113375626B (zh) | 一种基于惯性装置的空间矢量相对平行度测量方法 | |
CN113503891B (zh) | 一种sinsdvl对准校正方法、系统、介质及设备 | |
CN110987023B (zh) | 一种惯性导航动态对准方法 | |
CN109738928B (zh) | 空间脉管包络分布式三维目标的卫星成像路径规划方法 | |
CN113465616A (zh) | 轨迹异常点检测方法和装置、电子设备、计算机程序产品及计算机可读存储介质 | |
Kim et al. | Optimal configuration based on lever arm effect rejection performance index for redundant inertial sensors | |
CN114608578B (zh) | 一种加权不确定性无人机集群协同导航方法 | |
CN116401618B (zh) | 基于几何分布采样的跨域无人集群协同导航信息融合方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |