一种基于多GPS接收机的无人机姿态追踪方法及系统技术方案

本发明专利技术提出了一种基于多GPS接收机的无人机姿态追踪方法，首先，确定各个GPS接收机在ENU坐标系下的初始化位置；当无人机在飞行过程中姿态发生变化时，采用RTK定位的方法，实时计算各个GPS接收机在ECEF坐标系下的坐标位置；然后，将各GPS接收机在ECEF坐标系下的位置转化为ENU坐标系下的位置信息；最后，将得到的位置信息与初始化位置进行比较、计算，得出GPS接收机在ENU坐标系下绕各个轴向旋转的角度。本发明专利技术还提出一种的无人机姿态追踪系统。本发明专利技术通过比较当前位置姿态与初始位置姿态，能够直接得到角度的变化量，计算结果更加准确，实现无人机姿态的精确追踪。

An attitude tracking method and system for UAV Based on multi GPS receiver

The invention provides a method, attitude tracking receiver based on multi GPS first identified in the ENU coordinates of the initial position of each GPS receiver; when the UAV attitude changes during the flight, using the method of RTK positioning, real-time calculation of the various GPS coordinates receiver in ECEF coordinates then, the GPS; the receiver in the ECEF coordinates of the location position information into ENU coordinate system; finally, the obtained position information and initialization comparison and calculation, the GPS receiver in ENU coordinates around each axial rotation angle. The invention also presents an unmanned aerial vehicle attitude tracking system. By comparing the current position and attitude and initial position and attitude, the invention can get the change of angle directly, and the calculation result is more accurate, so that the UAV posture can be accurately tracked.

