CN111007460B - 直升机协同定位方法 - Google Patents
直升机协同定位方法 Download PDFInfo
- Publication number
- CN111007460B CN111007460B CN201911267236.0A CN201911267236A CN111007460B CN 111007460 B CN111007460 B CN 111007460B CN 201911267236 A CN201911267236 A CN 201911267236A CN 111007460 B CN111007460 B CN 111007460B
- Authority
- CN
- China
- Prior art keywords
- helicopter
- target
- positioning
- ground
- measurement
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 37
- 238000005259 measurement Methods 0.000 claims abstract description 60
- 238000002922 simulated annealing Methods 0.000 claims abstract description 26
- 230000006870 function Effects 0.000 claims abstract description 25
- 238000011084 recovery Methods 0.000 claims abstract description 20
- 238000005457 optimization Methods 0.000 claims abstract description 17
- 238000012545 processing Methods 0.000 claims abstract description 10
- 239000013598 vector Substances 0.000 claims description 55
- 239000011159 matrix material Substances 0.000 claims description 18
- 238000004364 calculation method Methods 0.000 claims description 4
- 238000000137 annealing Methods 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000009827 uniform distribution Methods 0.000 claims description 3
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 claims description 2
- 238000005516 engineering process Methods 0.000 abstract description 15
- 230000008569 process Effects 0.000 abstract description 8
- 230000007547 defect Effects 0.000 abstract description 3
- 230000008901 benefit Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 230000002411 adverse Effects 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000903 blocking effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000009826 distribution Methods 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000005693 optoelectronics Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- 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
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0278—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves involving statistical or probabilistic considerations
-
- 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
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/14—Determining absolute distances from a plurality of spaced points of known location
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Probability & Statistics with Applications (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
一种直升机协同定位方法，包括如下步骤：步骤1：对设定的定位区域进行离散处理；步骤2：部署直升机，预设测量节点并采集定位信息；步骤3：建立有源字典；步骤4：用基于稀疏贝叶斯学习的压缩感知恢复算法估计目标位置；步骤5：利用模拟退火算法进行直升机航迹规划并重新采集定位信息；步骤6：重复执行步骤3到步骤5，取预定时限内最终迭代结果为目标定位结果。结合其它结构或方法有效避免了现有技术中直升机飞行时使得测量距离的扩大会使压缩感知定位技术的定位性能急剧下降、在实际应用中无法进行精确定位、在直升机定位信息采集的过程中难以选取目标函数来有效利用模拟退火算法进行优化以确定飞行航迹的缺陷。
Description
技术领域
本发明涉及直升机协同技术领域，也涉及定位技术领域，具体涉及一种直升机协同定位方法，尤其涉及一种基于压缩感知的直升机协同定位方法。
背景技术
直升机作为20世纪航空技术极具特色的创造之一，极大的拓展了飞行器的应用范围。直升机是典型的军民两用产品，可以广泛的应用在运输、巡逻、旅游、救护等多个领域。随着无线通信和物联网技术的快速进步，用户对位置服务的需求日益增加，而目标位置信息的获取是后续提供基于位置服务的关键所在，这样直升机凭借其灵活机动，成本低廉，使用便捷等优势在对地面目标定位领域扮演愈发重要的角色。不同于现有固定传感器网络，以直升机作为传感平台可以实时调整感应位置，具有更高的灵活性。现有的直升机对地面目标定位技术主要依赖光电设备获取图像，利用摄影测量、图像处理和信息处理等技术处理与分析，最终得到目标的精确坐标。然而，许多恶劣的视野条件，如夜晚，阴雨天气，障碍物的遮挡及目标与环境温差不明显(对于红外传感来说)等，均会对光电设备的信息采集造成困扰进而无法完成定位。
基于直升机无线传感器网络的协同定位技术利用目标发出的无线信号估算目标位置，可以在不良视野条件下实现定位，且信号强度传感设备较光电传感设备具有简单，廉价，不易损坏等优势。当前，直升机对地面目标定位得到学术界广泛关注和研究。将压缩感知技术用于直升机对地面目标进行定位能有效减少信息的采集量，在实际应用中具有重要意义，其基本原理是：目标的位置信息在定位区域中具备稀疏性，可转化为高维稀疏向量。通过观测矩阵可以采集低维的位置信息，然后利用压缩感知恢复算法估计以上提及的高维稀疏向量从而得到最终的位置信息。
在实际的直升机对地面目标定位过程中，可通过模拟退火算法对直升机的飞行航迹进行规划，从而发挥出直升机灵活机动的优势，有力促进对位置向量的恢复并有效提高定位精度。然而，现有的压缩感知定位技术还没有在较大范围的直升机的飞行轨迹所形成的三维空域中有效应用，这样就需要将压缩感知定位技术与基于模拟退火算法的直升机飞行轨迹规划所形成的三维空域相结合，提出一种有效的应用于三维空域的基于压缩感知的直升机协同定位方法。而目前要实现该定位方法，主要面临如下亟需解决的问题：
(1)在室外三维空间中，直升机飞行时使得测量距离的扩大会使压缩感知定位技术的定位性能急剧下降，从而在实际应用中无法进行精确定位。
(2)在直升机定位信息采集的过程中，难以选取目标函数来有效利用模拟退火算法进行优化以确定飞行航迹。
发明内容
为解决上述问题，本发明提供了一种直升机协同定位方法，有效避免了现有技术中直升机飞行时使得测量距离的扩大会使压缩感知定位技术的定位性能急剧下降、在实际应用中无法进行精确定位、在直升机定位信息采集的过程中难以选取目标函数来有效利用模拟退火算法进行优化以确定飞行航迹的缺陷。
为了克服现有技术中的不足，本发明提供了一种直升机协同定位方法的解决方案，具体如下：
一种直升机协同定位方法，包括如下步骤：
步骤1：对设定的定位区域进行离散处理；
步骤2：部署直升机，预设测量节点并采集定位信息；
步骤3：建立有源字典；
步骤4：用基于稀疏贝叶斯学习的压缩感知恢复算法估计目标位置；
步骤5：利用模拟退火算法进行直升机航迹规划并重新采集定位信息；
步骤6：重复执行步骤3到步骤5，取预定时限内最终迭代结果为目标定位结果。
所述对设定的定位区域进行离散处理，包括：
将所述定位区域划分为N个大小相同的矩形格点，若某个矩形格点内含有地面目标，只能有且只能有一个地面目标；并按顺序编号，即N个大小相同的矩形格点的编号分别为1,2,3,…,n,…,N；用N维稀疏向量θN×1表征T个地面目标的位置矩阵，所述T个地面目标的位置矩阵为P(x1,x2,...,xT；y1,y2,...,yT)，若第k个区域格点中含有地面目标，则令该区域格点中的该地面目标的直角坐标系坐标为该格点中心坐标(xk,yk)，并令N维稀疏向量θN×1中的第k个分量θk＝1，否则θk＝0；因此就有||θ||0＝T并假设θ的支撑集为Ω；这里N、T均为正整数且N>>T，n为小于或等于N的正整数，k为小于或等于N的正整数。
所述部署直升机，预设测量节点并采集定位信息的方式，包括：
在所述定位区域的上空部署载有信号强度传感器的直升机，所述直升机的信号强度传感器用于在各测量节点测量地面目标发出信号的信号强度RSS，以此能基于各测量节点的信号强度RSS的强弱差异估计地面目标位置；所述直升机的初始位置均匀部署在所述定位区域的边界上，所述直升机数量为S，则直升机初始位置矩阵为U0＝(x1,x2,...,xS；y1,y2,...,yS；z1,z2,...,zS)，其中S为不小于二的正整数，这里xt、yt和zt分别表示第t个直升机的初始位置的x坐标、第t个直升机的初始位置的y坐标和第t个直升机的初始位置的z坐标；各直升机的初始水平飞行的方向角向量为Γ0＝(γ1,γ2,...,γS)，这里γt表示第t个直升机的水平飞行的方向角，t为小于或等于S的正整数；然而为了将压缩感知理论应用到对地目标定位中，所述测量节点的数量M需满足公式(1)的条件：
M≥Tlog(N/T) (1)
其中M<<N,由于实际应用中调用直升机的数量有限，通常并不足以满足一架直升机建立一个测量节点的设想，故考虑在各直升机完成一次定位测量的飞行航迹上设置C个测量节点，由此构建起M＝S*C个测量节点，并使得M≥Tlog(N/T)，其中M为正整数；于是定位区域内部所有地面目标在第m个测量节点上的信号强度RSS的叠加Sm为公式(2)所示：
其中，φm,k表示当第k个区域格点中存在地面目标时在第m个测量节点上的发送的信息的信号强度RSS；令M维测量向量yM×1表征在各测量节点实际测得的接收信号强度，其第m个分量为Sm，其中m为正整数，由公式(3)可知测量向量y可表示为：
y＝Φθ+ε (3)
其中，Φ为有源字典，φm,n为Φ中第m行，第n列元素，ε表示测量噪声，这里m为正整数；由公式(3)可看出，测量向量y的维数M小于目标位置向量θ维数N。
所述建立有源字典，包括：
根据无线信号自由空间传播模型计算φm,k的值，从而建立有源字典Φ，具体包括：
根据无线信号的自由空间传播模型，当地面目标处于第k个区域格点中时,在第m个测量节点上的信号接收功率Pm,k为公式(4)所示：
其中dm,k表示第k个区域格点中的地面目标到预设的第m个测量节点的距离，λ为地面目标发送的无线信号的波长，Pt为地面目标的信号发射功率大小，此时信号强度φm,k为公式(5)所示：
φm,k＝Pm,k (5)
所有所述信号强度φm,k的集合就形成了有源字典Φ。
这样，地面目标位置估计问题可转化为如公式(6)所示的稀疏向量恢复问题：
由此得到的目标位置向量为
所述用基于稀疏贝叶斯学习的压缩感知恢复算法估计目标位置，包括：
使用设定的稀疏阈值ηt来滤除这些取值微小的非零分量从而消除其对目标估计结果的影响，即目标位置向量的支撑集估计
如公式(7)所示：
，其中，i为正整数，获得目标位置向的支撑集后，地面目标的坐标可如公式(8)估计如下：
从而可以得到所有T个地面目标的首次估计坐标为
这里xh和yh分别为第h个地面目标位置首次估计的x坐标和y坐标。
所述利用模拟退火算法进行直升机航迹规划并重新采集定位信息，包括：
首先，需要确定模拟退火算法针对的优化目标函数f，由设立的无线信号的自由空间传播模型可知，在每个测量节点上收集到的地面目标发送的无线信号的信号强度
其中d表示该测量节点和该地面目标之间的距离，在第m个测量节点收集到的信号强度的叠加Sm为公式(9)所示：
其中dm,t为第m个测量节点与第t个地面目标之间的距离,该距离由公式(10)可得：
这里，xm、ym和zm分别为第m个测量节点的x坐标、y坐标和z坐标，xt和yt分别为第t个地面目标的x坐标和y坐标，m、t均为正整数；因此，将优化目标函数f设定为公式(11)所示：
则可以根据直升机初始位置矩阵U与初始水平方向角向量Γ来确定目标函数值f(U,Γ)，其中第m个测量节点的坐标表示为：
V表示直升机飞行速度，Δt为直升机飞行经过相邻测量节点所用时间，将直升机的初始位置U0＝(x1,x2,...,xS；y1,y2,...,yS；z1,z2,...,zS)代入优化目标函数f中可得模拟退火算法的初始目标函数值为f(U0,Γ0)，并随后用前一次S架直升机结束测量时的位置更新初始位置矩阵，并令其为U1；
而扰动模型设立为：所有直升机飞行高度保持不变，对第s个直升机的水平飞行方向γs加上一个Δγs的随机扰动，Δγs服从[0,2π]内的均匀分布，而s＝1,2,...,S，此时新的状态Γ1＝Γ0+ΔΓ，第m个测量节点的坐标表示为公式(13)所示：
新状态下目标函数值为f(U1,Γ1)。
根据Metropolis准则,在温度T下，若f(U1,Γ1)＜f(U0,Γ0)，则接受新状态(U1,Γ1)，否则，若概率P满足公式(14)的条件：
P＝exp{-[f(U1,Γ1)-f(U0,Γ0)]/KT}＞rand (14)
其中K为给定常数，rand为0到1范围内的随机数，则仍接受(U1,Γ1)为当前状态，若概率P不满足公式(14)的条件，则保留状态(U0,Γ0)为当前状态。且退火计划T(k)设定为公式(15)所示:
其中T0为初始温度，α为温度衰减率，α的选择范围为0.7≤α≤1，k为正整数且为迭代次数，N为待反演参数的个数，在实际应用中N可选择1或2。
所述重复执行步骤3到步骤5，取预定时限内最终迭代结果为目标定位结果的方法，包括：
所述迭代终止的两个条件设立为如下所示：
1.最多允许以上循环迭代设定的Q次，这里Q为正整数；
2.若在迭代次数小于Q的某次循环中出现以下情况：优化结果的目标值
f(U,Γ)＞f(U0,Γ0)，说明直升机群已部署至较理想的位置，不需进行位置变换，因而舍弃本次优化结果并终止迭代；
最终，取最后一次迭代结果，即最后一次利用基于稀疏贝叶斯学习的压缩感知算法恢复的估计目标位置，作为最终估计目标位置
本发明的有益效果为：
在直升机收集地面目标的定位信息的过程中，利用模拟退火算法进行航迹规划，从而促进压缩感知定位方法性能的提升，另外本发明方法设计了一种多直升机协同探测地面目标信号的方法，能克服距离的扩大对压缩感知定位技术性能的不良影响，并选取了各观测点测得的接收信号强度(Received Signal Strength,RSS)的总和作为目标函数，利用模拟退火算法对其进行优化，从而确定直升机飞行轨迹。
附图说明
图1为本发明的直升机对地面目标协同定位基本场景图；
图2为本发明的有源字典建立数据测量图；
图3为本发明的模拟退火算法流程图；
图4为不同大小定位区域中本发明提出的方案(CS-SA)与现有的固定测量节点定位方案(FMN)的定位精度对比图；
图5为不同信噪比条件下本发明提出的方案(CS-SA)与现有的固定测量节点定位方案(FMN)的定位精度对比图。
具体实施方式
下面将结合附图和实施例对本发明做进一步地说明。
如图1-图5所示，直升机协同定位方法，直升机用基于压缩感知方式对地面T个目标的定位过程中，为了产生满足空间稀疏性的目标位置向量，首先需要将设定的定位区域划分为N个大小相同的矩形格点，于是目标在整个定位区域的分布可用一个N维的向量来表示：对于目标所在的格点，其中心点即视为目标位置，并在N维向量中对应位置设为1，其余位置置0，这里N、T均为正整数且N>>T；由于格点数N远大于目标数T，所以表征目标位置信息的N维向量是稀疏的，从而，直升机对地面目标的定位问题可转化为稀疏向量的恢复问题。为恢复该稀疏向量，就需要通过直升机在定位区域上空测量获得接收信号的强度信息，感知目标与直升机间相对位置变化对信号强度产生的影响，而后根据测量信号的强度信息和有源字典，通过压缩感知恢复算法估计目标位置向量。同时，为消除直升机飞行距离扩大对压缩感知恢复算法性能的影响，将当前估计目标位置作为实际目标位置，利用模拟退火算法对下一步飞行轨迹进行规划，随后利用直升机下一次飞行重新测量的信息得到新的估计位置，如此循环迭代，最终在规定的时间内恢复出较精确的目标位置向量；由此，所述直升机协同定位方法包括如下步骤：
步骤1：对设定的定位区域进行离散处理；
所述对设定的定位区域进行离散处理，包括：
设定的定位区域为包含有待定位的地面目标的区域，所述地面目标所在的定位区域各点位置坐标是连续变化的，然而压缩感知理论针对的是离散信号。为了将压缩感知理论应用到直升机对地面目标的协同定位中，就要对定位区域进行离散处理，即将所述定位区域划分为N个大小相同的矩形格点，若某个矩形格点内含有地面目标，只能有且只能有一个地面目标；并按顺序编号，即N个大小相同的矩形格点的编号分别为1,2,3,…,n,…,N；用N维稀疏向量θN×1表征T个地面目标的位置矩阵，所述N维稀疏向量θN×1能够简称为θ；所述T个地面目标的位置矩阵为P(x1,x2,...,xT；y1,y2,...,yT)，若第k个区域格点中含有地面目标，则令该区域格点中的该地面目标的直角坐标系坐标为该格点中心坐标(xk,yk)，并令N维稀疏向量θN×1中的第k个分量θk＝1，否则θk＝0；因此就有||θ||0＝T并假设θ的支撑集为Ω；这里N、T均为正整数且N>>T，n为小于或等于N的正整数，k为小于或等于N的正整数。在地面目标的位置上设置有发送无线信号的无线发射器。
步骤2：部署直升机，预设测量节点并采集定位信息；
所述部署直升机，预设测量节点并采集定位信息的方式，包括：
所述直升机对地面目标协同定位的基本场景图如图1所示，定位区域中随机分布有T个地面目标。为了估计地面目标位置，需在所述定位区域的上空部署载有信号强度传感器的直升机，所述直升机的信号强度传感器用于在各测量节点测量地面目标发出信号的信号强度RSS，以此能基于各测量节点的信号强度RSS的强弱差异估计地面目标位置；为更好地覆盖定位区域，所述直升机的初始位置均匀部署在所述定位区域的边界上，假设所述直升机数量为S，则直升机初始位置矩阵为U0＝(x1,x2,...,xS；y1,y2,...,yS；z1,z2,...,zS)，其中S为不小于二的正整数，这里xt、yt和zt分别表示第t个直升机的初始位置的x坐标、第t个直升机的初始位置的y坐标和第t个直升机的初始位置的z坐标；并令各直升机的初始水平飞行的方向角向量为Γ0＝(γ1,γ2,...,γS)，这里γt表示第t个直升机的水平飞行的方向角，t为小于或等于S的正整数；然而为了将压缩感知理论应用到对地目标定位中，所述测量节点为无线测量节点，无线测量节点的数量M需满足公式(1)的条件：
M≥Tlog(N/T) (1)
其中M<<N,由于实际应用中调用直升机的数量有限，通常并不足以满足一架直升机建立一个测量节点的设想，故考虑在各直升机完成一次定位测量的飞行航迹上设置C个无线测量节点，由此构建起M＝S*C个无线测量节点，并使得M≥Tlog(N/T)，其中M为正整数；于是定位区域内部所有地面目标在第m个测量节点上的信号强度RSS的叠加Sm为公式(2)所示：
其中，φm,k表示当第k个区域格点中存在地面目标时在第m个测量节点上的发送的信息的信号强度RSS；令M维测量向量yM×1表征在各测量节点实际测得的接收信号强度，其第m个分量为Sm，其中m为正整数，由公式(3)可知测量向量y可表示为：
y＝Φθ+ε (3)
其中，Φ为有源字典，φm,n为Φ中第m行，第n列元素，ε表示测量噪声，这里m为正整数；由公式(3)可看出，测量向量y的维数M小于目标位置向量θ维数N，利用压缩感知理论可通过采集少量的测量信息就可实现对地面目标位置信息的恢复。
步骤3：建立有源字典；
所述建立有源字典，包括：
如图2所示，当地面目标处于定位区域内的不同区域格点时，对各个测量节点所造成的影响大小不同。本发明根据无线信号自由空间传播模型计算φm,k的值，从而建立有源字典Φ，具体包括：
根据无线信号的自由空间传播模型，当地面目标处于第k个区域格点中时,在第m个测量节点上的信号接收功率Pm,k为公式(4)所示：
其中dm,k表示第k个区域格点中的地面目标到预设的第m个测量节点的距离，λ为地面目标发送的无线信号的波长，Pt为地面目标的信号发射功率大小，此时信号强度φm,k为公式(5)所示：
φm,k＝Pm,k (5)
所有所述信号强度φm,k的集合就形成了有源字典Φ。
这样，地面目标位置估计问题可转化为如公式(6)所示的稀疏向量恢复问题：
由此得到的目标位置向量为
步骤4：用基于稀疏贝叶斯学习的压缩感知恢复算法估计目标位置；
所述用基于稀疏贝叶斯学习的压缩感知恢复算法估计目标位置，包括：
本发明利用稀疏贝叶斯学习的压缩感知恢复算法恢复稀疏目标向量。相比于传统的基于稀疏松弛优化的恢复算法和基于贪婪迭代的恢复算法，该方法估计目标位置向量能取得更高的精度。
通常，上述恢复算法得出的目标位置向量
与θ相比，除少数分量取值较大外还含有许多取值微小的非零分量。本发明使用设定的稀疏阈值ηt来滤除这些取值微小的非零分量从而消除其对目标估计结果的影响，即目标位置向量的支撑集估计
如公式(7)所示：
，其中，i为正整数，获得目标位置向的支撑集后，地面目标的坐标可如公式(8)估计如下：
从而可以得到所有T个地面目标的首次估计坐标为
这里xh和yh分别为第h个地面目标位置首次估计的x坐标和y坐标。
步骤5：利用模拟退火算法进行直升机航迹规划并重新采集定位信息；
所述利用模拟退火算法进行直升机航迹规划并重新采集定位信息，包括：
得到所有T个地面目标的首次估计坐标后，为克服所述定位区域范围过大对定位效果的影响，本发明根据已有目标估计坐标，利用模拟退火算法对直升机航迹进行规划，为下一步信号测量与稀疏向量恢复做准备。本发明中模拟退火算法的流程图如图3所示，由此可知模拟退火算法由一个外循环加上一个内循环构成，外循环由逐渐下降的温度与收敛条件共同控制，内循环中则是在同一温度下进行多次扰动产生不同的新状态，并按照Metropolis准则接受新状态。
首先，需要确定模拟退火算法针对的优化目标函数f，由本发明中设立的无线信号的自由空间传播模型可知，在每个测量节点上收集到的地面目标发送的无线信号的信号强度
其中d表示该测量节点和该地面目标之间的距离，在第m个测量节点收集到的信号强度的叠加Sm为公式(9)所示：
其中dm,t为第m个测量节点与第t个地面目标之间的距离,该距离由公式(10)可得：
这里，xm、ym和zm分别为第m个测量节点的x坐标、y坐标和z坐标，xt和yt分别为第t个地面目标的x坐标和y坐标，m、t均为正整数；因此，将优化目标函数f设定为公式(11)所示：
则可以根据直升机初始位置矩阵U与初始水平方向角向量Γ来确定目标函数值f(U,Γ)，其中第m个测量节点的坐标表示为：
V表示直升机飞行速度，Δt为直升机飞行经过相邻测量节点所用时间，将直升机的初始位置U0＝(x1，x2，...，xS；y1，y2，...，yS；z1，z2，...，zS)代入优化目标函数f中可得模拟退火算法的初始目标函数值为f(U0,Γ0)，并随后用前一次S架直升机结束测量时的位置更新初始位置矩阵，并令其为U1；
而扰动模型设立为：所有直升机飞行高度保持不变，对第s个直升机的水平飞行方向γs加上一个Δγs的随机扰动，Δγs服从[0,2π]内的均匀分布，而s＝1,2,...,S，此时新的状态Γ1＝Γ0+ΔΓ，第m个测量节点的坐标表示为公式(13)所示：
新状态下目标函数值为f(U1,Γ1)。
根据Metropolis准则,在温度T下，若f(U1,Γ1)＜f(U0,Γ0)，则接受新状态(U1,Γ1)，否则，若概率P满足公式(14)的条件：
P＝exp{-[f(U1,Γ1)-f(U0,Γ0)]/KT}＞rand (14)
其中K为给定常数，rand为0到1范围内的随机数，则仍接受(U1,Γ1)为当前状态，若概率P不满足公式(14)的条件，则保留状态(U0,Γ0)为当前状态。且退火计划T(k)设定为公式(15)所示:
其中T0为初始温度，α为温度衰减率，α的通常选择范围为0.7≤α≤1，k为正整数且为迭代次数，N为待反演参数的个数，在实际应用中N可选择1或2。
经过如图3所示的模拟退火算法流程后，得到最终优化结果(U,Γ)，将其作为下一次测量的初始状态(U0,Γ0)，计算优化结果的目标值f(U,Γ)，令直升机群从初始位置出发，按各自优化的飞行方向角飞行，同步骤2，在各段飞行航迹上设置C个无线传感节点，由此构建起M＝S*C个无线测量节点，得到新的M维测量向量yM×1。
步骤6：重复执行步骤3到步骤5，取预定时限内最终迭代结果为目标定位结果。
所述重复执行步骤3到步骤5，取预定时限内最终迭代结果为目标定位结果的方法，包括：
在直升机群获得新的测量向量后，将其回代至上述三个步骤中，建立新的有源字典，再次利用基于稀疏贝叶斯学习的压缩感知恢复算法估计目标位置，并根据最新的估计目标位置进行直升机航迹规划。以上过程为一次循环迭代。在实际应用中，考虑到直升机定位时的时限约束，将所述迭代终止的两个条件设立为如下所示：
3.最多允许以上循环迭代设定的Q次，这里Q为正整数；
4.若在迭代次数小于Q的某次循环中出现以下情况：优化结果的目标值
f(U,Γ)＞f(U0,Γ0)，说明直升机群已部署至较理想的位置，不需进行位置变换，因而舍弃本次优化结果并终止迭代；
最终，取最后一次迭代结果，即最后一次利用基于稀疏贝叶斯学习的压缩感知算法恢复的估计目标位置，作为最终估计目标位置
而经过实践验证，如图4和图5所示，本发明提出的方案(CS-SA)与现有技术的不使用航迹规划而采用固定测量节点的方案(FMN)相比，在相同的定位区域与信噪比条件下，CS-SA的定位精度要好于FMN，且随着定位区域的扩大与信噪比的降低，CS-SA均能保持70％以上的无误率。
本发明的方法利用模拟退火算法在直升机收集地面目标的定位信息的过程中对其进行航迹规划，将飞行过程中采集的定位信息用于基于稀疏贝叶斯学习的压缩感知定位技术中，从而恢复出估计目标位置，然后对测量向量与估计目标位置进行多次迭代，最终得出精度较高的定位结果。该方法能有效结合直升机灵活机动的特点，并克服直升机飞行距离的扩大对压缩感知定位技术性能的不良影响，提高了定位精度。同时，本发明算法计算复杂度小，实现难度较低，具有良好的应用前景。
以上以用实施例说明的方式对本发明作了描述，本领域的技术人员应当理解，本公开不限于以上描述的实施例，在不偏离本发明的范围的情况下，可以做出各种变化、改变和替换。
Claims (5)
1.一种直升机协同定位的方法，其特征在于，包括如下步骤：
步骤1：对设定的定位区域进行离散处理；
步骤2：部署直升机，预设测量节点并采集定位信息；
步骤3：建立有源字典；
步骤4：用基于稀疏贝叶斯学习的压缩感知恢复算法估计目标位置；
步骤5：利用模拟退火算法进行直升机航迹规划并重新采集定位信息；
步骤6：重复执行步骤3到步骤5，取预定时限内最终迭代结果为目标定位结果；
所述部署直升机，预设测量节点并采集定位信息的方式，包括：
在所述定位区域的上空部署载有信号强度传感器的直升机，所述直升机的信号强度传感器用于在各测量节点测量地面目标发出信号的信号强度RSS，以此能基于各测量节点的信号强度RSS的强弱差异估计地面目标位置；所述直升机的初始位置均匀部署在所述定位区域的边界上，所述直升机数量为S，则直升机初始位置矩阵为U0＝(x1,x2,...,xS；y1,y2,...,yS；z1,z2,...,zS)，其中S为不小于二的正整数，这里xt、yt和zt分别表示第t个直升机的初始位置的x坐标、第t个直升机的初始位置的y坐标和第t个直升机的初始位置的z坐标；各直升机的初始水平飞行的方向角向量为Γ0＝(γ1,γ2,...,γS)，这里γt表示第t个直升机的水平飞行的方向角，t为小于或等于S的正整数；然而为了将压缩感知理论应用到对地目标定位中，所述测量节点的数量M需满足公式(1)的条件：
M≥Tlog(N/T) (1)
其中M<<N,N、T均为正整数且N>>T,由于实际应用中调用直升机的数量有限，通常并不足以满足一架直升机建立一个测量节点的设想，故考虑在各直升机完成一次定位测量的飞行航迹上设置C个测量节点，由此构建起M＝S*C个测量节点，并使得M≥Tlog(N/T)，其中M为正整数；于是定位区域内部所有地面目标在第m个测量节点上的信号强度RSS的叠加Sm为公式(2)所示：
其中，φm,k表示当第k个区域格点中存在地面目标时在第m个测量节点上的发送的信息的信号强度RSS,θk为N维稀疏向量θN×1中的第k个分量；令M维测量向量yM×1表征在各测量节点实际测得的接收信号强度，其第m个分量为Sm，其中m为正整数，由公式(3)可知测量向量y可表示为：
y＝Φθ+ε (3)
其中，Φ为有源字典，φm,n为Φ中第m行，第n列元素，ε表示测量噪声，这里m为正整数；由公式(3)可看出，测量向量y的维数M小于目标位置向量θ维数N；
所述利用模拟退火算法进行直升机航迹规划并重新采集定位信息，包括：
首先，需要确定模拟退火算法针对的优化目标函数f，由设立的无线信号的自由空间传播模型可知，在每个测量节点上收集到的地面目标发送的无线信号的信号强度
其中d表示该测量节点和该地面目标之间的距离，在第m个测量节点收集到的信号强度的叠加Sm为公式(9)所示：
其中dm,t为第m个测量节点与第t个地面目标之间的距离,Pt为地面目标的信号发射功率大小，λ为地面目标发送的无线信号的波长，T为地面目标个数，该距离由公式(10)可得：
这里，xm、ym和zm分别为第m个测量节点的x坐标、y坐标和z坐标，xt和yt分别为第t个地面目标的x坐标和y坐标，m、t均为正整数；
因此，将优化目标函数f设定为公式(11)所示：
则可以根据直升机初始位置矩阵U与初始水平方向角向量Γ来确定目标函数值f(U,Γ)，其中第m个测量节点的坐标表示为：
V表示直升机飞行速度，Δt为直升机飞行经过相邻测量节点所用时间，将直升机的初始位置U0＝(x1,x2,...,xS；y1,y2,...,yS；z1,z2,...,zS)代入优化目标函数f中可得模拟退火算法的初始目标函数值为f(U0,Γ0)，并随后用前一次S架直升机结束测量时的位置更新初始位置矩阵，并令其为U1；
而扰动模型设立为：所有直升机飞行高度保持不变，对第s个直升机的水平飞行方向γs加上一个Δγs的随机扰动，Δγs服从[0,2π]内的均匀分布，而s＝1,2,...,S，此时新的状态Γ1＝Γ0+ΔΓ，第m个测量节点的坐标表示为公式(13)所示：
新状态下目标函数值为f(U1,Γ1)；
根据Metropolis准则,在温度T下，若f(U1,Γ1)＜f(U0,Γ0)，则接受新状态(U1,Γ1)，否则，若概率P满足公式(14)的条件：
P＝exp{-[f(U1,Γ1)-f(U0,Γ0)]/KT}＞rand (14)
其中K为给定常数，rand为0到1范围内的随机数，则仍接受(U1,Γ1)为当前状态，若概率P不满足公式(14)的条件，则保留状态(U0,Γ0)为当前状态；且退火计划T(k)设定为公式(15)所示:
其中T0为初始温度，α为温度衰减率，α的选择范围为0.7≤α≤1，k为正整数且为迭代次数，N为待反演参数的个数，在实际应用中N可选择1或2。
2.根据权利要求1所述的直升机协同定位的方法，其特征在于，所述对设定的定位区域进行离散处理，包括：
将所述定位区域划分为N个大小相同的矩形格点，若某个矩形格点内含有地面目标，只能有且只能有一个地面目标；并按顺序编号，即N个大小相同的矩形格点的编号分别为1,2,3,…,n,…,N；用N维稀疏向量θN×1表征T个地面目标的位置矩阵，所述T个地面目标的位置矩阵为P(x1,x2,...,xT；y1,y2,...,yT)，若第k个区域格点中含有地面目标，则令该区域格点中的该地面目标的直角坐标系坐标为该格点中心坐标(xk,yk)，并令N维稀疏向量θN×1中的第k个分量θk＝1，否则θk＝0；因此就有||θ||0＝T并假设θ的支撑集为Ω；这里N、T均为正整数且N>>T，n为小于或等于N的正整数，k为小于或等于N的正整数。
3.根据权利要求1所述的直升机协同定位的方法，其特征在于，所述建立有源字典，包括：
根据无线信号自由空间传播模型计算φm,k的值，从而建立有源字典Φ，具体包括：
根据无线信号的自由空间传播模型，当地面目标处于第k个区域格点中时,在第m个测量节点上的信号接收功率Pm,k为公式(4)所示：
其中dm,k表示第k个区域格点中的地面目标到预设的第m个测量节点的距离，λ为地面目标发送的无线信号的波长，Pt为地面目标的信号发射功率大小，此时信号强度φm,k为公式(5)所示：
φm,k＝Pm,k (5)
所有所述信号强度φm,k的集合就形成了有源字典Φ；
这样，地面目标位置估计问题可转化为如公式(6)所示的稀疏向量恢复问题：
由此得到的目标位置向量为
目标位置向量为θ，ε表示测量噪声。
4.根据权利要求1所述的直升机协同定位的方法，其特征在于，所述用基于稀疏贝叶斯学习的压缩感知恢复算法估计目标位置，包括：
使用设定的稀疏阈值ηt来滤除这些取值微小的非零分量从而消除其对目标估计结果的影响，即目标位置向量的支撑集估计
如公式(7)所示：
其中，i为正整数，获得目标位置向的支撑集后，地面目标的坐标可如公式(8)估计如下：
从而可以得到所有T个地面目标的首次估计坐标为
这里xh和yh分别为第h个地面目标位置首次估计的x坐标和y坐标，h的取值范围为1-T。
5.根据权利要求1所述的直升机协同定位的方法，其特征在于，所述重复执行步骤3到步骤5，取预定时限内最终迭代结果为目标定位结果的方法，包括：
所述迭代终止的两个条件设立为如下所示：
1.最多允许以上循环迭代设定的Q次，这里Q为正整数；
2.若在迭代次数小于Q的某次循环中出现以下情况：优化结果的目标值
f(U,Γ)＞f(U0,Γ0)，说明直升机群已部署至较理想的位置，不需进行位置变换，因而舍弃本次优化结果并终止迭代；
最终，取最后一次迭代结果，即最后一次利用基于稀疏贝叶斯学习的压缩感知算法恢复的估计目标位置，作为最终估计目标位置
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911267236.0A CN111007460B (zh) | 2019-12-11 | 2019-12-11 | 直升机协同定位方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911267236.0A CN111007460B (zh) | 2019-12-11 | 2019-12-11 | 直升机协同定位方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN111007460A CN111007460A (zh) | 2020-04-14 |
| CN111007460B true CN111007460B (zh) | 2022-04-15 |
Family
ID=70114525
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201911267236.0A Active CN111007460B (zh) | 2019-12-11 | 2019-12-11 | 直升机协同定位方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN111007460B (zh) |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112229409B (zh) * | 2020-10-15 | 2022-08-12 | 西安电子科技大学 | 基于贝叶斯和进化算法的无人机协同航迹规划方法 |
| CN114071353B (zh) * | 2021-11-04 | 2024-02-09 | 中国人民解放军陆军工程大学 | 结合聚类算法的压缩感知无源被动式目标定位方法 |
| CN116520262B (zh) * | 2023-06-25 | 2023-10-17 | 成都华兴汇明科技有限公司 | 基于矢量信号源的雷达干扰信号生成方法及系统 |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104469939A (zh) * | 2014-12-16 | 2015-03-25 | 重庆邮电大学 | 基于rss统计分布分块区域误差限的wlan定位网络优化方法 |
| CN104969034A (zh) * | 2013-03-28 | 2015-10-07 | 爱信艾达株式会社 | 路径搜索系统、路径搜索方法以及路径搜索程序 |
| CN105954741A (zh) * | 2016-04-26 | 2016-09-21 | 杭州电子科技大学 | 一种基于多假设拟蒙特卡罗的多目标无源协同定位方法 |
| CN108834043A (zh) * | 2018-05-29 | 2018-11-16 | 中国人民解放军陆军工程大学 | 基于先验知识的压缩感知多目标无源定位方法 |
| CN110544296A (zh) * | 2019-07-31 | 2019-12-06 | 中国矿业大学 | 一种敌方威胁不确定环境下无人机三维全局航迹智能规划方法 |
Family Cites Families (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| FR2878684B1 (fr) * | 2004-11-30 | 2007-04-20 | Cit Alcatel | Dispositif de localisation de terminal mobile au moyen de signaux a marquage temporel corrige provenant de stations de base d'un reseau mobile asynchrone |
| US9274221B2 (en) * | 2013-02-01 | 2016-03-01 | GM Global Technology Operations LLC | Method and apparatus for remote object sensing employing compressive sensing |
| CN104320845B (zh) * | 2014-07-04 | 2018-02-02 | 南京邮电大学 | 一种基于传感器和量子智能计算的主用户定位方法 |
| JP6541065B2 (ja) * | 2015-05-28 | 2019-07-10 | パナソニックＩｐマネジメント株式会社 | 位置検出システム及び位置検出方法 |
| CN107064865B (zh) * | 2017-04-07 | 2020-06-23 | 杭州电子科技大学 | 基于深度聚类的极坐标动态规划无源协同定位方法 |
-
2019
- 2019-12-11 CN CN201911267236.0A patent/CN111007460B/zh active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104969034A (zh) * | 2013-03-28 | 2015-10-07 | 爱信艾达株式会社 | 路径搜索系统、路径搜索方法以及路径搜索程序 |
| CN104469939A (zh) * | 2014-12-16 | 2015-03-25 | 重庆邮电大学 | 基于rss统计分布分块区域误差限的wlan定位网络优化方法 |
| CN105954741A (zh) * | 2016-04-26 | 2016-09-21 | 杭州电子科技大学 | 一种基于多假设拟蒙特卡罗的多目标无源协同定位方法 |
| CN108834043A (zh) * | 2018-05-29 | 2018-11-16 | 中国人民解放军陆军工程大学 | 基于先验知识的压缩感知多目标无源定位方法 |
| CN110544296A (zh) * | 2019-07-31 | 2019-12-06 | 中国矿业大学 | 一种敌方威胁不确定环境下无人机三维全局航迹智能规划方法 |
Non-Patent Citations (5)
| Title |
|---|
| Bayesian compressive sensing;JI S等;《IEEE Transactions on Signal Processing》;20081231;第56卷(第6期);全文 * |
| Toward Intelligent Flight Control;Robert F等;《IEEE TRANSACTIONS ON SYSTEMS, MAN, AND CYBERNETICS》;19931231;第23卷(第6期);全文 * |
| 基于变分贝叶斯推理的多目标无源定位算法;余东平等;《南京邮电大学学报（自然科学版）》;20180430;第38卷(第2期);全文 * |
| 基于多目标优化算法的多无人机协同航迹规划;周德云等;《系统工程与电子技术》;20170430;第39卷(第4期);全文 * |
| 基于模拟退火算法的航迹规划方法研究;高晓静;《微电子学与计算机》;20001231(第5期);全文 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN111007460A (zh) | 2020-04-14 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN111007460B (zh) | 直升机协同定位方法 | |
| KR102116824B1 (ko) | 딥러닝 기반 측위 시스템 및 이의 구축 방법 | |
| CN110933599B (zh) | 一种融合uwb与wifi指纹的自适应定位方法 | |
| Ocana et al. | Indoor robot localization system using WiFi signal measure and minimizing calibration effort | |
| CN104519571B (zh) | 一种基于rss的室内定位方法 | |
| CN105180942B (zh) | 一种无人船自主导航方法及装置 | |
| CN113543066B (zh) | 感通导指一体化交互与多目标应急组网方法及系统 | |
| CN112423265B (zh) | 基于csi的双循环神经网络的船载环境室内定位方法 | |
| CN113569465B (zh) | 一种基于深度学习的航迹矢量和目标类型联合估计系统及估计方法 | |
| CN109672973A (zh) | 一种基于最强ap法的室内定位融合算法 | |
| CN108896047A (zh) | 分布式传感器网络协同融合与传感器位置修正方法 | |
| JP6663606B2 (ja) | 無人航空機位置推定方法及びシステム | |
| CN112731500B (zh) | 室外无人机协同室内无人机进行三维定位的方法 | |
| CN109151750A (zh) | 一种基于循环神经网络模型的lte室内定位楼层判别方法 | |
| CN111711923A (zh) | 一种基于uav的无线传感器网络节点定位方法 | |
| CN108834041B (zh) | 基于张量重建的室内位置指纹定位Radio Map建立方法 | |
| Zhang et al. | Assembling a swarm navigation system: Communication, localization, sensing and control | |
| CN110278525B (zh) | 一种高精度室内无线定位方法 | |
| CN117647993A (zh) | 一种基于电力巡检场景下的无人机巡检方法 | |
| Peng et al. | A new Wi-Fi dynamic selection of nearest neighbor localization algorithm based on RSS characteristic value extraction by hybrid filtering | |
| CN112839311B (zh) | 一种基于动态监测的csi室内定位方法 | |
| Yucer et al. | RSSI-based outdoor localization with single unmanned aerial vehicle | |
| CN115560757B (zh) | 随机姿态误差条件下基于神经网络的无人机直接定位校正方法 | |
| Van Nguyen et al. | Trackerbots: Autonomous uav for real-time localization and tracking of multiple radio-tagged animals | |
| Ocaña et al. | Indoor robot navigation using a POMDP based on WiFi and ultrasound observations |
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 | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |