一种X对称结构测量无人机姿态角的方法技术

本发明专利技术涉及一种X对称结构测量无人机姿态角的方法。通过三维空间X结构对称放置的6轴传感器，获取无人机各方位姿态数据，而后通过群论算法对无人机各方位姿态数据进行演算，获得无人机飞行过程中的姿态数据，实现无人机飞行控制的准确性。本发明专利技术能够实现无人机姿态数据获取准确，提高了无人机飞行过程中的姿态信息获取的效率。获取的效率。获取的效率。

【技术实现步骤摘要】
一种X对称结构测量无人机姿态角的方法


[0001]本专利技术属无人机领域，具体涉及一种X对称结构测量无人机姿态角的方法。

技术介绍

[0002]无人机具有体积小、成本低、机动性好、隐身能力强等优点而广泛应用于国防军工、运输、交通、地质、农业等领域。
[0003]无人机在飞行过程中，获得准确的飞行姿态数据非常重要，这些姿态数据包括翻滚角、俯仰角、巡航角和对应的角速度和加速度等。无人机的控制端利用这些姿态数据可以很好的控制电机运转，保证无人机飞行过程的平稳和飞行方向的正确。
[0004]现有的无人机姿态数据获取的方法是采用3轴、6轴、9轴传感器进行获取，比较经典的是MPU6050系列产品，为全球首例整合性6轴运动处理组件，而且提供广泛的通用接口如I2C,SPI和UART。该模块的姿态获取通常结合卡尔曼滤波算法进行修正，由此获得较好的角度、角速度和加速度数据。
[0005]但无人机在飞行时处于非常复杂的环境中，不仅飞行旋翼受到电信号本身扰动的影响，而且外部空气漩涡的不同也将导致无人机各个方位的姿态数据非常复杂，因此传统的将6轴传感器放置于中心的方法并不能消除上述影响。将多个传感器置于十字形或者正方形四个角落会在一定程度上取得效果，但一直以来，由于多个传感器的存在会加重CPU演算负担，而且传统的方法也无法解决飞行过程中空间变换的复杂性问题，从而多个传感器的技术无法获得实际应用发展。
[0006]本申请提供一种新型的X对称结构测量无人机姿态角的方法，该方法将传统技术进行拓展，更重要的是利用了空间群论变换的知识对不同方位获得的数据进行分类演算，提高了演算效率，节约了演算时间，从而解决飞行过程中空间变换的复杂性问题，使得将多个传感器放置于不同对称位置的技术能真正应用于实际中。

技术实现思路

