CN105865455B - 一种利用gps与加速度计计算飞行器姿态角的方法 - Google Patents

一种利用gps与加速度计计算飞行器姿态角的方法 Download PDF

Info

Publication number
CN105865455B
CN105865455B CN201610403806.4A CN201610403806A CN105865455B CN 105865455 B CN105865455 B CN 105865455B CN 201610403806 A CN201610403806 A CN 201610403806A CN 105865455 B CN105865455 B CN 105865455B
Authority
CN
China
Prior art keywords
coordinate system
axis
aircraft
under
navigation
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
Application number
CN201610403806.4A
Other languages
English (en)
Other versions
CN105865455A (zh
Inventor
舒胜
胡强
宋璟
苏浩秦
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
China Academy of Aerospace Aerodynamics CAAA
Original Assignee
China Academy of Aerospace Aerodynamics CAAA
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by China Academy of Aerospace Aerodynamics CAAA filed Critical China Academy of Aerospace Aerodynamics CAAA
Priority to CN201610403806.4A priority Critical patent/CN105865455B/zh
Publication of CN105865455A publication Critical patent/CN105865455A/zh
Application granted granted Critical
Publication of CN105865455B publication Critical patent/CN105865455B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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
    • 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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)

Abstract

一种利用GPS与加速度计计算飞行器姿态角的方法，根据GPS测得的飞行器导航坐标系下的飞行速度Vn计算导航坐标系下飞行速度的微分信号并根据公式计算获得导航坐标系下的比力fn，其中，为导航坐标系下哥式加速度，为导航坐标系下对地向心加速度，gn为导航坐标系下重力加速度；利用加速度计测得体坐标系下比力fb，求解转换关系式获得俯仰角偏航角滚转角γ，其中，为导航坐标系转换到体坐标系的姿态转换矩阵；本发明使飞行器无需陀螺就能获得姿态信息实现姿态控制并完成导航飞行，也能用于安装陀螺的飞行器上以提升飞行器故障余度。

Description

