用于多旋翼无人机定位跟踪的常模信号盲估计方法及系统

技术领域

本发明属于无人机定位和跟踪领域，尤其涉及一种用于多旋翼无人机定位跟踪的常模信号盲估计方法及系统。

背景技术

目前，无线通信技术随着国家信息化程度的不断加深以及信息量的急剧增加而呈现出爆炸式的速率递增。现如今，针对多旋翼无人机的无线通信技术已经得到了前所未有的发展与进步。建设一个可收集信号的信号总基站，通过铺设阵列信号阵元来接收、分析、处理各种传来信号的参数、内容以及信息，进而解决了多旋翼无人机实时定位跟踪的问题。在现代社会中，用于多旋翼无人机定位跟踪的无线通信技术已经越来越得到大众的广泛认知。

随着当今通信通信技术的迅猛发展，逐渐呈现出很多问题。例如在多旋翼无人机无线通信中，当发射端的信号发出时，其调制机制等信息数据在操控者接收端未被准确监测到；发射端发出的信号在传输过程中遭到其他各种电子信号的干扰和屏蔽，导致操控者接收端接收图传信号不清晰，出现信号重叠或信号模糊的现象。因此，在多旋翼无人机操控者的接收端如何可以精确地接收到准确的传输信号，同时进行识别和再处理，已经逐渐成了通信行业业内人士重点研究的方向，大家都对于这个领域充满了研究的热情。近年来，国内外的不少学者对多旋翼无人机定位跟踪的常模信号盲估计进行了大量的研究，同时也发表了很多的研究成果。

由于常模算法利用信号具有的常模特性，则不再需要参考信号，从而解放了带宽，大大提高了信号传输速率，具有模值恒定、复杂度不高、对矩阵列模型信号的误差不明显等优点。正是由于常模信号的这些优点，在多旋翼无人机定位跟踪的通信信号处理和数字图像处理等领域，常模算法越来越受到科研人员的重视，日益成为研究的热点问题，常模信号的盲估计技术也逐渐成了大家竞相研究的方向和趋势。

传统的盲估计方法对常模信号DOA的检测存在分辨率低、估计精度及稳定性不高的问题。

发明内容

针对现有技术存在的问题，本发明提供了一种用于多旋翼无人机定位跟踪的常模信号盲估计方法及系统。

本发明是这样实现的，一种用于多旋翼无人机定位跟踪的常模信号盲估计方法，所述用于多旋翼无人机定位跟踪的常模信号盲估计方法包括：

步骤一，利用2D-MUSIC算法对多旋翼无人机常模信号的DOA进行盲估计，利用二维角度来盲估计DOA的角度信息，以操控者为参考点，对无人机实时方位角和俯仰角进行估计；

步骤二，根据改变的不同无人机信号源个数以及观察所得到的不同多旋翼无人机实时位置，通过曲线拟合方法，推导出多旋翼无人机常模信号入射最小临界角与无人机信号源个数之间的关系式；

步骤三，搭建基于实值波束成形空间ESPRIT算法结合无迹卡尔曼滤波算法得多旋翼无人机定位跟踪盲估计装置平台，设计双系统的圆形阵列模型，结合ODAS开放嵌入式测试系统实时对多旋翼无人机的方向角和俯仰角进行检测。

进一步，所述步骤一的具体过程为：

建立数学模型图，假设所设定的天线阵列为一个双向平行的天线阵列分布，其中，沿X轴方向的相邻两个阵元之间的距离为d

假设目标空域内有P个多旋翼无人机位置信号从空间的二维方向

进一步，所述步骤二的具体过程为：

(1.1)模拟不同个数得多旋翼无人机常模信号源入射的不同波达方向DOA的方位角和俯仰角，信噪比均设定为10dB，利用控制变量法确定在同方位角的情况下，来测试和观察不同俯仰角时的MATLAB仿真对比结果；

(1.2)将仿真对比结果数据导入LabVIEW软件中，对所仿真模拟采集数据进行了排序和整理整合，通过运用最小二乘法的方法，利用SVD算法，对所测的数据量进行曲线拟合处理；

(1.3)根据LabVIEW软件所导出的多项式系数，推导出多旋翼无人机个数与盲估计所得的常模信号入射最小临界角的关系式，表达式如下：

Y＝1.51-1.38X+0.85X

式中，X表示多旋翼无人机个数，Y表示盲估计所得的常模信号入射最小临界角。

进一步，所述步骤三包括如下步骤：

(2.1)构建圆形阵列模型；

(2.2)基于实值波束成形空间ESPRIT算法进行DOA盲估计；

(2.3)基于无迹卡尔曼滤波算法进行干扰消除。

进一步，所述(2.1)的具体过程为：