【技术实现步骤摘要】
一种基于多GPS接收机的无人机姿态追踪方法及系统
本专利技术涉及一种无人机姿态追踪方法及系统，属于无人机技术研究领域。
技术介绍
随着科技的进步，近几年无人机技术得到了飞速的发展，而惯性测量单元IMU是无人机技术当中重要的一环，它能够测量出无人机三轴姿态角以及加速度的装置。陀螺仪是IMU的主要元件之一，其精度直接影响到惯性系统的精度。为何陀螺仪会成为无人机姿态导航的首选传感器呢？陀螺仪是利用高速回转体的动量矩敏感壳体相对惯性空间绕正交于自转轴的一轴或多轴的角运动检测装置。它可感测一轴或多轴的旋转角度，可精准感测自由空间中的复杂移动动作，因此，陀螺仪成为追踪物体移动方位与旋转动作的必要运动传感器，如手机、可穿戴设备、潜艇、飞机、导弹和航天器的惯性导航设备等。然而，像潜艇、飞机、导弹和航天器等工业级别的设备上，大多采用工业级别的、精度更高的陀螺仪，比如说光纤陀螺仪、环形激光陀螺仪、工业级MEMS陀螺仪，而面对消费级无人机，大多采用普通的陀螺仪。在无人机实际的飞行过程中，普通的陀螺仪容易受各种不可避免的因素干扰，比如外界温度、瞬间大电流、电机电磁干扰等，而导致陀螺仪产生误差，从初始对准开始，其导航误差就随时间而增长，会导致IMU中陀螺仪的精度下降甚至失效，这是惯导系统的主要缺点。尤其是姿态位置误差对无人机来说往往都是致命的，会直接导致无人机炸机。针对以上的问题，最好的解决办法是利用外部信息进行辅助，实现组合导航，使其有效地减小误差。目前各大无人机厂商大多采用冗余设计来解决，即在飞控上搭载多组IMU。欧洲的3DRobotics公司的pixhawk飞控上搭载了两组IMU；国内CUAV雷迅科技的pixhawk2,4x飞控上搭载了两组IMU，pixhawkv3飞控上搭载了三组IMU；国内大疆的精灵4的飞控上搭载了两组IMU，A3pro飞控上搭载了三组IMU。飞控系统采用软件算法对各组IMU数据进行判断，当一组IMU数据出现异常时，飞控系统立即切换至另外一组IMU上，以保障无人机可靠的、稳定的飞行。IMU的冗余设计在一定程度上保障了无人机的正常飞行，但是多组IMU的设计一方面增加了硬件的开销，另一方面增加了软件设计的复杂度。
技术实现思路
本专利技术所要解决的技术问题是：针对无人机飞行过程中，由于温度、电流、磁场等因素的影响所带来的惯性测量单元IMU精度低甚至失效的问题，提供了一种无人机姿态追踪的方法及系统，解决无人机内部惯性测量单元IMU受到外部干扰后精度降低或失效的问题。本专利技术为解决上述技术问题采用以下技术方案：一种基于多GPS接收机的无人机姿态追踪方法，包括如下步骤：S1、在无人机的机臂上，以每个机臂为单位分别安装GPS接收机，并以其中一个GPS接收机为原点，建立ENU坐标系；S2、将无人机水平放置，确定各个GPS接收机在ENU坐标系下的初始化位置；S3、当无人机在飞行过程中姿态发生变化时，实时计算出各个GPS接收机在ECEF坐标系下的坐标位置；S4、将步骤S3中得到的各个GPS接收机在ECEF坐标系下的坐标位置，转化为各个GPS接收机在ENU坐标系下的位置信息；S5、通过比较步骤S4和步骤S2中各个GPS接收机的位置变化，计算出无人机各个轴向的旋转角度。进一步的，本专利技术的无人机姿态追踪方法，在步骤S2中，将作为原点的GPS接收机的坐标位置设为(0,0,0)，将各个GPS接收机在ENU坐标系下相对于原点GPS接收机的坐标位置，作为各个GPS接收机在ENU坐标系下的初始化的位置。进一步的，本专利技术的无人机姿态追踪方法，步骤S3是采用RTK定位算法实时计算出各个GPS接收机在ECEF坐标系下的坐标位置。进一步的，本专利技术的无人机姿态追踪方法，在步骤S4中是应用三维坐标系旋转、空间向量运算的理论，将各个GPS接收机在ECEF坐标系下的坐标位置转化为在ENU坐标系下的位置信息，具体是：首先进行三维坐标系的旋转，使得旋转后的ECEF坐标系转化为以地球地心为原点的ENU坐标系；然后，再应用空间向量运算，得到位置发生变化的GPS接收机在ENU坐标系下的位置信息。进一步的，本专利技术的无人机姿态追踪方法，在步骤S5中，通过比较位置发生变化后的GPS接收机的位置信息与初始化位置信息，根据坐标系旋转变换的理论，计算得出GPS接收机在ENU坐标系下绕各个轴向旋转的角度，即无人机横滚、俯仰、偏航的角度变化。本专利技术还提出一种基于多GPS接收机的无人机姿态追踪系统，包括：安装在无人机的各个机臂上GPS接收机，以及姿态追踪模块；其中，姿态追踪模块包括：初始位置计算单元，用于将一个GPS接收机作为原点接收机，计算其余GPS接收机在ENU坐标系下相对于原点GPS接收机的坐标位置，得到各个GPS接收机在ENU坐标系下的初始化位置；实时姿态计算单元，用于无人机在飞行过程中姿态发生变化时，实时计算出各个GPS接收机在ECEF坐标系下的坐标位置；坐标信息转换单元，用于将实时姿态计算单元得到的各个GPS接收机在ECEF坐标系下的坐标位置，应用三维坐标系旋转、空间向量运算的理论，转化为各个GPS接收机在ENU坐标系下的位置信息；位置变化计算单元，用于通过比较各GPS接收机在ENU坐标系下的实时位置与初始化位置，计算出无人机各个轴向的旋转角度。本专利技术采用以上技术方案，在不采用传统的惯性传感器的情况下，摆脱了温度、电流、磁场等因素的干扰，提高了无人机的安全可靠性，与现有技术相比，具有以下技术效果：(1)本系统在建立坐标系的时候直接采用ENU坐标系，与无人机采用相同的坐标系，优点在于方便后期与飞控数据的融合。(2)陀螺仪是在测得角速度大小的基础上，通过对时间的积分得到角度的变化量，存在累积误差，而本专利技术的方法是通过比较当前位置姿态与初始位置姿态，能够直接得到角度的变化量，计算结果更加准确。(3)本专利技术的使用是在RTK精准定位的基础上实现的，定位精度属于厘米级别甚至毫米级别，转化为轴向旋转的精度大约为2度，与陀螺仪的精度相当，但是不存在外部环境的干扰情况，也不存在累积的误差，更加的安全可靠。(4)本专利技术不仅可以为无人机提供高精度的姿态追踪方法，还可以为无人机提供实时的高精度定位结果。附图说明图1是本专利技术方法的原理图。图2是本专利技术方法流程图。图3是本专利技术方法应用场景示意图。图4是ECEF坐标系和ENU坐标系关系图。具体实施方式下面结合附图对本专利技术的技术方案做进一步的详细说明：本
技术人员可以理解的是，除非另外定义，这里使用的所有术语(包括技术术语和科学术语)具有与本专利技术所属领域中的普通技术人员的一般理解相同的意义。还应该理解的是，诸如通用字典中定义的那些术语应该被理解为具有与现有技术的上下文中的意义一致的意义，并且除非像这里一样定义，不会用理想化或过于正式的含义来解释。ENU：站心坐标系，指用户所在位置点P为坐标原点，三个坐标轴分别是相互垂直的东向、北向和天向；比如以站心(如GPS接收天线中心)为坐标系原点O，Z轴与椭球法线重合，向上为正(天向)，y轴与椭球短半轴重合(北向)，x轴与地球椭球的长半轴重合(东向)所构成的直角坐标系，又称为当地东北天坐标系(ENU)。ECEF(Earth-Centered，Earth-Fixed)，是一个笛卡尔坐标系，以地球为中心，(0本文档来自技高网...

【技术保护点】
一种基于多GPS接收机的无人机姿态追踪方法，其特征在于，包括如下步骤：S1、在无人机的机臂上，以每个机臂为单位分别安装GPS接收机，并以其中一个GPS接收机为原点，建立ENU坐标系；S2、将无人机水平放置，确定各个GPS接收机在ENU坐标系下的初始化位置；S3、当无人机在飞行过程中姿态发生变化时，实时计算出各个GPS接收机在ECEF坐标系下的坐标位置；S4、将步骤S3中得到的各个GPS接收机在ECEF坐标系下的坐标位置，转化为各个GPS接收机在ENU坐标系下的位置信息；S5、通过比较步骤S4和步骤S2中各个GPS接收机的位置变化，计算出无人机各个轴向的旋转角度。

【技术特征摘要】
1.一种基于多GPS接收机的无人机姿态追踪方法，其特征在于，包括如下步骤：S1、在无人机的机臂上，以每个机臂为单位分别安装GPS接收机，并以其中一个GPS接收机为原点，建立ENU坐标系；S2、将无人机水平放置，确定各个GPS接收机在ENU坐标系下的初始化位置；S3、当无人机在飞行过程中姿态发生变化时，实时计算出各个GPS接收机在ECEF坐标系下的坐标位置；S4、将步骤S3中得到的各个GPS接收机在ECEF坐标系下的坐标位置，转化为各个GPS接收机在ENU坐标系下的位置信息；S5、通过比较步骤S4和步骤S2中各个GPS接收机的位置变化，计算出无人机各个轴向的旋转角度。2.根据权利要求1所述的无人机姿态追踪方法，其特征在于，在步骤S2中，将作为原点的GPS接收机的坐标位置设为(0,0,0)，将各个GPS接收机在ENU坐标系下相对于原点GPS接收机的坐标位置，作为各个GPS接收机在ENU坐标系下的初始化的位置。3.根据权利要求1所述的无人机姿态追踪方法，其特征在于，步骤S3是采用RTK定位算法实时计算出各个GPS接收机在ECEF坐标系下的坐标位置。4.根据权利要求1所述的无人机姿态追踪方法，其特征在于，在步骤S4中是应用三维坐标系旋转、空间向量运算的理论，将各个GPS接收机在ECEF坐标系下的坐标位置转化为在ENU坐标系下的位置信息，具体是：首...

【专利技术属性】
技术研发人员：倪晓军，葛昌利，汤振，
申请(专利权)人：南京邮电大学，
类型：发明
国别省市：江苏,32