一种利用GPS与加速度计计算飞行器姿态角的方法
技术领域
本发明涉及一种计算飞行器姿态角的方法。
背景技术
飞行器所携带惯导组件均包含陀螺和加速度计，加速度计用来测量飞行器的加速度，陀螺用来测量飞行器的角运动。加速度和角速度用于解算飞行器六个自由度，是惯性导航的基本条件。
现有技术获取飞行器角运动的方式局限于使用陀螺进行量测。其缺陷在于：陀螺的成本相对加速度计较高，且易损坏。在开发低成本飞行器的过程中，陀螺的价格在整个飞行器制造的成本中占了很大的比重，是开发者必须面对的问题；
现有飞行器非常依赖惯性组件提供姿态信息，陀螺还在控制角运动的伺服回路中用作控制环节。在飞行过程中，若陀螺发生故障时没有备用陀螺以持续提供姿态信息，则飞行器无法继续导航，并且陀螺参与的姿态控制回路断开，飞行器无法继续保持姿态，会发生重大飞行事故；
陀螺由于其漂移的问题其输出量的误差会随时间增长而增长。在没有母惯导进行传递对准的情况下，成本较低的MEMS陀螺1分钟产生的误差便不满足姿态精度要求，而精度较高的陀螺又较昂贵。
发明内容
本发明所解决的技术问题是：克服现有技术的不足，提供一种利用GPS与加速度计计算飞行器姿态角的方法，使飞行器无需陀螺就能获得姿态信息，实现姿态控制并完成导航飞行，也能用于安装陀螺的飞行器上以提升飞行器故障余度，防止陀螺发生故障时发生飞行事故。
本发明所采用的技术方案是：一种利用GPS与加速度计计算飞行器姿态角的方法，根据GPS测得的飞行器导航坐标系下的飞行速度Vn计算导航坐标系下飞行速度的微分信号并根据公式计算获得导航坐标系下的比力fn，其中，gn为导航坐标系下重力加速度，为地球坐标系相对与地心惯性坐标系的旋转角速率在导航坐标系下的投影，为导航坐标系相对于地球坐标系的旋转角速率在导航坐标系下的投影；利用加速度计测得体坐标系下比力fb，求解转换关系式获得俯仰角偏航角滚转角γ，其中，为导航坐标系转换到体坐标系的姿态转换矩阵；
导航坐标系为北天东坐标系，坐标原点On位于飞行器起飞点，Onxn轴指向正北方向，Onyn轴指向天，Onzn轴按右手定则确定；体坐标系的原点Ob位于飞行器的质心，Obxb轴在飞行器对称平面内，平行于机身轴向前，Obyb轴在对称平面内垂直于Obxb轴，指向天，Obzb垂直对称平面指向右；地心惯性坐标系的原点位于地心，x轴指向春分点，z轴沿地球自转轴，y轴与x与z轴构成右手系；地球坐标系的原点位于地心，x轴穿过本初子午线与赤道的交点，z轴穿过地球北极点，y轴穿过东经90°子午线与赤道的交点，坐标系与地球固连。
所述飞行速度的微分信号获取方法如下：
采用四阶龙格-库塔法计算如下微分方程，积分步长h＝0.01，调整参数R与参数δ，得到x2：
其中，δ＝0.00005R；输入信号v(t)为导航坐标系下的飞行速度Vn，x1为输入信号v(t)的跟踪信号，x2为导航坐标系下的飞行速度的微分信号
所述的参数R在输入信号v(t)不含噪声时，取值范围为10～70；在输入信号v(t)含有1％的噪声时，取值范围为2.5～5。
所述转换关系式采用牛顿迭代法求解。
本发明与现有技术相比的优点在于：
(1)本发明的方法能够利用GPS与加速度计计算飞行器姿态角，当被用作主控环节时，在飞行器设计中可以取消其中的陀螺部件，有效降低飞行器生产成本，提高控制的精确度。
(2)本发明的方法用作余度飞行器上的故障应急方案，则可以在飞行器安装的陀螺发生故障时提供姿态信息，以保持飞行器姿态稳定，增大其故障余度，防止飞行事故的发生。
(3)本发明的方法计算得出的姿态信息不存在漂移问题，误差主要来自GPS误差，不会随时间增长而增长，并且通过跟踪-微分器解决微分信号中噪声过大的问题，不仅可减小姿态噪声还可以滤除GPS输出速度信号中的噪声，提高了测量精度。
附图说明
图1为飞行器飞行方案示意图；
图2为本发明的姿态角计算方法流程图。
具体实施方式
图1为飞行器飞行方案示意图，首先说明本方案中提到的两种坐标系。
导航坐标系采用北天东坐标系，坐标原点On位于飞行器起飞点；Onxn轴指向正北方向；Onyn轴指向天；Onzn轴按右手定则确定，既正东方向。
体坐标系是固连于飞行器并随其运动的一种动坐标系。其原点Ob位于飞行器的质心；Obxb轴在飞行器对称平面内，平行于机身轴向前；Obyb轴亦在对称平面内垂直于Obxb轴，指向天；Obzb垂直对称平面指向右。
本文中所计算的姿态角便是体坐标系与导航坐标系之间的旋转角度。
飞行器在飞行过程中利用GPS接收机接收GPS卫星信号，GPS实时提供飞行器位置信息与速度信息Vn均为导航坐标系下的值；利用飞行器上的加速度计得到体坐标系下的实时比力信息fb。Vn与fb为提取导航坐标系与体坐标系之间姿态转换矩阵的输入。
如图2，一种利用GPS与加速度计计算飞行器姿态角的方法，包括步骤如下：
(1)由GPS得出飞行器飞行速度Vn，并通过非线性跟踪-微分器计算出速度的近似微分信号并通过比力方程去除有害加速度获得导航坐标系下的比力fn；
通过二阶非线性跟踪-微分器计算出速度的近似微分信号的方法，其方程为
式中，
其中，参数R越大，跟踪效果越好，但是R过大会给微分信号增加高频噪声，具体R与δ的取值根据GPS提供的速度信号质量而定。
一般遵循以下取值原则：
(1)在输入不含噪声时，R的取值在10～70；
(2)在输入含有1％的噪声时，微分信号震荡加大，在保证跟踪的前提下，R要尽可能小，取值在2.5～5；
(3)参数δ的取值对微分信号有极大影响，要保证微分信号尽可能不受δ的影响，δ与R之间的关系是R增大时δ应增大相应的倍数，在此二阶非线性跟踪-微分器中令δ＝0.00005R；
根据Vn的信号质量设计二阶非线性跟踪-微分器中R与δ值的大小后，将Vn输入作为输入信号v(t)代入公式中，输出信号x1为输入v(t)的跟踪信号，可以认为是处理之后的输入信号，采用四阶龙格-库塔法解此微分方程，积分步长取h＝0.01，调整R与δ的大小得到两个光滑可用的信号，x1为v(t)的跟踪信号，x2为v(t)的近似微分信号既导航坐标系下的飞行速度的微分信号
(2)通过比力方程去除有害加速度获得导航坐标系下的比力的方法：该比力方程为是比力方程导航坐标系下的形式，其中所有的量都取导航坐标系下的值，包括哥式加速度对地向心加速度以及重力加速度gn，为地球坐标系相对与地心惯性坐标系的旋转角速率在导航坐标系下的投影，为导航坐标系相对于地球坐标系的旋转角速率在导航坐标系下的投影；在与gn均为已知值的情况下导航坐标系下的比力fn可以通过转换后的公式实时求出。地心惯性坐标系的原点位于地心，x轴指向春分点，z轴沿地球自转轴，y轴与x与z轴构成右手系；地球坐标系的原点位于地心，x轴穿过本初子午线与赤道的交点，z轴穿过地球北极点，y轴穿过东经90°子午线与赤道的交点，坐标系与地球固连。
(3)由加速度计获得体坐标系下的比力fb；利用姿态转换矩阵与姿态角的关系及两个坐标系下比力的转换关系得出姿态角与两坐标系下比力的关系式，并采用牛顿迭代法求解出姿态角。
姿态转换矩阵为：
体坐标系下的比力值fb与导航坐标系下的比力值fn存在如下转换关系展开可得
既可得到姿态角与两坐标系下比力的关系式：
其中，均已知，姿态角γ为未知数，采用牛顿迭代法解此方程既可得到姿态角。其中，为fb沿体坐标系三轴的分量，为fn沿导航坐标系三轴的分量，姿态角包括：俯仰角偏航角滚转角γ。
本发明说明书中未详细说明的内容属于本领域技术人员公知常识。

