分享一下，仅供参考借鉴，切勿直接使用！致谢一下全糖奶茶屋！
由于无人机集群在遂行编队飞行时, 应尽可能的避免外界干扰, 因此需要尽可能的保持电磁静默减少电磁波信号的发射.为保持编队队形, 拟采用纯方位无源定位的方法调整无人机的位置, 即由编队中某几架无人机发射信号, 其余无人机被动接收信号, 从中提取出方向信息进行定位, 来调整无人机的位置.其中, 无人机所接收到的方向信息约定为：该无人机与任意两架发射信号无人机连线之间的夹角.编队中每架无人机均有固定编号, 且在编队中与其他无人机的相对位置关系保持不变.
本文将要解决以下几个问题：
问题一：编队由10架无人机组成, 构成圆形编队, 其中9架无人机均匀分布在某一圆周上, 令一架无人机位于圆心.无人机基于自身感知高度信息, 均保持在同一高度上飞行.建立数学模型, 解决以下问题：
1、 位于圆心的无人机和编队中另2架无人机发射信号, 其余位置略有偏差的无人机被动接收信号.当发射信号的无人机位置无偏差且编号已知时, 建立被动接收信号的无人机的定位模型.
2、某位置略有偏差的无人机接收到编号为FY00和FY01的无人机发射的信号, 另接收到编队中若干编号位置的无人机发射的信号.若发射的无人机位置无偏差, 除FY00和FY01外, 还需要几架无人机发射信号, 才能实现无人机的有效定位?
3、按编队要求, 1架无人机位于圆心, 另外9架无人机均匀分布在半径为100m的圆周上.当初始时刻无人机的位置略有偏差时, 每次选择编号为FY00的无人机和圆周上最多3架无人机遂行发射信号, 其余无人机接收通过多次调整, 最终使9架无人机均匀分布在某个圆周上.其中无人机的初始位置如题所示.
问题二：当无人即集群使其他编队队形, 例如锥形编队飞行, 其中直线上相邻两架无人机间距相等.设计纯方位无源定位情形下, 无人机的位置调整方案.
对本文提出的有关无人机定位问题，我们逐一做如下分析：
问题一主要围绕十架无人机形成圆形编队且保持同一高度飞行时, 通过若干无人机发射的信号实现纯方位无源定位的问题, 那么此时只需要考虑平面上的圆周问题就可以了.根据问题一的假设, 剩下的九架飞机尽量均匀分布在圆周上, 对于位置准确的无人机, 其位置仅与无人机的编号有关, 而对于位置略有偏差的无人机, 他们距离圆心无人机的距离以及角度都是暂时不知道的. 我们需要对下述三种情况进行分析：
问题二是一个动态规划问题.与问题一不同的是, 问题二的无人机一定在同一高度飞行, 因此, 我们需要利用动态规划模型, 寻找使得无人机在调整过程中偏差尽可能小的方案.
针对本文提出的问题，我们做了如下模型假设：
假设1：题目中的无人机略有偏差时, 还大体在理想位置, 不存在偏离超
过XX范围的无人机；
假设2：假设每架无人机标号都是固定的, 且明确知道哪些无人机发射信号；
本文常用符号见下表, 其它符号见文中说明
| 符号 | 符号意义 |
| z | 复数域内的自变量 |
| w | 复数域内的自变量 |
| f（z） | 的复变函数 |
假设圆周的半径为, 以无人机FY00为极点, 以FY00为端点且经过FY01的射线为极轴建立极坐标系.不失一般性, 假设在圆周上的其中一架发射信号无人机为FY01, 转化为极坐标后, 其对应的极坐标为 ). 由于发射信号的无人机都是位置准确的, 所以另一架发射信号无人机的位置是根据编号固定的, 编号为FY0K, 由于理想状态下, 所有无人机均匀分布在圆周上, 则其对应的坐标为
, 其中
接着, 假设接受信号的无人机ρ的极坐标位置为（x,θ）, 由于剩下无人机的位置略有偏差, 所以两个参数都需要进行确定. 接着, 我们去假设它与三架发射信号的无人机的夹角. 假设ρ与FY00、FY01之间的夹角为α1, 与FY00、FY0K之间的夹角为α2, 与FY01、FY0K之间的夹角为α3.接下来需要通过已知信息来确定出相应接收信号无人机的极坐标（x,θ）.
我们将略有偏差的无人机与确定的无人机位置相连, 利用正弦定理, 通过联立方程组来解得极坐标 （x,θ）. 下面由于牵扯到角度, 还需要对K的不同值进行分类讨论：
（情况i）当K=2时, 两个外围确定的无人机之间没有其他无人机：分布情况可视化如下图5.1所示：
图5.1 两个外围确定的无人机之间没有其他无人机分布图
由上图5.1可知：若α1≤α2，(绿色所示位置), 我们考察FY00、FY01、FY0K构成的三角形与FY00、FY02、FY0K构成的三角形, 根据正弦定理可得：
解得：
根据图5.1可知：若α1>α2，(蓝色所示位置), 我们考察FY00、FY01、FY0K构成的三角形与FY00、FY02、FY0K构成的三角形, 根据正弦定理可得：
解得：
情况ii）当K=3,4,5时, 我们需要根据α3的大小判断有偏差的无人机是否夹在两个确定位置的无人机中间：分布情况可视化分析如图5.2所示
图5.2 情况ii无人机分布情况可视化分析
图5.2中：若α3<π/2 且 α2=α3+α1此时无人机并不处于两架飞机之间, 和上一种情况一致, 列出方程为:
（其他两种略过）
情况iii）当5<k≤9时, 情况与11-K(1<K5)时相对应, 只需将1<k≤5时方程中的用替换即可.
在第1小问中，根据已知信息，我们可以利用基于角度的测量方法三角测量定位法求出无人机的定位。三角定位原理主要根据一个测量目标点以及两个已知坐标的参考点可形成一个三角形，借助三角形中参考边的长度，测量两参考点与目标点形成的角度，即可找到目标点的距离及坐标。
根据题设，选定已知三个发射信号的无人机坐标分别为：FY00（0,0），FY01（R，0），FY0K（cosθ，Rsinθ），其中K≠0,1，在本问中θ=Kα。则其三角定位模型如下图5.3所示：
图5.3 无人机分布三角定位模型
篇幅公式过多，这里就不再一一赘述，可以看文末。
该问题要求我们在无人机位置有偏差时，根据无人机接收到的位置信息通过多次调整，使得除编号为0的无人机外，另外9架无人机最终均匀分布在某个圆周上。由于圆周的半径不需要取一个固定值，通过已知无人机的极坐标信息，由编号为：2，5，8的无人机确定一个以98为半径，为圆心的圆周。再将其余编号无人机调整到该圆周上，并使其均匀分布即可实现题目中无人机位置要求。具体实现策略如下：
由编号为：2，5，8的无人机确定一个以98为半径，（0,0）为圆心的圆周，模型可视化如下图5.3所示
图5.3 2，5，8的无人机组成的圆模型
图5.4 3，4，6，7，9的无人机组成的圆模型
以编号为6的无人机为例，由于编号2，5的无人机均在圆周上，将编号为6的无人机与圆心连线与圆周的交点设为6’。当6’在圆周上时，∠26’5的大小不变且可求出。当调整编号为6的无人机位置至∠26’5与相等时，∠26’5可判断出编号为6的无人机位于圆周上。通过上述方法可将编号3，4，7，9的无人机调整到圆周上。
令圆周上的所有无人机均匀分布，可视化分析如下图5.5所示：
图5.5 圆周上的所有无人机均匀分布
以上图为例，当无人机6在移动时，我们规定∠562保持不变，则可保证无人机6始终在圆周上。在圆周上移动无人机6，当∠560为70°时，此时无人机6即位于目标位置。同理可将其余无人机移动至目标位置。其余无人机均可由类似方法进行调整，从而使无人机在圆周上均匀分布。
由于问题二中无人机不一定保持同一高度飞行，因此在建立模型时，我们尽可能选择相邻三个无人机发射信号，通过测量其边长与50m的差距，来衡量无人机位置的偏差。因此，针对上述问题可以采用动态规划模型进行求解。
在问题二中无人机初始时刻坐标未知，当其编队队形为锥形时，仍利用无源定位的位置信息对队形进行调整。在该问题中，由于初始位置未知，我们无法直接通过无源定位的未知信息测量出每个无人机的位置。因此，需要通过相邻无人机之间距离以及角度来衡量无人机的位置偏差以及编队中存在的对称关系，对无人机的位置进行调整。我们可以通过贪婪策略，每次尽可能少的选择发射信号的无人机个数对其余无人机位置进行调整。
具体调整方案如下：
1）.选择发射信号无人机为：FY02, FY03，
后面的找时间再更新，具体的可以看下方名片