[0007]本专利技术的目的在于提供一种X对称结构测量无人机姿态角的方法，通过三维空间X结构对称放置的6轴传感器，获取无人机各方位姿态数据，而后通过群论算法对无人机各方位姿态数据进行演算，获得无人机飞行过程中的姿态数据，实现无人机飞行控制的准确性。
[0008]为实现上述目的，本专利技术的技术方案是：一种X对称结构测量无人机姿态角的方法，通过三维空间X结构对称放置的6轴传感器，获取无人机各方位姿态数据，而后通过群论算法对无人机各方位姿态数据进行演算，获得无人机飞行过程中的姿态数据，实现无人机飞行控制的准确性。
[0009]在本专利技术一实施例中，所述传感器至少为4个，并且按照空间X结构进行对称性摆放，以无人机中心为对称心，形成体心对称结构。
[0010]在本专利技术一实施例中，所述传感器采用MPU6050系列6轴传感器模块，其基于C、C++进行数据的采集和处理，获得姿态数据。
[0011]在本专利技术一实施例中，所述群论算法搭载于STM32F4以上系列或采用windows微小板上，群论算法采用基于STM32的编译软件或采用windows下的python编译。
[0012]在本专利技术一实施例中，所述通过群论算法对无人机各方位姿态数据进行演算，获得无人机飞行过程中的姿态数据的具体实现方式如下：
[0013]传感器以三维空间X结构对称放置，分别测量得到角度、角速度和加速度数据，设传感器获得的角度、角速度和加速度为3*3矩阵：
[0014][0015]其中，X11-X13分别为三个角度，即：翻滚角、俯仰角和巡航角，X21-X23分别为三个方向的角速度，X31-X33分别为三个加速度值，因此，四个传感器将构成一个6*6阶的矩阵，即：
[0016][0017]简化为：
[0018][0019]由于体心对称性，因此对角线的两个传感器X
c1
和X
c3
，X
c2
和X
c4
中的部分矩阵元将成线性相关性，即：
[0020][0021][0022]X
11-X
41
＝X
12-X
42
＝X
13-X
43
＝λ
ꢀꢀ
(4)
[0023]同理，其他相关矩阵元也都有类似的关系，将该关系代入矩阵X
T
中，进一步简化矩阵元；
[0024]通过四个传感器获得的无人机各方位姿态数据需转换后，才可获得无人机机体的角度、角速度和加速度值，无人机机体的最终的矩阵形式为3*3阶矩阵：
[0025][0026]根据矩阵运算和空间群变换理论，需要引入一个3*6阶的中间矩阵X
z
才能将四个传感器的6*6阶矩阵变成3*3矩阵，即满足：
[0027]X
z
*X
T
*X
zT
＝X
f
ꢀꢀ
(6)
[0028]其中，X
zT
为X
z
的转置矩阵，如此即可通过4个X对称的传感器得到无人机各方位姿
态数据，最后通过对称性演算获得无人机机体的最终姿态数据。
[0029]在本专利技术一实施例中，所述中间矩阵X
z
根据X结构通过如下基本矩阵形式进行变换：
[0030][0031]相较于现有技术，本专利技术具有以下有益效果：
[0032]1.由于采用具有空间X对称性结构的传感器放置方式，使得获取无人机在旋翼方向的姿态数据变得更为准确；
[0033]2.对称性结构降低了传感器使用的成本，避免了大规模使用传感器进行多方位的数据采集；
[0034]3.空间群变换、群论、坐标变换等融合算法，尤其是群论算法的引入，大幅度降低了无人机在空中飞行时飞行状态的复杂性，通过空间群分类处理，提高了效率并降低了演算时间，使得多传感器配合得以实际应用。
附图说明
[0035]图1为本专利技术一实例的四旋翼无人机X对称结构测量姿态角示意图。
[0036]图2为本专利技术一实例的X对称结构测量无人机姿态角的方法(空间群图)。
具体实施方式
[0037]下面结合附图，对本专利技术的技术方案进行具体说明。
[0038]本专利技术提供了一种X对称结构测量无人机姿态角的方法，通过三维空间X结构对称放置的6轴传感器，获取无人机各方位姿态数据，而后通过群论算法对无人机各方位姿态数据进行演算，获得无人机飞行过程中的姿态数据，实现无人机飞行控制的准确性。
[0039]如图1所示，本专利技术一实例的一种X对称结构测量无人机姿态角的方法，所示无人机包括四个旋翼Y1-Y4，2个机臂B1-B2及其他附件，无人机系统包括两个主要模块，分别为6轴传感器模块c1-c4和群论算法模块q1。
[0040]编号为c1-c4的6轴传感器模块，该模块设有硬件和软件两部分；硬件为6轴整合姿态获取模块如MPU6050系列等；软件主要为基于STM32的C/C++编译环境；所用的算法为姿态解算+卡尔曼滤波相结合的混合算法。
[0041]6轴传感器模块为4个但不本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种X对称结构测量无人机姿态角的方法，其特征在于，通过三维空间X结构对称放置的6轴传感器，获取无人机各方位姿态数据，而后通过群论算法对无人机各方位姿态数据进行演算，获得无人机飞行过程中的姿态数据，实现无人机飞行控制的准确性。2.根据权利要求1所述的一种X对称结构测量无人机姿态角的方法，其特征在于，所述传感器至少为4个，并且按照空间X结构进行对称性摆放，以无人机中心为对称心，形成体心对称结构。3.根据权利要求1所述的一种X对称结构测量无人机姿态角的方法，其特征在于，所述传感器采用MPU6050系列6轴传感器模块，其基于C、C++进行数据的采集和处理，获得姿态数据。4.根据权利要求1所述的一种X对称结构测量无人机姿态角的方法，其特征在于，所述群论算法搭载于STM32F4以上系列或采用windows微小板上，群论算法采用基于STM32的编译软件或采用windows下的python编译。5.根据权利要求1所述的一种X对称结构测量无人机姿态角的方法，其特征在于，所述通过群论算法对无人机各方位姿态数据进行演算，获得无人机飞行过程中的姿态数据的具体实现方式如下：传感器以三维空间X结构对称放置，分别测量得到角度、角速度和加速度数据，设传感器获得的角度、角速度和加速度为3*3矩阵：其中，X11-X13分别为三个角度，即：翻滚角、俯仰角和巡航角，X21-X23分别为三个方向的角速度，X31-X33分别为三个加速度值，因此，四个传感器将构成一个6*6阶的矩...

【专利技术属性】
技术研发人员：武永华，任海科，羊富贵，乔亮，林曼峰，林喜季，
申请(专利权)人：福建江夏学院，
类型：发明
国别省市：