Claims (3)

1.一种利用GPS与加速度计计算飞行器姿态角的方法，其特征在于：根据GPS测得的飞行器导航坐标系下的飞行速度Vn计算导航坐标系下飞行速度的微分信号并根据公式计算获得导航坐标系下的比力fn，其中，gn为导航坐标系下重力加速度，为地球坐标系相对于地心惯性坐标系的旋转角速率在导航坐标系下的投影，为导航坐标系相对于地球坐标系的旋转角速率在导航坐标系下的投影；利用加速度计测得体坐标系下比力fb，求解转换关系式获得俯仰角偏航角滚转角γ，其中，为导航坐标系转换到体坐标系的姿态转换矩阵；
导航坐标系为北天东坐标系，坐标原点On位于飞行器起飞点，Onxn轴指向正北方向，Onyn轴指向天，Onzn轴按右手定则确定；体坐标系的原点Ob位于飞行器的质心，Obxb轴在飞行器对称平面内，平行于机身轴向前，Obyb轴在对称平面内垂直于Obxb轴，指向天，Obzb垂直对称平面指向右；地心惯性坐标系的原点位于地心，x轴指向春分点，z轴沿地球自转轴，y轴与x与z轴构成右手系；地球坐标系的原点位于地心，x轴穿过本初子午线与赤道的交点，z轴穿过地球北极点，y轴穿过东经90°子午线与赤道的交点，坐标系与地球固连；
所述飞行速度的微分信号获取方法如下：
采用四阶龙格-库塔法计算如下微分方程，积分步长h＝0.01，调整参数R与参数δ，得到x2：
其中，令δ＝0.00005R；输入信号v(t)为导航坐标系下的飞行速度Vn，x1为输入信号v(t)的跟踪信号，x2为导航坐标系下的飞行速度的微分信号
2.根据权利要求1所述的一种利用GPS与加速度计计算飞行器姿态角的方法，其特征在于：所述的参数R在输入信号v(t)不含噪声时，取值范围为10～70；在输入信号v(t)含有1％的噪声时，取值范围为2.5～5。
3.根据权利要求1或2所述的一种利用GPS与加速度计计算飞行器姿态角的方法，其特征在于：所述转换关系式采用牛顿迭代法求解。
CN201610403806.4A 2016-06-08 2016-06-08 一种利用gps与加速度计计算飞行器姿态角的方法 Active CN105865455B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610403806.4A CN105865455B (zh) 2016-06-08 2016-06-08 一种利用gps与加速度计计算飞行器姿态角的方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610403806.4A CN105865455B (zh) 2016-06-08 2016-06-08 一种利用gps与加速度计计算飞行器姿态角的方法

