CN103542853A - 一种估计加速度计漂移的绝对导航滤波方法 - Google Patents
一种估计加速度计漂移的绝对导航滤波方法 Download PDFInfo
- Publication number
- CN103542853A CN103542853A CN201310559590.7A CN201310559590A CN103542853A CN 103542853 A CN103542853 A CN 103542853A CN 201310559590 A CN201310559590 A CN 201310559590A CN 103542853 A CN103542853 A CN 103542853A
- Authority
- CN
- China
- Prior art keywords
- error
- inertial
- acceleration
- axis
- coordinate system
- 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.)
- Granted
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/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
-
- 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/24—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Astronomy & Astrophysics (AREA)
- Manufacturing & Machinery (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
一种估计加速度计漂移的绝对导航滤波方法,由于采用GPS接收机输出位置信息,并采用PI滤波技术对位置误差、速度误差和加速度误差进行估计,省掉KALMAN滤波解算,大大简化星上计算量,同时对加速度误差进行估计,可以提高惯导递推精度,能够显著改善自主导航的精度,提高工程实用性,取得了自主导航新思路以及可以扩展到深空探测软着陆应用等有益效果。
Description
技术领域
本发明涉及基于惯导和GPS接收机的绝对导航技术,尤其涉及一种估计加速度计漂移的绝对导航滤波方法。
背景技术
开展航天器自主导航技术研究,可以减轻地面站的工作量,缓解因地域限制造成的地面测控站布点的困难;其次由于自主导航可以及时确定卫星的位置,因此可以提高卫星观测数据的利用率,增强卫星在执行任务时的灵活性与准确性,提高卫星的生存能力,即使发生地面跟踪测量被迫中断的恶劣情况时,仍可以保持飞行任务的连续性,其实用意义尤为明显。
目前,现有的卫星自主导航技术基于惯导和GPS接收机的组合导航技术理论研究较多,该方法可以充分发挥GPS接收机和惯导的优点,但由于计算量较大,很难进入工程应用阶段。
发明内容
本发明提供的一种估计加速度计漂移的绝对导航滤波方法,可以大大减少星上计算量,并对加速度误差进行估计,提高惯导递推精度。
为了达到上述目的,本发明提供一种估计加速度计漂移的绝对导航滤波方法,该方法包含以下步骤:
步骤1、根据惯测组合输出的角速度和加速度,进行惯导解算,输出航天器在惯性坐标系下的位置和速度信息Xsins;
步骤2、GPS接收机定位后,利用GPS接收机输出的惯性坐标系下的位置和速度信息Xgps,采用PI滤波技术对步骤1中惯导解算的位置误差、速度误差及加速度误差进行估计,在步骤1的惯导解算中进行扣除,并对惯导解算结果进行修正;
步骤3、将步骤2中得到的惯导计算结果与轨道发生器产生的理论结果做差值计算,计算误差百分比,评估导航精度。
所述的步骤1包含以下步骤:
步骤1.1、求取本体坐标系相对惯性坐标系的姿态四元数:
本体坐标系的原点在航天器质心,X轴沿航天器纵轴指向航天器飞行方向,Z轴沿航天器竖轴,Y轴与X轴,Z轴构成右手直角坐标系;
惯性坐标系的原点在地心,X轴指向春分点,Z轴指向北极,Y轴在赤道面内与X轴,Z轴构成右手直角坐标系;
步骤1.2、求取惯性坐标系的加速度:
步骤1.3、求取惯导解算位置:
步骤1.4、求取惯导解算速度:
由当前位置,计算当前地球引力项:
;
惯导***速度求解:
所述的步骤2包含以下步骤:
步骤2.1、位置误差估计:
对三轴位置进行限幅,超过r1取r1,小于- r1取-r1,其中r1大于0,限幅到[-r1,r1](r1可以选取为40);
;
步骤2.2、位置误差估计:
;
其中,Δνb是本体坐标系的速度误差。
步骤2.3、加速度误差估计:
本发明由于采用GPS接收机输出位置信息,并采用PI滤波技术对位置误差、速度误差和加速度误差进行估计,省掉KALMAN滤波解算,大大简化星上计算量,同时对加速度误差进行估计,可以提高惯导递推精度,能够显著改善自主导航的精度,提高工程实用性,取得了自主导航新思路以及可以扩展到深空探测软着陆应用等有益效果。
附图说明
图1是本发明提供的一种估计加速度计漂移的绝对导航滤波方法的示意图。
具体实施方式
以下根据图1具体说明本发明的较佳实施例。
如图1所示,本发明提供一种估计加速度计漂移的绝对导航滤波方法,该方法包含以下步骤:
步骤1、根据惯测组合(包含加速度计和陀螺)输出的角速度和加速度,进行惯导解算,输出航天器在惯性坐标系下的位置和速度信息,用Xsins表示航天器在惯性坐标系下的位置和速度信息;
步骤1.1、求取本体坐标系相对惯性坐标系的姿态四元数:
本体坐标系的原点在航天器质心,X轴沿航天器纵轴指向航天器飞行方向,Z轴沿航天器竖轴,Y轴与X轴,Z轴构成右手直角坐标系;
惯性坐标系的原点在地心,X轴指向春分点,Z轴指向北极,Y轴在赤道面内与X轴,Z轴构成右手直角坐标系;
步骤1.2、求取惯性坐标系的加速度:
步骤1.3、求取惯导解算位置:
步骤1.4、求取惯导解算速度:
由当前位置,计算当前地球引力项:
惯导***速度求解:
;
步骤2、GPS接收机定位后,利用GPS接收机输出的惯性坐标系下的位置和速度信息(用Xgps表示惯性坐标系下的位置和速度信息),采用PI滤波技术对步骤1中惯导解算的位置误差、速度误差及加速度误差进行估计,在步骤1的惯导解算中进行扣除,并对惯导解算结果进行修正;
步骤2.1、位置误差估计:
步骤2.2、位置误差估计:
;
步骤2.3、加速度误差估计:
步骤3、将步骤2中得到的惯导计算结果与轨道发生器产生的理论结果做差值计算,计算误差百分比,评估导航精度。
尽管本发明的内容已经通过上述优选实施例作了详细介绍,但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后,对于本发明的多种修改和替代都将是显而易见的。因此,本发明的保护范围应由所附的权利要求来限定。
Claims (3)
1.一种估计加速度计漂移的绝对导航滤波方法,其特征在于,该方法包含以下步骤:
步骤1、根据惯测组合输出的角速度和加速度,进行惯导解算,输出航天器在惯性坐标系下的位置和速度信息Xsins;
步骤2、GPS接收机定位后,利用GPS接收机输出的惯性坐标系下的位置和速度信息Xgps,采用PI滤波技术对步骤1中惯导解算的位置误差、速度误差及加速度误差进行估计,在步骤1的惯导解算中进行扣除,并对惯导解算结果进行修正;
步骤3、将步骤2中得到的惯导计算结果与轨道发生器产生的理论结果做差值计算,计算误差百分比,评估导航精度。
2.如权利要求1所述的估计加速度计漂移的绝对导航滤波方法,其特征在于,所述的步骤1包含以下步骤:
步骤1.1、求取本体坐标系相对惯性坐标系的姿态四元数:
本体坐标系的原点在航天器质心,X轴沿航天器纵轴指向航天器飞行方向,Z轴沿航天器竖轴,Y轴与X轴,Z轴构成右手直角坐标系;
惯性坐标系的原点在地心,X轴指向春分点,Z轴指向北极,Y轴在赤道面内与X轴,Z轴构成右手直角坐标系;
步骤1.2、求取惯性坐标系的加速度:
;
步骤1.3、求取惯导解算位置:
步骤1.4、求取惯导解算速度:
由当前位置,计算当前地球引力项:
惯导***速度求解:
3.如权利要求1所述的估计加速度计漂移的绝对导航滤波方法,其特征在于,所述的步骤2包含以下步骤:
步骤2.1、位置误差估计:
;
步骤2.2、位置误差估计:
步骤2.3、加速度误差估计:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310559590.7A CN103542853B (zh) | 2013-11-12 | 2013-11-12 | 一种估计加速度计漂移的绝对导航滤波方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310559590.7A CN103542853B (zh) | 2013-11-12 | 2013-11-12 | 一种估计加速度计漂移的绝对导航滤波方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103542853A true CN103542853A (zh) | 2014-01-29 |
CN103542853B CN103542853B (zh) | 2016-06-01 |
Family
ID=49966542
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310559590.7A Active CN103542853B (zh) | 2013-11-12 | 2013-11-12 | 一种估计加速度计漂移的绝对导航滤波方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103542853B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105445763A (zh) * | 2014-09-17 | 2016-03-30 | 上海新跃仪表厂 | 基于跟瞄信息的目标重构方法 |
CN105486305A (zh) * | 2014-09-17 | 2016-04-13 | 上海新跃仪表厂 | 一种估计加速度计漂移的近程相对导航滤波方法 |
CN106123923A (zh) * | 2016-08-03 | 2016-11-16 | 哈尔滨工程大学 | 一种基于速度辅助的惯性导航***陀螺漂移修正方法 |
CN106324285A (zh) * | 2016-11-11 | 2017-01-11 | 苏州工讯科技有限公司 | 一种针对工业产品物流过程中平稳水平的测试装置及方法 |
CN107860384A (zh) * | 2017-10-19 | 2018-03-30 | 中国科学院电子学研究所 | 基于gps与加速度计的姿态观测方法 |
CN110596426A (zh) * | 2019-09-25 | 2019-12-20 | 上海航天控制技术研究所 | 一种加速度计组合数据漂移自主辨识方法 |
CN111637894A (zh) * | 2020-04-28 | 2020-09-08 | 北京控制工程研究所 | 一种定常系数陆标图像导航滤波方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5410481A (en) * | 1991-03-04 | 1995-04-25 | TZN Forschungs-und Entwicklungs-zentrum Unterluss GmbH | Method of determining the rate of rotation of vehicles and vehicle arrangement for implementing the method |
CN101319902A (zh) * | 2008-07-18 | 2008-12-10 | 哈尔滨工程大学 | 一种低成本组合式定位定向装置及组合定位方法 |
CN201266089Y (zh) * | 2008-09-05 | 2009-07-01 | 北京七维航测科技发展有限公司 | Ins/gps组合导航*** |
CN102508277A (zh) * | 2011-10-27 | 2012-06-20 | 中国矿业大学 | 精密单点定位与惯性测量紧组合导航***及数据处理方法 |
-
2013
- 2013-11-12 CN CN201310559590.7A patent/CN103542853B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5410481A (en) * | 1991-03-04 | 1995-04-25 | TZN Forschungs-und Entwicklungs-zentrum Unterluss GmbH | Method of determining the rate of rotation of vehicles and vehicle arrangement for implementing the method |
CN101319902A (zh) * | 2008-07-18 | 2008-12-10 | 哈尔滨工程大学 | 一种低成本组合式定位定向装置及组合定位方法 |
CN201266089Y (zh) * | 2008-09-05 | 2009-07-01 | 北京七维航测科技发展有限公司 | Ins/gps组合导航*** |
CN102508277A (zh) * | 2011-10-27 | 2012-06-20 | 中国矿业大学 | 精密单点定位与惯性测量紧组合导航***及数据处理方法 |
Non-Patent Citations (1)
Title |
---|
王坚等: "基于低通滤波的GPS/INS组合导航模型研究", 《导航定位学报》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105445763A (zh) * | 2014-09-17 | 2016-03-30 | 上海新跃仪表厂 | 基于跟瞄信息的目标重构方法 |
CN105486305A (zh) * | 2014-09-17 | 2016-04-13 | 上海新跃仪表厂 | 一种估计加速度计漂移的近程相对导航滤波方法 |
CN105486305B (zh) * | 2014-09-17 | 2018-12-28 | 上海新跃仪表厂 | 一种估计加速度计漂移的近程相对导航滤波方法 |
CN106123923A (zh) * | 2016-08-03 | 2016-11-16 | 哈尔滨工程大学 | 一种基于速度辅助的惯性导航***陀螺漂移修正方法 |
CN106123923B (zh) * | 2016-08-03 | 2019-02-26 | 哈尔滨工程大学 | 一种基于速度辅助的惯性导航***陀螺漂移修正方法 |
CN106324285A (zh) * | 2016-11-11 | 2017-01-11 | 苏州工讯科技有限公司 | 一种针对工业产品物流过程中平稳水平的测试装置及方法 |
CN107860384A (zh) * | 2017-10-19 | 2018-03-30 | 中国科学院电子学研究所 | 基于gps与加速度计的姿态观测方法 |
CN110596426A (zh) * | 2019-09-25 | 2019-12-20 | 上海航天控制技术研究所 | 一种加速度计组合数据漂移自主辨识方法 |
CN111637894A (zh) * | 2020-04-28 | 2020-09-08 | 北京控制工程研究所 | 一种定常系数陆标图像导航滤波方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103542853B (zh) | 2016-06-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103542853A (zh) | 一种估计加速度计漂移的绝对导航滤波方法 | |
CN107655476B (zh) | 基于多信息融合补偿的行人高精度足部导航方法 | |
Gowda et al. | Tracking drone orientation with multiple GPS receivers | |
CN101256080B (zh) | 卫星/惯性组合导航***的空中对准方法 | |
CN105371844B (zh) | 一种基于惯性/天文互助的惯性导航***初始化方法 | |
CN103235328A (zh) | 一种gnss与mems组合导航的方法 | |
CN103453907B (zh) | 基于分层大气模型的行星进入段导航滤波方法 | |
CN108151737A (zh) | 一种动态互观测关系条件下的无人机蜂群协同导航方法 | |
Yun et al. | IMU/Vision/Lidar integrated navigation system in GNSS denied environments | |
CN105241456B (zh) | 巡飞弹高精度组合导航方法 | |
CN104697520A (zh) | 一体化无陀螺捷联惯导***与gps***组合导航方法 | |
CN101285687B (zh) | 地空天一体化自主导航***设计方法 | |
CN105737834B (zh) | 一种基于轨道平根数的相对导航鲁棒滤波方法 | |
Wang et al. | Evaluation on loosely and tightly coupled GNSS/INS vehicle navigation system | |
CN103954281A (zh) | 一种基于共面星间测向和异面星间测距的星座导航方法 | |
CN105115507A (zh) | 一种基于双imu的双模式室内个人导航***及方法 | |
CN104567868A (zh) | 基于ins修正的机载长航时天文导航***的方法 | |
CN103950555A (zh) | 超近距离的高精度相对位置保持控制方法 | |
CN105486305B (zh) | 一种估计加速度计漂移的近程相对导航滤波方法 | |
CN107830856B (zh) | 面向编队飞行的太阳tdoa量测方法及组合导航方法 | |
CN105180928A (zh) | 一种基于惯性系重力特性的船载星敏感器定位方法 | |
Vigrahala et al. | Attitude, Position and Velocity determination using Low-cost Inertial Measurement Unit for Global Navigation Satellite System Outages | |
CN105445763A (zh) | 基于跟瞄信息的目标重构方法 | |
Kumar et al. | Optimized inertial navigation system with kalman filter based altitude determination for aircraft in GPS deprived regions | |
Luo et al. | An imu/visual odometry integrated navigation method based on measurement model optimization |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20170623 Address after: 200233 Xuhui District, Yishan Road, No. 710, Patentee after: SHANGHAI AEROSPACE CONTROL TECHNOLOGY RESEARCH INSTITUTE Address before: 200233 Xuhui District, Yishan Road, No. 710, Patentee before: Shanghai Xinyue Instrument Factory |