假设所述圆形阵列模型由M个阵元组成，均匀分布在半径为R圆形阵列上，且相互独立，假设存在N个目标多旋翼无人机信号射入圆形阵列上，以坐标原点O为中心参考点，无人机位置信号与XOY轴平面所成夹角α为被测目标无人机的俯仰角，多旋翼无人机位置信号在水平面的投影虚线与X轴所形成的夹角θ定义为方位角，其中俯仰角α∈[0°，90°]，方位角θ∈[0°，360°]，取逆时针为正向，所述圆形阵列模型地表示为：

将上式写成矩阵形式为：

X(t)＝AS(t)+N(t)

式中，X(t)为M×1维的输出数据向量；S(t)为N×1维的远场声源信号；N(t)为M×1维的噪声数据且为高斯白噪声，每一个阵元上的噪声不相关；A＝[a

式中，w

进一步，所述步骤(2.2)的具体过程为：

所述实值波束成形空间ESPRIT算法利用圆形阵列模型接收数据协方差矩阵的信号子空间的旋转不变性，进而计算出空间信号源传来多旋翼无人机位置信号的方位角和俯仰角；

圆形阵元阵列为由多个子阵列组成的整体阵列模型，子阵列之间相互协作，由多个直线阵列围起来，子阵列阵元数目都是M个数，交叉排列着，其中X(t)子阵列由前0到M-1个阵列组成，Y(t)子阵列表示1到M个阵列组成的组合阵列；

实值波束成形空间ESPRIT算法接收远场空间的多旋翼无人机位置信号源，引入了频率相同的高斯白噪声，由于信号子空间与噪声子空间两个子阵存在相对平移的相位值，则φ的表达式为：

式中，φ是两个子阵列相位延迟形成的对角矩阵；β是中心频率；d是信号源波长；θ

x(k)是一个M×M的标准方阵，则组成x(k)的两个子矩阵x

式中，x

圆形阵元阵列的对应矩阵表示为：

式中，R

两个对应的子阵列分别表示为：

整体的信号子空间假设为E

E

式中，Ψ表示为Ψ＝T

所存在的旋转算子简化表达式为：

E

E

因此，推导出Ψ和φ的关系式：

φ＝TΨT

因此，常模信号的盲估计角度就变成了求解Ψ特征值得过程，通过对Ψ进行特征值分解得到φ，再利用φ估计空间内多旋翼无人机位置信号的方位角与俯仰角。

进一步，所述(2.3)的具体过程为：

(2.3.1)进行Unscented transform(UT)，选取X～N(μ,σ

∑

μ＝∑

∑＝∑

式中，i＝1，n；∑

(2.3.2)在原状态分布中按某一规则选取一些采样点，使这些采样点的均值和协方差等于原状态分布的均值和协方差：将这些点代入非线性函数汇总，得到相应的非线性函数值点集，通过这些点集求取变换后的均值和协方差。这样得到的非线性变换后的均值和协方差精度最少具有2阶精度。对于高斯分布，可以达到3阶精度。其采样点的选择是基于先验均值和先验协方差矩阵的平方根的相关列实现的，根据这些规则来选择Sigma点：

χ

式中，

(2.3.3)对相关矩阵进行平方根的求解进而得到所述Sigma点，定义协方差矩阵为S，同时满足Σ＝S

Σ＝VDV

(2.3.4)分配Sigma点权值：

式中，

(2.3.5)对计算出来的Sigma点的映射值做高斯估计，得到如下估计结果：

式中，Σ′表示计算测量变量和观测变量的协方差矩阵，

(2.3.6)把所述Unscented transform(UT)代入到卡尔曼滤波中，得到无迹卡尔曼滤波，通过无迹变换的采样和权重计算近似获得均值和方差；

所述无迹变换为在原状态分布中按某一规则选取一些采样点，使这些采样点的均值和协方差等于原状态分布的均值和协方差：将这些点代入非线性函数汇总，得到相应的非线性函数值点集，通过这些点集求取变换后的均值和协方差。

进一步，所述无迹卡尔曼滤波包括如下步骤：

(3.1)利用χ

(3.2)计算2n+1个Sigma点集的预测，i＝1,2，2n+1，则下一时刻t时刻的状态：

(3.3)使用无迹变换得到的并且经过状态转移的Sigma点计算先验预测均值与协方差，计算系统状态量的一步预测，则先验估计值为：

(3.4)计算误差协方差矩阵的先验预测值：

(3.5)根据一步预测值，再次使用无迹变换采样，产生新的Sigma点集：

式中，加权方差

(3.6)根据(3.5)得到的新的Sigma点集，代入测量方程h(x)，得到预测的测量：

式中，测量方程

本发明的另一目的在于提供一种实施所述用于多旋翼无人机定位跟踪的常模信号盲估计方法的用于多旋翼无人机定位跟踪的常模信号盲估计系统，所述用于多旋翼无人机定位跟踪的常模信号盲估计系统包括：

2D-MUSIC模块，用于对多旋翼无人机常模信号的DOA进行盲估计，利用二维角度来盲估计DOA的角度信息；

曲线拟合模块，用于推导出了多旋翼无人机常模信号入射最小临界角与无人机信号源个数之间的关系式；

检测模块，用于搭建了基于实值波束成形空间ESPRIT算法结合无迹卡尔曼滤波算法得多旋翼无人机定位跟踪盲估计装置平台，设计双系统的圆形阵列模型，并结合ODAS开放嵌入式测试系统，实时对多旋翼无人机的方向角和俯仰角进行检测。

本发明的另一目的在于提供一种实施所述用于多旋翼无人机定位跟踪的常模信号盲估计系统的用于多旋翼无人机定位跟踪的常模信号盲估计软件，所述用于多旋翼无人机定位跟踪的常模信号盲估计软件包括：

使用LabVIEW虚拟仪器建立数学模型和常模信号盲估计的界面设计，在三维空间DOA盲估计系统软件设计上，虚拟仪器技术在可以充分地功能齐全的硬件基础上，结合软件完成各种开发和仿真模拟

进一步，所述用于多旋翼无人机定位跟踪的常模信号盲估计软件包括：

系统登录界面，在登录界面里，输入正确的用户名和登录密码后，点击登录按钮，进入三维空间DOA盲估计系统的主要功能页面；

系统功能操作界面，包括前面板图以及程序框图，用于利用LabVIEW仿真模拟实现用于多旋翼无人机定位跟踪的常模信号DOA盲估计的系统功能。

进一步，所述系统登录界面的具体过程包括：

输入已经设定好的用户名和密码；若输入错误，系统会提示“用户名和密码输入错误”，无法进入主系统；

所述系统登录界面采用平铺式顺序结构，通过三帧顺序来执行编程；在第一帧写入While循环，起到循环输入用户名和密码的作用，当所输入的用户名和密码是正确的，点击登录就能第一时间向后一帧输出为“真”的信号指令，反之输出为假；相较于第二帧，第三帧起到判断输出的作用，若输出为“真”，就会打开系统功能所对应的子VI；

所述前面板图中DOA盲估计的输入部分为信号的协方差矩阵、方位角和俯仰角的扫描精度，输出的内容为空间谱相关参数、接收信号的方位角跟俯仰角的具体值参数；

所述程序框图是虚拟仪器进行编程的地方，通过采用模块化的各种器件进行连线编程，整体分为两部分模块，一部分为对协方差矩阵进行特征值分解的功能；另一部分则为由方位角和俯仰角决定的矢量计算，信号流通过两部分的信号处理，最终进行空间谱盲估计的计算。

这里的器件指：很多外观与传统仪器(如示波器、万用表)类似的控件，可用来方便地创建用户界面。用户界面在LabVIEW中被称为前面板。使用图标和连线，可以通过编程对前面板上的对象进行控制。

本发明的另一目的在于提供一种计算机设备，所述计算机设备包括存储器和处理器，所述存储器存储有计算机程序，所述计算机程序被所述处理器执行时，使得所述处理器执行所述用于多旋翼无人机定位跟踪的常模信号盲估计方法的步骤。

本发明的另一目的在于提供一种计算机可读存储介质，存储有计算机程序，所述计算机程序被处理器执行时，使得所述处理器执行所述用于多旋翼无人机定位跟踪的常模信号盲估计方法的步骤。

结合上述的技术方案和解决的技术问题，本发明所要保护的技术方案所具备的优点及积极效果为：

本发明通过与传统的Extended Kalman Filter(EKF)相比较，平均精确度误差降低了51.91％，达到了高精度定位跟踪的目的，验证了本发明方法的有效性，更好地丰富了对多旋翼无人机定位跟踪的常模信号盲估计得多样性；最后设计了针对多旋翼无人机的三维空间DOA盲估计的界面操作系统，极大地提升了对于多旋翼无人机信号传输过程中的位置定位、信号分析处理及智能化的管理，实现了自动化地观测和操作，安全且便捷，在数字化屏幕上，直观显示出多旋翼无人机实时DOA三维空间仰角和方位角的数据，具有更好的人机交互功能。

本发明利用2D-MUSIC(二维空间MUSIC)算法来对多旋翼无人机常模信号的DOA进行盲估计，利用二维角度来盲估计DOA的角度信息，即以操控者为参考点，对多旋翼无人机实时方位角和俯仰角进行估计；

本发明改变不同多旋翼无人机信号源个数，观察所得到的不同多旋翼无人机实时位置，并通过曲线拟合方法，首次推导出了多旋翼无人机常模信号入射最小临界角与无人机信号源个数之间的关系式；

本发明搭建了一套基于实值波束成形空间ESPRIT算法结合无迹卡尔曼滤波算法得多旋翼无人机定位跟踪盲估计装置平台，设计了双系统的圆形阵列模型，结合ODAS开放嵌入式测试系统，可以实时对多旋翼无人机的方向角和俯仰角进行检测，通过与传统的Extended Kalman Filter(EKF)相比较，平均精确度误差降低了51.91％，达到了高精度定位跟踪的目的，验证了本发明装置的有效性，更好地丰富了对多旋翼无人机定位跟踪的常模信号盲估计得多样性；

本发明提供的针对多旋翼无人机的三维空间DOA盲估计的界面操作系统，极大地提升了对于多旋翼无人机信号传输过程中的位置定位、信号分析处理及智能化的管理，实现了自动化地观测和操作，安全且便捷，在数字化屏幕上，直观显示出多旋翼无人机实时DOA三维空间仰角和方位角的数据。

附图说明

图1是本发明实施例提供的用于多旋翼无人机定位跟踪的常模信号盲估计方法流程图；

图2是本发明实施例提供的双向平行阵列模拟示意图；

图3是本发明实施例提供的方位角与俯仰角示意图；

图4是本发明实施例提供的曲线拟合图；

图5是本发明实施例提供的圆形阵列数学模型；

图6是本发明实施例提供的圆形阵列模型；

图7是本发明实施例提供的直线阵元阵列模型；

图8是本发明实施例提供的结果分析图，(a)、二维结果图，(b)三维结果图；

图9是本发明实施例提供的测试对比图；

图10是本发明实施例提供的UFK与EKF测试对比图；

图11是本发明实施例提供的干扰消除效果图；

图12是本发明实施例提供的系统软件设计框图；

图13是本发明实施例提供的登录界面图；

图14是本发明实施例提供的用户名、密码输入正确提示图；

图15是本发明实施例提供的登录界面程序框图；

图16是本发明实施例提供的仿真结果示意图；

图17是本发明实施例提供的二维DOA波达角强度分散图；

图18是本发明实施例提供的两个信号源的仿真对比图；

图19是本发明实施例提供的三个信号源的仿真对比图；

图20是本发明实施例提供的四个信号源的仿真对比图；

图21是本发明实施例提供的曲线拟合界面图；

图22是本发明实施例提供的双系统的圆形阵列模型示意图；

图23是本发明实施例提供的多旋翼无人机DOA信息示意图，(a)方向角，(b)俯仰角。

具体实施方式

为了使本发明的目的、技术方案及优点更加清楚明白，以下结合实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。

为了使本领域技术人员充分了解本发明如何具体实现，该部分是对权利要求技术方案进行展开说明的解释说明实施例。

如图1所示，本发明实施例提供的一种用于多旋翼无人机定位跟踪的常模信号盲估计方法包括：

S101，利用2D-MUSIC算法对多旋翼无人机常模信号的DOA进行盲估计，利用二维角度来盲估计DOA的角度信息，以操控者为参考点，对无人机实时方位角和俯仰角进行估计；

S102，根据改变不同无人机信号源个数，观察所得到的不同多旋翼无人机实时位置，并通过曲线拟合方法，首次推导出了多旋翼无人机常模信号入射最小临界角与无人机信号源个数之间的关系式；

S103，搭建了基于实值波束成形空间ESPRIT算法结合无迹卡尔曼滤波算法得多旋翼无人机定位跟踪盲估计装置平台，设计了双系统的圆形阵列模型，结合ODAS开放嵌入式测试系统实时对多旋翼无人机的方向角和俯仰角进行检测。

基于2D-MUSIC算法得多旋翼无人机DOA盲估计的具体过程包括：

在实际场景下，对于多旋翼无人机在定位跟踪方面，更多的是建立在三维空间里的信息传递，所以，为了提高DOA盲估计的全面性和完整性，本发明采用空间阵列的2D-MUSIC(二维空间MUSIC)算法的DOA盲估计。相比于传统的一维空间DOA盲估计，仅限于确定多旋翼无人机位置信号源入射角的一个角度，即仅能确定目标信号在一个平面内，并不能实现较精确地定向定位。因此，利用二维空间角度来估计多旋翼无人机当前位置DOA的角度信息，即包括了方位角和俯仰角的估计，更加有效地提高了辨识度，更好地丰富了对多旋翼无人机定位跟踪的常模信号盲估计得多样性。

本发明设计了一种双向平行天线阵列，提出了一种把参数进行配对的二维空间DOA盲估计的算法，既提高了波达方向盲估计得多样性(即增加了对空间方位角和俯仰角的盲估计)，同时也在原来的基础上降低了计算的复杂性。

建立系统的数学模型图，如图2所示，假设所设定的天线阵列为一个双向平行的天线阵列分布。其中沿X轴方向的相邻两个阵元之间的距离为,两条平行阵列之间的距离为d

现假设，如图3所示，目标空域内有P个多旋翼无人机位置信号从空间的二维方向

多旋翼无人机常模信号入射最小临界角与信号源个数关系式推导的具体过程包括：

本发明分别模拟假设不同个数得多旋翼无人机常模信号源入射的不同波达方向DOA的方位角和俯仰角，信噪比均设定为10dB。利用控制变量法确定在同方位角的情况下，来测试和观察不同俯仰角时的MATLAB仿真对比结果，首次推导出多旋翼无人机个数与盲估计所得的常模信号入射最小临界角的关系式。

实验一：当存在两个多旋翼无人机信号源时，得到四个仿真结果，进行对比分析验证后，不难得出以：当存在两个多旋翼无人机信号源时，相同方位角的情况下，最小临界俯仰角为2°。

实验二：当存在三个多旋翼无人机信号源时，得到三个仿真结果，进行对比分析验证后，不难得出以：当存在三个多旋翼无人机信号源时，相同方位角的情况下，最小临界俯仰角为5°。

实验三：当存在四个多旋翼无人机信号源时，得到三个仿真结果，进行对比分析验证后，不难得出以：当存在四个多旋翼无人机信号源时，相同方位角的情况下，最小临界俯仰角为10°。

本发明经过多次实验仿真，将所得数据的导入LabVIEW软件中，通过对结果数据进行曲线拟合的处理，对所仿真模拟采集到的12组数据进行了排序和整理整合，通过运用最小二乘法的方法，利用SVD算法，对这些所测的数据量进行曲线拟合处理，如图4所示。根据LabVIEW所导出的多项式系数，首次推导出多旋翼无人机个数与盲估计所得的常模信号入射最小临界角的关系式，如公式1所示，X表示多旋翼无人机个数，Y表示盲估计所得的常模信号入射最小临界角。

Y＝1.51-1.38X+0.85X

多旋翼无人机定位跟踪DOA盲估计方法的具体过程包括：

本发明首次设计了圆形阵列模型来实现对多旋翼无人机实时位置进行定位，基于实值波束成形空间的ESPRIT算法，利用阵列信号接收数据协方差矩阵的信号子空间的旋转不变性，进而计算出空间中多旋翼无人机常模信号的方位角和俯仰角。随后采用了精度更高、计算量更小的无迹卡尔曼滤波算法(Unscented Kalman Filter，UKF)，设计了双系统的圆形阵列模型，结合ODAS开放嵌入式测试平台，构建三维立体的动态模型，将多旋翼无人机的位置信息直观显示在空间坐标系中，实现位置定位与目标轨迹追踪。

本发明设计了圆形阵列模型来实现对多旋翼无人机实时位置进行定位，假设由M个阵元组成，均匀分布在半径为R圆形阵列上，且相互独立，模型如图5所示，假设存在N个目标多旋翼无人机信号射入圆形阵列上，以坐标原点O为中心参考点，无人机位置信号与XOY轴平面所成夹角α为被测目标无人机的俯仰角，多旋翼无人机位置信号在水平面的投影虚线与X轴所形成的夹角θ定义为方位角，其中俯仰角α∈[0°，90°]，方位角θ∈[0°，360°]，取逆时针为正向，则该圆形阵列模型公式2可表示为：

将(2)式写成矩阵形式为：

X(t)＝AS(t)+N(t) (3)

X(t)为M×1维的输出数据向量；S(t)为N×1维的远场声源信号；N(t)为M×1维的噪声数据，且为高斯白噪声，而每一个阵元上的噪声不相关；A＝[a

w

实值波束成形空间ESPRIT算法是利用圆形阵列信号接收数据协方差矩阵的信号子空间的旋转不变性，进而计算出空间信号源传来多旋翼无人机位置信号的方位角和俯仰角。相比于传统的MUSIC算法，此算法具有计算量小、无需在空间中不断地进行谱峰搜索等优点，是对传统MUSIC算法功能的拓展和计算的简化。

实值波束成形空间ESPRIT算法基于一个事实：在旋转矢量中，一个元素上的信号来源于更早期元素信号的相移。其核心思想就是将圆形阵列看作是一个整体的模型，由多个子阵列组成的整体阵列模型，这些子阵列之间相互协作，如图7所示，可以看作由多个直线阵列围起来，组成的圆形阵元阵列，阵元数目都是M个数，交叉排列着，其中X(t)子阵列由前M个阵列组成，Y(t)表示后面的M个阵列组成的组合阵列。

与传统的MUSIC算法的前提条件是一致的，实值波束成形空间ESPRIT算法同样也是接收远场空间的多旋翼无人机位置信号源，引入了频率相同的高斯白噪声，由于信号子空间与噪声子空间两个子阵存在相对平移的相位值，则φ的表达式为：

假设该矩阵是一个M×M的标准方阵，则两个矩阵所接收到相同的两个阵列信号能够表示为：

所得到该阵列的对应矩阵表示为：

两个对应的子阵列可以分别表示为：

设整体的信号子空间假设为E

E

所存在的旋转算子简化表达式为：

E

E

因此，不难推导出两者的关系式：

φ＝TΨT

这样，常模信号的盲估计角度就变成了求解Ψ特征值得过程，通过对采样信号来估计空间内多旋翼无人机位置信号的方位角与俯仰角。

本发明首先对一个多旋翼无人机常模信号源进行采集分析，将圆形阵列等间距地排列，通过设定采样点数，来提高实验的普遍性和可靠性，选取拟定该多旋翼无人机所处位置为x＝13m、y＝12m、z＝11m处，该常模信号所传输的入射波长为λ，设定两两相邻阵元之间的距离d为λ/2，实验结果如图8所示。在二维分析图和三维分析图中，可以准确显示出目标多旋翼无人机的具体位置。

在想痛快拍数、信噪比和阵元数情况下，与MUSIC算法和多种改进ESPRIT算法做对比实验，如图9所示，结果显示中，实值波束成形空间ESPRIT算法的阵列测量精度相对最高。

本发明基于精度更高、计算量更小的无迹卡尔曼滤波算法(Unscented KalmanFilter，UKF)，设计了双系统的圆形阵列模型，结合ODAS开放嵌入式测试平台，构建三维立体的动态模型，将多旋翼无人机的位置信息直观显示在空间坐标系中，进行位置定位与目标轨迹追踪，通过与传统的Extended Kalman Filter(EKF)相比较，平均精确度误差降低了51.91％。

无迹卡尔曼滤波算法(Unscented Kalman Filter，UKF)是基于Unscentedtransform(UT)对通过非线性函数进行变换的随机向量的统计结论，它使用有限的Sigma点来描述要变换的向量的统计特性，从而选定特定的sigma样本集，用以完整的投影原始分布的一阶二阶矩阵，然后把这些点从过UT非线性转换，分配到新的空间内，在此描述它转换分布的统计信息，从而计算输出时所采用的统计信息。

首先进行Unscented transform(UT)，现在选取X～N(μ,σ

∑

μ＝∑

∑＝∑

对采样与权值的分配有多种不同的方法，根据这些规则来选择Sigma点：

为了求解上述的Sigma点，接下来需要对相关矩阵进行平方根的求解，这里定义矩阵为S，同时满足Σ＝S

Σ＝VDV

对于Sigma点权值的分配，

接下来，对计算出来的Sigma点的映射值，做进一步的高斯估计，得到如下估计结果：

最后，本发明只需要把Unscented transform(UT)代入到卡尔曼滤波中，即可得到无迹卡尔曼滤波：

1：采样：

2：变换：

3：加权均值：

4：加权方差：

5：采样：

6：变换：

7：加权均值：

8：加权方差：

9：

10：

11：

12：

13:returnμ

无迹卡尔曼滤波算法(Unscented Kalman Filter，UKF)是直接寻找一个与真实分布近似的高斯分布，没有用线性表征，而传统的Extended Kalman Filter(EKF)是求一阶全导数得到线性模型，来近似非线性模型。传统的EKF利用泰勒分解将模型线性化，再利用高斯假设解决了概率计算困难的问题，但是线性误差的引入降低了模型精度。对于非线性模型，很困难直接通过用解析的方式来求解贝叶斯递推公式，不易得到各概率分布的均值和方差，但是，利用Unscented transform(UT)的方法却可以较好地解决这个问题，通过一定规律的采样和权重，便可以近似获得均值和方差。而且由于Unscented transform(UT)的方法对矩阵的近似精度较高，通过对UKF与EKF做仿真对比可知，如图10所示其平均精确度误差降低了51.91％，UFK的效果可以达到二阶EKF的效果。

本发明设计了双系统的圆形阵列模型，结合ODAS开放嵌入式测试平台，构建三维立体的动态数学模型，将多旋翼无人机的位置信息直观显示在空间坐标系中，进行位置定位与目标轨迹追踪。如图11所示，三维立体空间中，移动的绿色大球代表着多旋翼无人机实时位置与飞行轨迹，其余蓝色小球表示为无人机多旋翼旋转带来的噪声信号源干扰。经过试验验证，本发明采用的UKF在对于噪声的滤除效果方面明显优于传统的EKF。

本发明实施例还提供了一种实施所述多旋翼无人机定位跟踪的常模信号盲估计得多旋翼无人机定位跟踪的常模信号盲估计系统，三维空间DOA盲估计界面操作系统软件设计包括：

本发明为了继续深入研究关于三维空间中多旋翼无人机DOA俯仰角及方位角的盲估计，并运用LabVIEW软件仿真，设计了三维空间DOA盲估计的界面操作系统，更好地实现了对多旋翼无人机常模信号全面立体的盲估计研究。

通过使用LabVIEW虚拟仪器来建立数学模型和常模信号盲估计的界面设计，在三维空间DOA盲估计系统软件设计上，虚拟仪器技术在可以充分地功能齐全的硬件基础上，同时结合软件效率极高度来完成各种开发和仿真模拟。操作界面系统软件设计框图如图12所示。

打开本软件，首先就会进入该软件的系统初始页面兼登录界面，在登录界面里，将显示本软件的一些制作信息，输入正确的用户名和登录密码后，点击登录按钮，就可以进入三维空间DOA盲估计系统的主要功能页面，如图13所示。

输入正确的用户名和登录密码，点击“登录”按钮，就可以进入主系统了。但前提必须输入已经设定好的用户名和密码，即：输入用户名“管理员”，密码“666”。

若输入正确用户名和密码正确后，这样才可以成功进入；否则，系统会提示“用户名和密码输入错误”，无法进入主系统，如图14所示。

本发明为了设计该登录界面和实现相关功能，该登录界面采用平铺式顺序结构，通过三帧顺序来执行编程。在第一帧写入While循环，起到循环输入用户名和密码的作用，当所输入的用户名和密码是正确的，点击登录就能第一时间向后一帧输出为“真”的信号指令，反之输出为假。相当于第二帧来说，第三帧起到判断输出的作用，若输出为“真”，就会打开系统功能所对应的子VI，如图15所示。

本发明利用LabVIEW仿真模拟实现了一种用于多旋翼无人机定位跟踪的常模信号DOA盲估计的系统功能，以下将展示实现的整体系统效果图。

DOA盲估计的输入部分为信号的协方差矩阵、方位角和俯仰角的扫描精度，而输出的内容为空间谱相关参数、接收信号的方位角跟俯仰角的具体值等参数。

LabVIEW的程序框图是虚拟仪器进行编程的地方，通过采用模块化的各种器件进行连线编程。从图中可以观察到，整体分为两部分模块，一部分为对协方差矩阵进行特征值分解的功能；另一部分则为由方位角和俯仰角决定的矢量计算，信号流通过两部分的信号处理，最终进行空间谱盲估计的计算。

应用实施例。为了证明本发明的技术方案的创造性和技术价值，该部分是对权利要求技术方案进行具体产品上或相关技术上的应用实施例。

本发明首先选取了无线天线阵列阵元个数为3的接收端传感器作为模拟基站，将阵列等间距地排列，通过设定采样点数，来提高实验的普遍性和可靠性，选取拟定了3个相对独立的远场窄带信号，信号源所传输的入射波长为λ，设定两两相邻阵元之间的距离d为λ/2，即相邻间距是信号源入射信号波长的二分之一。

模拟假设了3个信号源入射信号，设定的波达方向DOA角度分别为：方位角(30°、50°、70°)；俯仰角(20°、40°、60°)，信噪比均设定为10dB，MATLAB仿真实验结果图如图16所示。通过本次仿真模拟图像，可以根据空间二维空间MUSIC算法的谱峰搜索的原理，来寻找出波形图中3个“波峰”的位置，以及谱峰分别所对应的方位角和俯仰角的信息，从图像中，可以明显观察出来3个估计的角度，分别对应DOA角度约为：方位角(30°、50°、70°)；俯仰角(20°、40°、60°)，与实际预先假设的入射角信号完全相符，成功地实现了通过运用二维空间MUSIC算法来对常模信号的波达方向DOA进行盲估计的实验研究，与预期的结果相符。接下来利用MATLAB图像模拟的性能，对以上设定的方位角及俯仰角进行再次处理仿真，仿真结果如图17所示，再一次验证了本发明研究的准确性和可靠性。

本发明分别模拟假设不同个数得多旋翼无人机常模信号源入射的不同波达方向DOA的方位角和俯仰角，信噪比均设定为10dB。利用控制变量法确定在同方位角的情况下，来测试和观察不同俯仰角时的MATLAB仿真对比结果，首次推导出多旋翼无人机个数与盲估计所得的常模信号入射最小临界角的关系式。

实施例1：(两个多旋翼无人机信号源)

(1)DOA设置：方位角为(50°，50°)；俯仰角为(40°，60°)

结果分析：波峰独立，角度清晰。

(2)DOA设置：方位角为(50°，50°)；俯仰角为(50°，60°)

结果分析：波峰独立，角度清晰。

(3)DOA设置：方位角为(50°，50°)；俯仰角为(50°，55°)

结果分析：波峰较独立，可观察角度，波底出现干扰。

(4)DOA设置：方位角为(50°，50°)；俯仰角为(50°，52°)

结果分析：波峰模糊，相互融合，角度未知。

结论：将以上四个仿真结果进行对比验证，不难得出以下结论，即：当存在两个多旋翼无人机信号源时，相同方位角的情况下，最小临界俯仰角为2°如图18所示。

实施例2：(三个多旋翼无人机信号源)

(1)DOA设置：方位角为(50°，50°，50°)；俯仰角为(20°，40°，60°)

结果分析：波峰独立，角度清晰。

(2)DOA设置：方位角为(50°，50°，50°)；俯仰角为(40°，50°，60°)

结果分析：波峰较独立，可观察角度，波底出现干扰。

(3)DOA设置：方位角为(50°，50°，50°)；俯仰角为(45°，50°，55°)

结果分析：波峰模糊，相互融合，角度未知。

结论：将以上三个仿真结果进行对比验证，不难得出以下结论，即：当存在三个多旋翼无人机信号源时，相同方位角的情况下，最小临界俯仰角为5°如图19所示。

实施例3：(四个多旋翼无人机信号源)

(1)DOA设置：方位角为(50°，50°，50°，50°)；俯仰角为(20°，40°，60°，80°)

结果分析：波峰独立，角度清晰。

(2)DOA设置：方位角为(50°，50°，50°，50°)；俯仰角为(20°，35°，50°，65°)

结果分析：干扰较明显，波峰强度不一，角度可粗略估计。

(3)DOA设置：方位角为(50°，50°，50°，50°)；俯仰角为(30°，40°，50°，60°)

结果分析：波峰融合严重，角度不可得。

结论：将以上三个仿真结果进行对比验证，不难得出以下结论，即：当存在四个多旋翼无人机信号源时，相同方位角的情况下，最小临界俯仰角为10°如图20所示。

本发明经过多次实验仿真，将所得数据的导入LabVIEW软件中，通过对结果数据进行曲线拟合的处理，对所仿真模拟采集到的12组数据进行了排序和整理整合，通过运用最小二乘法的方法，利用SVD算法，对这些所测的数据量进行曲线拟合处理，如图21所示。根据LabVIEW所导出的多项式系数，首次推导出多旋翼无人机个数与盲估计所得的常模信号入射最小临界角的关系式，如公式22所示，X表示多旋翼无人机个数，Y表示盲估计所得的常模信号入射最小临界角。

Y＝1.51-1.38X+0.85X

实施例相关效果的证据。本发明实施例在研发或者使用过程中取得了一些积极效果，和现有技术相比的确具备很大的优势，下面内容结合实验过程的数据、图表等进行描述。

本发明首次设计了圆形阵列模型来实现对多旋翼无人机实时位置进行定位，基于实值波束成形空间的ESPRIT算法，利用阵列信号接收数据协方差矩阵的信号子空间的旋转不变性，进而计算出空间中多旋翼无人机常模信号的方位角和俯仰角。随后采用了精度更高、计算量更小的无迹卡尔曼滤波算法(Unscented Kalman Filter，UKF)，设计了双系统的圆形阵列模型，如图22所示。结合ODAS开放嵌入式测试平台，构建三维立体的动态模型，将多旋翼无人机的位置信息直观显示在空间坐标系中，实现位置定位与目标轨迹追踪，通过与传统的Extended Kalman Filter(EKF)相比较，平均精确度误差降低了51.91％。如图23所示，两个曲线图代表着目标多旋翼无人机实时在X、Y轴水平面方向上的方位角和Z轴方向上的俯仰角。很明显，在本发明实验设计中，目标多旋翼无人机在俯仰角为30°到60°的Z轴正半轴、方位角为0°到100°的X、Y轴正半轴范围内移动，实现了高精度定位跟踪的目的，验证了本发明装置的有效性，更好地丰富了对多旋翼无人机定位跟踪的常模信号盲估计得多样性

最后，本发明设计了针对多旋翼无人机的三维空间DOA盲估计的界面操作系统，继续深入研究关于三维空间中多旋翼无人机DOA俯仰角及方位角的盲估计，并运用LabVIEW软件仿真，极大地提升了对于多旋翼无人机常模信号传输过程中的位置定位、信号分析处理及智能化的管理，实现了自动化地观测和操作，安全且便捷，在数字化屏幕上，直观显示出多旋翼无人机实时DOA三维空间仰角和方位角的数据，具有更好的人机交互功能。

以上所述，仅为本发明的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，凡在本发明的精神和原则之内所做的做的任何修改、等同替换和改进等，都应涵盖在本发明的保护范围之内。