Publications (2)

Publication Number Publication Date
CN105865455A CN105865455A (zh) 2016-08-17
CN105865455B true CN105865455B (zh) 2018-07-24

Family

ID=56677403

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610403806.4A Active CN105865455B (zh) 2016-06-08 2016-06-08 一种利用gps与加速度计计算飞行器姿态角的方法

Country Status (1)

Country Link
CN (1) CN105865455B (zh)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107632315A (zh) * 2017-09-18 2018-01-26 佛山科学技术学院 一种大空域三维相对导航方法
CN107764260A (zh) * 2017-09-30 2018-03-06 湖南城市学院 一种卫星航迹定位系统
CN107860384A (zh) * 2017-10-19 2018-03-30 中国科学院电子学研究所 基于gps与加速度计的姿态观测方法
CN108548535B (zh) * 2018-03-13 2021-08-31 北京沙谷科技有限责任公司 低速gnss/mems组合导航系统的初始化方法
CN109211230B (zh) * 2018-09-07 2022-02-15 东南大学 一种基于牛顿迭代法的炮弹姿态和加速度计常值误差估计方法
CN109635388B (zh) * 2018-11-29 2023-04-18 中国航空工业集团公司沈阳飞机设计研究所 一种全机加速度参数测算方法
CN110487277B (zh) * 2019-08-21 2021-07-30 深圳市道通智能航空技术股份有限公司 一种偏航角的融合方法、装置及飞行器
CN113608543A (zh) * 2021-08-31 2021-11-05 普宙科技(深圳)有限公司 飞行器航迹自适应规划的方法、装置、设备及存储介质
CN115060256B (zh) * 2022-07-05 2022-11-08 西北工业大学 一种基于发射坐标系的制导炮弹空中姿态辨识方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103900614A (zh) * 2014-03-28 2014-07-02 哈尔滨工程大学 一种九加速度计无陀螺惯导系统的重力补偿方法
CN103900565A (zh) * 2014-03-04 2014-07-02 哈尔滨工程大学 一种基于差分gps的惯导系统姿态获取方法
CN104422948A (zh) * 2013-09-11 2015-03-18 南京理工大学 一种嵌入式组合导航系统及其方法
CN104697520A (zh) * 2015-02-05 2015-06-10 南京航空航天大学 一体化无陀螺捷联惯导系统与gps系统组合导航方法
CN105180928A (zh) * 2015-07-30 2015-12-23 哈尔滨工程大学 一种基于惯性系重力特性的船载星敏感器定位方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CA2875332A1 (en) * 2012-06-07 2013-12-12 Zoll Medical Corporation Systems and methods for video capture, user feedback, reporting, adaptive parameters, and remote data access in vehicle safety monitoring

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104422948A (zh) * 2013-09-11 2015-03-18 南京理工大学 一种嵌入式组合导航系统及其方法
CN103900565A (zh) * 2014-03-04 2014-07-02 哈尔滨工程大学 一种基于差分gps的惯导系统姿态获取方法
CN103900614A (zh) * 2014-03-28 2014-07-02 哈尔滨工程大学 一种九加速度计无陀螺惯导系统的重力补偿方法
CN104697520A (zh) * 2015-02-05 2015-06-10 南京航空航天大学 一体化无陀螺捷联惯导系统与gps系统组合导航方法
CN105180928A (zh) * 2015-07-30 2015-12-23 哈尔滨工程大学 一种基于惯性系重力特性的船载星敏感器定位方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
单天线GPS/加速度计组合测姿方法研究;卢鸿谦等;《哈尔滨工程大学学报》;20061231;第27卷(第6期);第854-857、903页 *
基于单天线GPS的无陀螺姿态测量系统设计;马培圣等;《计算机测量与控制》;20131231;第21卷(第6期);第1465-1466、1469页 *

