CN110095121B - 一种抗机体磁干扰的无人机航向解算方法和*** - Google Patents
一种抗机体磁干扰的无人机航向解算方法和*** Download PDFInfo
- Publication number
- CN110095121B CN110095121B CN201910285563.2A CN201910285563A CN110095121B CN 110095121 B CN110095121 B CN 110095121B CN 201910285563 A CN201910285563 A CN 201910285563A CN 110095121 B CN110095121 B CN 110095121B
- Authority
- CN
- China
- Prior art keywords
- magnetometer
- unmanned aerial
- aerial vehicle
- module
- output value
- 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
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Measuring Magnetic Variables (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种抗机体磁干扰的无人机航向解算方法和***,采用INS/GNSS组合导航***、姿态和航向参考系和磁强计椭圆校正方法或椭球校正方法进行磁强计输出偏差补偿和磁强计校准。实现了无人机起飞时对自身电子电器***产生的磁干扰进行隔离,使磁干扰不影响磁航向解算,有效克服了无人机因自身电子电器***产生的磁干扰对无人机磁航向解算影响的问题,从而提高无人机航向解算的稳定性和可靠性。
Description
技术领域
本发明涉及电子信息技术领域,更具体的说是涉及一种抗机体磁干扰的无人机航向解算方法和***。
背景技术
无人机已成为智能制造领域的重要组成部分,世界上许多发达国家和新兴工业国家,例如欧美、日本等都将无人机作为发展重点。随着中国制造2025和人工智能国家战略计划的推进,无人机已向人工智能方向发展,其智能自主***及应用已经成为我国社会发展中的重大科学技术问题。无人机智能化需经历单机智能、多机协同智能和任务自主智能三个发展阶段,而且单机智能是基础。
在复杂环境下实现无人机自主导航定位是实现无人机自主智能的关键基础。无人机自主导航控制***要具备环境适应的能力,特别是环境发生了变化,自主导航与控制***具备自主导航与控制的能力。目前,无人机,特别是旋翼无人机的航向大多数采用磁航向进行解算,但磁场易受环境干扰磁,无人机电子电器设备产生的磁干扰是主要磁干扰源,特别是无人机起飞时电子和电器设备对磁航向解算影响明显,导致无人机不能以固定航向起飞,甚至给实际飞行带来坠机危险。
因此,如何克服无人机自身电子电器对其本身产生的磁干扰是本领域技术人员亟需解决的问题。
发明内容
有鉴于此,本发明提供了一种抗机体磁干扰的无人机航向解算方法和***,对无人机起飞阶段由电子电器设备引起的磁干扰进行建模补偿,有效克服无人机因自身电子电器***磁干扰影响无人机磁航向解算的问题,有利于提高无人机航向解算的稳定性和可靠性。
为了实现上述目的,本发明采用如下技术方案:
一种抗机体磁干扰的无人机航向解算方法,包括以下步骤:
步骤4:用所述磁强计校准参数对所述磁偏差补偿后的磁强计实时输出值进行磁校准补偿,并完成磁航向解算。
优选的,步骤1的具体实现过程为:
步骤11:利用磁强计椭圆校正方法或磁强计椭球校正方法完成所述磁强计校准参数的计算;
步骤12:利用最优估计方法实现所述INS/GNSS组合导航***导航参数解算,并实时计算所述无人机的位置、速度、姿态和航向信息;
优选的,步骤3具体实现过程为:
优选的,步骤4具体实现过程为:
一种抗机体磁干扰的无人机航向解算***包括导航参数计算模块和磁强计补偿模块;所述导航参数计算模块与所述磁强计补偿模块电连接,并进行相互通信;所述导航参数计算模块与GNSS和IMU进行通信;所述磁强计补偿模块与磁传感器电连接通信,所述磁传感器发送磁场强度至所述磁强计补偿模块;所述导航参数计算模块包括INS/GNSS组合导航模块以及姿态和航向参考***AHRS模块;所述GNSS发送位置和速度至INS/GNSS组合导航***模块;所述IMU发送角速度和比力至所述INS/GNSS组合导航***模块以及所述姿态和航向参考***AHRS模块;所述INS/GNSS组合导航模块根据所述GNSS发送的所述位置和所述速度,计算获得所述位置、所述速度、所述姿态角和所述航向角;所述导航参数计算模块根据所述位置、所述速度、所述姿态角和所述航向角,计算获得垂向速度和并发送至所述磁强计补偿模块;所述磁强计补偿模块包括磁强计校准模块和磁强计偏差量计算模块;所述磁强计校准模块计算接收所述磁场强度并计算得到所述磁强计校准参数并传输至所述磁强计补偿计算模块;所述磁强计输出值偏差量模块实时接收所述垂向速度、所述和所述磁传感器发送的所述磁场强度,计算得出磁强计实时输出值并传输至所述磁强计补偿计算模块;所述磁强计补偿计算模块接收所述磁强计校准参数和所述磁强计实时输出值对所述磁强计实时输出值进行磁强计补偿,获到磁强计的实时输出估计值并发送至所述导航参数计算模块;所述导航参数计算模块接收所述补偿后的磁强计输出值,所述姿态和航向参考***AHRS模块根据所述IMU发送的所述角速度和所述比力以及磁强计补偿计算模块发送的经磁偏差补偿后的所述磁强计实时输出估计值计算所述姿态角和所述航向角;同时,所述INS/GNSS组合导航模块完成位置、速度、姿态和航向角导航参数解算。
一种抗机体磁干扰的无人机航向解算***,将上述的一种抗机体磁干扰的无人机航向解算方法采用对应算法进行编程形成程序模块,并将所述程序模块运行在处理器,所述***选择在普通计算机或嵌入式处理器或便携式终端上运行。
经由上述的技术方案可知,与现有技术相比,本发明公开提供了一种抗机体磁干扰的无人机航向解算方法和***,该方法和***首先在无人机起飞前完成磁强计校准参数计算和INS/GNSS组合导航***导航解算,并记录起飞前磁强计输出的原始值为磁强计第一次原始值;其次,无人机解锁起飞后,以无人机的垂向速度作为判断阈值,当无人机的垂向速度大于判断阈值时记录磁强计的输出值为磁强计第二次原始值;然后用磁强计的第二次原始值和第一次原始值做差形成磁强计输出值偏差量,利用磁强计输出值偏差量补偿磁强计的实时输出值,获得磁偏差补偿后的磁强计实时输出值;最后利用磁强计校准参数对磁偏差补偿后的磁强计实时输出值进行磁校准补偿并完成磁航向解算。实现无人机起飞时对自身电子电器***产生的磁干扰进行隔离,使磁干扰不影响磁航向解算。有效克服了无人机因自身电子电器***产生的磁干扰对无人机磁航向解算影响的问题,从而提高无人机航向解算的稳定性和可靠性。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据提供的附图获得其他的附图。
图1附图为本发明提供的一种抗机体磁干扰的无人机航向解算方法流程结构示意图;
图2附图为本发明提供的一种抗机体磁干扰的无人机航向解算***原理图;
图3附图为本发明提供的利用一种抗机体磁干扰的无人机航向解算方法和***的实际飞行航向角变化曲线图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明实施例公开了一种抗机体磁干扰的无人机航向解算方法,无人机的自主导航与控制***实现姿态和航向解算以及INS/GNSS组合导航***导航解算,输出无人机的俯仰角θ、横滚角γ和航向角ψ,本发明的抗机体磁干扰的无人机航向解算方法包括以下步骤:
S11:利用磁强计椭圆校正方法或椭球校正方法完成磁强计校准参数计算;
S12:利用最优估计方法实现INS/GNSS组合导航***导航参数解算,并实时计算无人机的位置、速度、姿态和航向信息,其中最优估计方法选用卡尔曼滤波;
S3:利用磁强计的第二次原始值和第一次原始值做差形成磁强计输出值偏差量,利用磁强计输出值偏差量补偿磁强计的实时输出值,获得磁偏差补偿后的磁强计实时输出值,具体实现步骤为:
S4:用磁强计校准参数对磁偏差补偿后的磁强计实时输出值进行磁校准补偿,并完成磁航向解算,具体步骤为:
为了进一步优化上述技术方案,S31:利用姿态和航向参考系AHRS计算出的姿态角,该姿态角为利用角速度、比力和磁强计实时输出估计值进行磁偏差补偿后的姿态角,其中姿态角包括俯仰角θ和横滚角γ;采用INS/GNSS组合导航***计算输出航向角ψ;并且由姿态角和航向角ψ计算得到捷联姿态矩阵
一种抗机体磁干扰的无人机航向解算***包括导航参数计算模块和磁强补偿模块;导航参数计算模块与磁强计补偿模块电连接,并进行相互通信;导航参数计算模块与GNSS(全球导航卫星***)和IMU(惯性测量单元)进行通信;磁强计补偿模块与磁传感器电连接通信,磁传感器发送磁场强度至磁强计补偿模块;导航参数计算模块包括INS/GNSS组合导航模块以及姿态和航向参考***AHRS模块;GNSS发送位置和速度至INS/GNSS组合导航***模块;IMU发送角速度和比力至INS/GNSS组合导航***模块以及姿态和航向参考***AHRS模块;INS/GNSS组合导航模块根据GNSS发送的位置和速度,计算获得位置、速度和航向角;导航参数计算模块根据位置、速度、姿态角和航向角,计算获得垂向速度和并发送至磁强计补偿模块;磁强计补偿模块包括磁强计校准模块和磁强计偏差量计算模块;磁强计校准模块计算接收磁场强度并计算得到磁强计校准参数并传输至磁强计补偿计算模块;磁强计输出值偏差量模块实时接收垂向速度、和磁传感器发送的磁场强度,计算得出磁强计实时输出值并传输至磁强计补偿计算模块;磁强计补偿计算模块接收磁强计校准参数和磁强计实时输出值对磁强计实时输出值进行磁强计补偿,获到磁强计的实时输出估计值并发送至导航参数计算模块;导航参数计算模块接收补偿后的磁强计输出值,姿态和航向参考***AHRS模块根据IMU发送的角速度和比力以及磁强计补偿计算模块发送的经磁偏差补偿后的磁强计实时输出估计值计算姿态角和航向角;同时,INS/GNSS组合导航模块完成位置、速度、姿态和航向角导航参数解算。
并对垂向速度进行修正,以及对INS/GNSS组合导航模块以及姿态和航向参考***AHRS模块计算的俯仰角、横滚角及偏航角进行修正。
实施例
如图3所示的曲线图中,0-69个历元时无人机处于地面静止阶段,机头指向北,航向角为0°;69-75个历元为无人机解锁起飞阶段,机头指向不变,磁强计受磁干扰影响,磁航向角解算误差增大,以垂向速度为依据形成磁干扰修正偏差量;75-85个历元为实施磁干扰偏差量补偿阶段,磁航向解算收敛到初始值。
本发明的优点在于:利用了无人机在起飞地点的环境磁场相对不变,无人机在不同运动状态下自身电子电器***产生的磁干扰大小不同的内在约束关系,提出了一种抗机体磁干扰的无人机航向解算方法,该方法通过记录无人机起飞前和起飞后不同状态下磁强计的输出值构建机体自身环境磁干扰补偿量,并对无人机起飞过程中自身电子电器***产生的磁干扰进行自动补偿,能有效克服无人机因自身电子电器***产生的磁干扰对无人机磁航向解算影响的问题,有利于提高无人机航向解算的稳定性和可靠性。
实现上述方法全部或部分步骤可以通过相关的软件编程实现,并在处理器上运行形成一种抗机体磁干扰的无人机航向解算***,处理器既可以是笔记本、服务器、工作站或普通计算机,也可以是嵌入式处理器,还可以是便携式终端设备,其适应范围广。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的装置而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其它实施例中实现。因此,本发明将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。
Claims (4)
1.一种抗机体磁干扰的无人机航向解算方法,其特征在于,包括以下步骤:
步骤11:利用磁强计椭圆校正方法或磁强计椭球校正方法完成所述磁强计校准参数的计算;
步骤12:利用最优滤波方法实现所述INS/GNSS组合导航***导航参数解算,并实时计算所述无人机的位置、速度、姿态和航向信息;
其中mx为X轴输出值,my为Y轴输出值,mz为Z轴输出值;
步骤4:用所述磁强计校准参数对所述磁偏差补偿后的磁强计实时输出值进行磁校准补偿,并完成磁航向解算;
3.根据权利要求1所述的一种抗机体磁干扰的无人机航向解算方法,其特征在于,所述步骤12中的最优滤波方法选用卡尔曼滤波算法。
4.一种抗机体磁干扰的无人机航向解算***,其特征在于,应用如权利要求1-3中任一项所述的一种抗机体磁干扰的无人机航向解算方法;所述***包括导航参数计算模块和磁强计补偿模块;所述导航参数计算模块与所述磁强计补偿模块电连接,并进行相互通信;所述导航参数计算模块与GNSS和IMU进行通信;所述磁强计补偿模块与磁传感器电连接通信,所述磁传感器发送磁场强度至所述磁强计补偿模块;
所述导航参数计算模块包括INS/GNSS组合导航模块以及姿态和航向参考***AHRS模块;所述GNSS发送位置和速度至INS/GNSS组合导航***模块;所述IMU发送角速度和比力至所述INS/GNSS组合导航***模块以及所述姿态和航向参考***AHRS模块;所述INS/GNSS组合导航模块根据所述GNSS发送的所述位置和所述速度,计算获得所述位置、所述速度、所述姿态角和所述航向角;所述导航参数计算模块根据所述位置、所述速度、所述姿态角和所述航向角,计算获得垂向速度和并发送至所述磁强计补偿模块;
所述磁强计补偿模块包括磁强计校准模块和磁强计偏差量计算模块;所述磁强计校准模块接收所述磁场强度并计算得到所述磁强计校准参数并传输至所述磁强计补偿计算模块;所述磁强计输出值偏差量模块实时接收所述垂向速度、所述和所述磁传感器发送的所述磁场强度,计算得出磁强计实时输出值并传输至所述磁强计补偿计算模块;所述磁强计补偿计算模块接收所述磁强计校准参数和所述磁强计实时输出值对所述磁强计实时输出值进行磁强计补偿,获到磁强计实时输出估计值并发送至所述导航参数计算模块;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910285563.2A CN110095121B (zh) | 2019-04-10 | 2019-04-10 | 一种抗机体磁干扰的无人机航向解算方法和*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910285563.2A CN110095121B (zh) | 2019-04-10 | 2019-04-10 | 一种抗机体磁干扰的无人机航向解算方法和*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110095121A CN110095121A (zh) | 2019-08-06 |
CN110095121B true CN110095121B (zh) | 2021-07-30 |
Family
ID=67444600
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910285563.2A Active CN110095121B (zh) | 2019-04-10 | 2019-04-10 | 一种抗机体磁干扰的无人机航向解算方法和*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110095121B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110488865B (zh) * | 2019-08-19 | 2022-09-20 | 深圳市道通智能航空技术股份有限公司 | 无人机航向确定方法、装置及无人机 |
CN112595317B (zh) * | 2020-10-26 | 2024-05-24 | 一飞(海南)科技有限公司 | 无人机起飞控制方法、***、介质、计算机设备、无人机 |
CN112985461B (zh) * | 2021-03-25 | 2023-11-03 | 成都纵横自动化技术股份有限公司 | 一种基于gnss测向的磁传感器校准方法 |
CN113959438A (zh) * | 2021-10-20 | 2022-01-21 | 广东电力通信科技有限公司 | 一种基于多源数据融合的导航定位方法、存储介质 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102654404A (zh) * | 2011-03-02 | 2012-09-05 | 浙江中科无线授时与定位研发中心 | 一种提高航姿参考***解算精度和***抗干扰能力的方法 |
CN102901977A (zh) * | 2012-10-24 | 2013-01-30 | 北京航天自动控制研究所 | 一种飞行器的初始姿态角的确定方法 |
CN106597017A (zh) * | 2016-12-16 | 2017-04-26 | 上海拓攻机器人有限公司 | 一种基于扩展卡尔曼滤波的无人机角加速度估计方法及装置 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8860609B2 (en) * | 2008-10-23 | 2014-10-14 | Texas Instruments Incorporated | Loosely-coupled integration of global navigation satellite system and inertial navigation system |
CN104897172B (zh) * | 2015-06-18 | 2018-04-13 | 南京航空航天大学 | 基于运动捕捉***的旋转mems惯导磁航向角误差补偿方法 |
CN105510849B (zh) * | 2015-11-26 | 2018-03-16 | 哈尔滨工业大学 | 航磁干扰补偿方法 |
CN105910623B (zh) * | 2016-04-14 | 2018-08-14 | 中国电子科技集团公司第五十四研究所 | 利用磁强计辅助gnss/mins紧组合***进行航向校正的方法 |
CN105928519B (zh) * | 2016-04-19 | 2019-03-29 | 成都翼比特自动化设备有限公司 | 基于ins惯性导航与gps导航以及磁力计的导航算法 |
CN106646281A (zh) * | 2016-10-11 | 2017-05-10 | 极翼机器人(上海)有限公司 | 一种无人机的磁传感器模块及其校准方法 |
-
2019
- 2019-04-10 CN CN201910285563.2A patent/CN110095121B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102654404A (zh) * | 2011-03-02 | 2012-09-05 | 浙江中科无线授时与定位研发中心 | 一种提高航姿参考***解算精度和***抗干扰能力的方法 |
CN102901977A (zh) * | 2012-10-24 | 2013-01-30 | 北京航天自动控制研究所 | 一种飞行器的初始姿态角的确定方法 |
CN106597017A (zh) * | 2016-12-16 | 2017-04-26 | 上海拓攻机器人有限公司 | 一种基于扩展卡尔曼滤波的无人机角加速度估计方法及装置 |
Non-Patent Citations (2)
Title |
---|
Integration of a Triaxial Magnetometer into a Helicopter UAV GPS-Aided INS;MARTIN BARCZYK 等;《IEEE TRANSACTIONS ON AEROSPACE AND ELECTRONIC SYSTEMS》;20121031;第48卷(第4期);第2947-2960页 * |
飞机磁干扰补偿技术;赵瑜 等;《电子世界》;20181231(第3期);第167-169页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110095121A (zh) | 2019-08-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110095121B (zh) | 一种抗机体磁干扰的无人机航向解算方法和*** | |
CN110058288B (zh) | 无人机ins/gnss组合导航***航向误差修正方法及*** | |
CN104635251B (zh) | 一种ins/gps组合定位定姿新方法 | |
US20200206945A1 (en) | Robot pose estimation method and apparatus and robot using the same | |
CN102654404B (zh) | 一种提高航姿参考***解算精度和***抗干扰能力的方法 | |
Xu et al. | A reliable hybrid positioning methodology for land vehicles using low-cost sensors | |
CN105674984A (zh) | 一种无约束使用移动终端获取行人前进方向的方法 | |
CN110887493A (zh) | 基于局部地图匹配的轨迹推算方法、介质、终端和装置 | |
CN105352502A (zh) | 一种微惯性航姿参考***的姿态获取方法 | |
CN104121930B (zh) | 一种基于加表耦合的mems陀螺漂移误差的补偿方法 | |
CN111993427B (zh) | 一种空中作业机器人的自增稳控制方法、装置、终端、***及可读存储介质 | |
CN112595317B (zh) | 无人机起飞控制方法、***、介质、计算机设备、无人机 | |
CN110375740B (zh) | 车辆导航方法、装置、设备和存储介质 | |
CN105865492A (zh) | 两轴磁强计在线误差补偿方法及*** | |
CN116823929A (zh) | 基于视觉图像与点云地图的跨模态匹配定位方法及*** | |
CN109753045B (zh) | 一种基于bp神经网络的航天器姿控***故障诊断方法 | |
CN111207734A (zh) | 一种基于ekf的无人机组合导航方法 | |
CN111610800B (zh) | 一种松耦合无人机控制*** | |
CN110514199B (zh) | 一种slam***的回环检测方法及装置 | |
CN112762936A (zh) | 一种运用于长航时无人机载荷的多源定位信息融合方法 | |
Dai et al. | Unmanned ground vehicle‐unmanned aerial vehicle relative navigation robust adaptive localization algorithm | |
CN113815875B (zh) | 吊舱控制方法、装置、吊舱、无人机及介质 | |
CN113391338B (zh) | 紧耦合轨迹修复方法、装置、设备、介质及产品 | |
Dai et al. | An Adaptive and Robust Strategy for GPS/IMU/VO Integrated Navigation | |
CN118310514A (zh) | 一种弱gnss环境下车辆定位方法和*** |
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 |