Also Published As

Publication number Publication date
CN105865455A (zh) 2016-08-17

Similar Documents

Publication Publication Date Title
CN105865455B (zh) 一种利用gps与加速度计计算飞行器姿态角的方法
CN109813311B (zh) 一种无人机编队协同导航方法
WO2020220729A1 (zh) 基于角加速度计/陀螺/加速度计的惯性导航解算方法
CN104655152B (zh) 一种基于联邦滤波的机载分布式pos实时传递对准方法
CN112630813B (zh) 基于捷联惯导和北斗卫星导航系统的无人机姿态测量方法
CN104374388B (zh) 一种基于偏振光传感器的航姿测定方法
CN109000665B (zh) 一种深空着陆几何定轨定姿方法、系统及深空着陆器
CN111207745B (zh) 一种适用于大机动无人机垂直陀螺仪的惯性测量方法
CN106708066A (zh) 基于视觉/惯导的无人机自主着陆方法
CN103900576B (zh) 一种深空探测自主导航的信息融合方法
CN102809377A (zh) 飞行器惯性/气动模型组合导航方法
CN103925930B (zh) 一种重力仪双轴陀螺稳定平台航向误差效应的补偿方法
CN104697520B (zh) 一体化无陀螺捷联惯导系统与gps系统组合导航方法
CN106813662A (zh) 一种基于光流的导航方法
CN102829781A (zh) 一种旋转式捷联光纤罗经实现的方法
CN104215244B (zh) 基于发射惯性坐标系的空天飞行器组合导航鲁棒滤波方法
CN108534783A (zh) 一种基于北斗导航技术的飞行器导航方法
CN104457748A (zh) 一种嵌入式瞄准吊舱测姿系统及其传递对准方法
CN105928515A (zh) 一种无人机导航系统
Islam et al. A low cost MEMS and complementary filter based attitude heading reference system (AHRS) for low speed aircraft
Rhudy et al. Wide-field optical flow aided inertial navigation for unmanned aerial vehicles
Han et al. Vehicle positioning algorithm based on NHC/virtual-MINS/OD
Yang et al. Model-free integrated navigation of small fixed-wing UAVs full state estimation in wind disturbance
CN112649001B (zh) 一种小型无人机姿态与位置解算方法
Wang et al. Uav attitude measurement based on enhanced mahony complementary filter

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant