CN115355906B - 一种基于惯导和卫星方向矢量的组合导航方法 - Google Patents
一种基于惯导和卫星方向矢量的组合导航方法 Download PDFInfo
- Publication number
- CN115355906B CN115355906B CN202211276149.3A CN202211276149A CN115355906B CN 115355906 B CN115355906 B CN 115355906B CN 202211276149 A CN202211276149 A CN 202211276149A CN 115355906 B CN115355906 B CN 115355906B
- Authority
- CN
- China
- Prior art keywords
- navigation
- aircraft
- star sensor
- space
- state
- 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/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/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- 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/02—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means
-
- 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/183—Compensation of inertial measurements, e.g. for temperature effects
- G01C21/188—Compensation of inertial measurements, e.g. for temperature effects for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Astronomy & Astrophysics (AREA)
- Navigation (AREA)
Abstract
本发明提供了一种基于惯导和卫星方向矢量的组合导航方法,包括:步骤S1:利用星敏感器对单个已编目的空间目标进行观测,根据观测图像获取观测的空间目标在星敏感器像平面的坐标;步骤S2:获取观测的空间目标相对于星敏感器的方向矢量;步骤S3:构建组合导航系统模型:以飞行器的位置、速度、姿态、加速度计偏置和陀螺仪漂移为状态量构建状态方程;以观测的空间目标相对于星敏感器的方向矢量为观测量构建测量方程;步骤S4:利用滤波算法获得飞行器的导航状态量估计值,并利用获得的加速度计偏置和陀螺仪漂移的估计值对惯性导航进行修正。本发明的方法解决了现有技术中根据星光折射信息对惯导修正存在导航精度不高的弊端。
Description
技术领域
本发明涉及导航技术领域,具体涉及一种基于惯导和卫星方向矢量的组合导航方法。
背景技术
临近空间飞行器是指运行于临近空间的一类飞行器,包括飞艇、高空气球、高空无人机、滑翔飞行器等。临近空间飞行器具有覆盖范围广、反应时间短、续航时间久等独特优势,在环境探测、灾害评估等领域具有广泛的应用前景。自主导航技术是临近空间飞行器自动化、智能化运行的关键,对于增强临近空间飞行器的任务执行能力具有重要意义。
目前常用飞行器自主导航技术主要包括惯性导航和卫星导航。惯性导航具有完全自主性的独特优势,但惯性导航的系统误差会随运行时间不断增大,无法独立支持临近空间飞行器的长期自主运行。卫星导航可以提供高精度的导航定位服务,但由于卫星导航信息易被干扰,导致其不具备完全的自主性。
因此,将惯性导航和卫星导航相结合的组合导航技术应运而生。现有组合导航技术中,利用星光折射信息对惯导加速度计偏差(即加速度计偏置)进行修正。但是,由于星光折射信息受大气模型误差影响较大,难以提供精准的惯导修正信息,使得组合导航系统的精度受到严重制约。
综上所述,急需一种基于惯导和卫星方向矢量的组合导航方法以解决现有技术中存在的问题。
发明内容
本发明目的在于提供一种基于惯导和卫星方向矢量的组合导航方法,旨在解决现有组合导航技术采用星光折射信息对惯导进行修正,存在导航精度不高的问题,具体技术方案如下:
一种基于惯导和卫星方向矢量的组合导航方法,包括以下步骤:
步骤S1:利用星敏感器对单个已编目的空间目标进行观测,根据观测图像获取观测的空间目标在星敏感器像平面的坐标;
步骤S2:获取观测的空间目标相对于星敏感器的方向矢量;
步骤S3:构建组合导航系统模型:以飞行器的位置、速度、姿态、加速度计偏置和陀螺仪漂移为状态量构建状态方程;以观测的空间目标相对于星敏感器的方向矢量为观测量构建测量方程;
步骤S4:利用滤波算法获得飞行器的导航状态量估计值,并利用获得的加速度计偏置和陀螺仪漂移的估计值对惯性导航进行修正。
以上技术方案中优选的,利用观测图像中的背景恒星与恒星星表进行匹配,获得星敏感器光轴在惯性空间中的指向。
以上技术方案中优选的,所述步骤S1中,观测的空间目标在已知空间目标编目数据库中的编号为已知。
以上技术方案中优选的,所述步骤S3中,状态方程的构建具体如下:
则构建的状态方程为:
以上技术方案中优选的,测量方程的构建如下:
以上技术方案中优选的,所述步骤S4中,采用无迹卡尔曼滤波算法获得飞行器的导航状态量估计值;其中,状态方程用于无迹卡尔曼滤波算法中的时间更新步骤,测量方程用于无迹卡尔曼滤波算法中的测量更新步骤。
应用本发明的技术方案,具有以下有益效果:
本发明的组合导航方法,利用星敏感器对已编目的空间目标进行观测,并以观测空间目标相对于星敏感器的方向矢量为观测量构建测量方程,然后利用估计获得的加速度计偏置和陀螺仪漂移的估计值对惯导进行修正;即本发明中利用已编目空间目标的方向矢量对惯导偏差进行修正,可有效克服惯导定位误差随时间增大的缺点,从而显著提高组合导航的位置估计精度,并且由于空间目标方向矢量测量模型的精度远高于恒星星光折射测量模型,解决了现有技术中根据星光折射信息对惯导修正存在导航精度不高的弊端。
本发明组合导航的信息来源为惯导和已编目的空间目标,惯导具有高可靠性和高动态性,而已编目的空间目标数量多,分布广,其光学观测信号不易被干扰,使得该组合导航方法具有很强的可靠性和自主性。
除了上面所描述的目的、特征和优点之外,本发明还有其它的目的、特征和优点。下面将参照图,对本发明作进一步详细的说明。
附图说明
构成本申请的一部分的附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1是基于惯导和卫星方向矢量的组合导航方法的系统框架图;
图2是仿真应用案例中飞行器的定位结果图。
具体实施方式
为了便于理解本发明,下面将对本发明进行更全面的描述,并给出了本发明的较佳实施例。但是,本发明可以以许多不同的形式来实现,并不限于本文所描述的实施例。相反地,提供这些实施例的目的是使对本发明的公开内容的理解更加透彻全面。
除非另有定义,本文所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中在本发明的说明书中所使用的术语只是为了描述具体的实施例的目的,不是旨在于限制本发明。
实施例1:
参见图1,一种基于惯导(即惯性导航)和方向矢量的组合导航方法,包括以下步骤:
步骤S1:利用星敏感器对单个已编目的空间目标进行观测,根据观测图像获取观测的空间目标在星敏感器像平面的坐标;
空间目标包括绕地球飞行的卫星、空间碎片等物体,现有空间态势感知系统已经可以对大部分空间目标进行编目,构建其轨道信息数据库并定期更新。本实施例中观测的空间目标在已知空间目标编目数据库中的编号为已知,因此观测空间目标的轨道位置信息可以直接获取,本实施例的导航方法中空间目标为卫星,即步骤S1观测的是星历已知的卫星;其中,星敏感器是搭载于飞行器上。
步骤S2:获取观测的空间目标相对于星敏感器的方向矢量;
步骤S3:构建组合导航系统模型:以飞行器的位置、速度、姿态、加速度计偏置和陀螺仪漂移为状态量构建状态方程;以观测的空间目标相对于星敏感器的方向矢量为观测量构建测量方程;
进一步的,状态方程的构建具体如下:
则构建的状态方程为:
测量方程的构建如下:
步骤S4:利用滤波算法获得飞行器的导航状态量估计值,并利用获得的加速度计偏置和陀螺仪漂移的估计值对惯性导航进行修正。
具体的,由于导航系统的状态方程和测量方程均为非线性,因此可以采用无迹卡尔曼滤波算法获得飞行器的导航状态量估计值,即获得飞行器的位置、速度、姿态、加速度计偏置和陀螺仪漂移的估计值;其中,状态方程用于无迹卡尔曼滤波算法中的时间更新步骤,测量方程用于无迹卡尔曼滤波算法中的测量更新步骤。
本领域人员知晓,无迹卡尔曼滤波算法为本领域的公知技术,例如申请号为CN201910784120.8的专利申请、《王建琦,曹喜滨,孙兆伟.基于UKF算法的航天器自主导航研究[J].飞行力学,2004(02):41-44.》、《李璟璟. 基于自适应UKF及位速测量辅助的大椭圆轨道卫星自主导航[D].哈尔滨工业大学,2012.》、《杨文博,李少远.基于强跟踪UKF的航天器自主导航间接量测滤波算法[J].系统工程与电子技术,2011,33(11):2485-2491.》以及《桂先洲,李志豪,黎胜亮.基于X射线脉冲星自主导航中UKF滤波算法的仿真研究[J].航天控制,2010,28(06):33-37.DOI:10.16804/j.cnki.issn1006-3242.2010.06.008.》等现有技术文献均对无迹卡尔曼滤波算法进行了详细说明。因此,状态方程如何用于无迹卡尔曼滤波算法中的时间更新,测量方程如何用于无迹卡尔曼滤波算法中的测量更新,本实施例中无需进行详细说明。
惯性导航的具体构成请参见现有技术,其中包括加速度计、陀螺仪和解算模块;方向矢量导航的具体构成同样请参见现有技术,其中通过定姿模块解算星敏感器光轴在惯性空间中的指向,通过方向矢量处理模块解算观测空间目标相对于星敏感器的方向矢量。
本实施例还提供了上述组合导航方法的仿真应用案例,具体详情如下:
(1)仿真条件
在仅考虑飞行器质心运动的条件下,对本实施例中的组合导航方法进行验证。假设飞行器初始位置为[-4397.65km; -4091.42km; -2652.72km],初始速度为[-6.139km/s;3.489 km/s; 2.262km/s],初始位置误差为[1km; 1km; 1km],初始速度误差为[1m/s; 1m/s; 1m/s]。飞行器所搭载星敏感器测角误差为0.5角秒,卫星星历三轴位置误差均为50m。星敏感器依次对三个低轨卫星进行观测,观测计划如表1所示,各卫星的初始轨道根数如表2所示。
表1 已知卫星观测计划
表2 已知卫星初始轨道根数
表2中,a为半长轴;e为偏心率;i为轨道倾角;Ω为升交点赤经;ω为近地点纬度幅角;f为真近点角。
(2)仿真应用案例中UKF滤波计算流程如下:
①滤波初始化
②构造Sigma采样点和权重
③时间更新
时间更新是指根据系统前一时刻的状态,根据状态方法,对系统当前时刻的状态进行预测;
④量测更新
测量更新是指利用当前时刻的实际测量值(来自于传感器)以及预估测量值,对系统当前时刻的预测状态进行修改,并最终得到当前时刻系统状态的估计值;
(3)仿真结果
飞行器定位结果如图2,由图可知,仅采用惯性导航时,飞行器定位误差会随时间增大,当采用本实施例中的组合导航方法时,飞行器的位置估计误差可收敛至小于100m。由此可知,该组合导航方法可为临近空间飞行器提供高精度的自主导航服务。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (8)
1.一种基于惯导和卫星方向矢量的组合导航方法,其特征在于,包括以下步骤:
步骤S1:利用星敏感器对单个已编目的空间目标进行观测,根据观测图像获取观测的空间目标在星敏感器像平面的坐标;
步骤S2:获取观测的空间目标相对于星敏感器的方向矢量;
步骤S3:构建组合导航系统模型:以飞行器的位置、速度、姿态、加速度计偏置和陀螺仪漂移为状态量构建状态方程;以观测的空间目标相对于星敏感器的方向矢量为观测量构建测量方程;
步骤S4:利用滤波算法获得飞行器的导航状态量估计值,并利用获得的加速度计偏置和陀螺仪漂移的估计值对惯性导航进行修正。
3.根据权利要求2所述的基于惯导和卫星方向矢量的组合导航方法,其特征在于,利用观测图像中的背景恒星与恒星星表进行匹配,获得星敏感器光轴在惯性空间中的指向。
4.根据权利要求1所述的基于惯导和卫星方向矢量的组合导航方法,其特征在于,所述步骤S1中,观测的空间目标在已知空间目标编目数据库中的编号为已知。
7.根据权利要求5所述的基于惯导和卫星方向矢量的组合导航方法,其特征在于,所述步骤S4中,采用无迹卡尔曼滤波算法获得飞行器的导航状态量估计值;其中,状态方程用于无迹卡尔曼滤波算法中的时间更新步骤,测量方程用于无迹卡尔曼滤波算法中的测量更新步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211276149.3A CN115355906B (zh) | 2022-10-19 | 2022-10-19 | 一种基于惯导和卫星方向矢量的组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211276149.3A CN115355906B (zh) | 2022-10-19 | 2022-10-19 | 一种基于惯导和卫星方向矢量的组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115355906A CN115355906A (zh) | 2022-11-18 |
CN115355906B true CN115355906B (zh) | 2022-12-20 |
Family
ID=84008338
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211276149.3A Active CN115355906B (zh) | 2022-10-19 | 2022-10-19 | 一种基于惯导和卫星方向矢量的组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115355906B (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5508932A (en) * | 1992-05-19 | 1996-04-16 | Aerospatiale Societe Nationale Industrielle | Method and device for earth acquisition using the pole star for a three-axis stabilized satellite in a low inclination orbit |
RU2012127092A (ru) * | 2012-06-28 | 2014-01-10 | Федеральное государственное унитарное предприятие "Научно-производственный центр автоматики и приборостроения имени академика Н.А. Пилюгина" (ФГУП "НПЦАП") | Способ определения параметров модели погрешностей измерений акселерометров инерциальной навигационной системы по измерениям спутниковой навигации |
CN110672128A (zh) * | 2019-11-05 | 2020-01-10 | 中国人民解放军国防科技大学 | 一种星光/惯性组合导航及误差在线标定方法 |
CN113551668A (zh) * | 2021-07-21 | 2021-10-26 | 北京航空航天大学 | 一种航天器惯性/恒星星光矢量/星光折射组合导航方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2001049565A1 (en) * | 2000-01-04 | 2001-07-12 | The Johns Hopkins University | Method and apparatus for autonomous solar navigation |
-
2022
- 2022-10-19 CN CN202211276149.3A patent/CN115355906B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5508932A (en) * | 1992-05-19 | 1996-04-16 | Aerospatiale Societe Nationale Industrielle | Method and device for earth acquisition using the pole star for a three-axis stabilized satellite in a low inclination orbit |
RU2012127092A (ru) * | 2012-06-28 | 2014-01-10 | Федеральное государственное унитарное предприятие "Научно-производственный центр автоматики и приборостроения имени академика Н.А. Пилюгина" (ФГУП "НПЦАП") | Способ определения параметров модели погрешностей измерений акселерометров инерциальной навигационной системы по измерениям спутниковой навигации |
CN110672128A (zh) * | 2019-11-05 | 2020-01-10 | 中国人民解放军国防科技大学 | 一种星光/惯性组合导航及误差在线标定方法 |
CN113551668A (zh) * | 2021-07-21 | 2021-10-26 | 北京航空航天大学 | 一种航天器惯性/恒星星光矢量/星光折射组合导航方法 |
Non-Patent Citations (3)
Title |
---|
Influence of IMU parameters on navigation performance in network-based collaborative navigation scenarios;P. Schuler 等;《2022 DGON Inertial Sensors and Systems (ISS)》;20220914;第1-17页 * |
一种航天飞行器的INS/CNS自主导航方案;杨淑洁等;《中国惯性技术学报》;20141231;第22卷(第06期);第728-733页 * |
基于X射线脉冲星的深空探测自主导航方法;郑伟等;《中国空间科学技术》;20081031(第05期);第1-6页 * |
Also Published As
Publication number | Publication date |
---|---|
CN115355906A (zh) | 2022-11-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111238467B (zh) | 一种仿生偏振光辅助的无人作战飞行器自主导航方法 | |
CN102692225A (zh) | 一种用于低成本小型无人机的姿态航向参考系统 | |
CN111207745B (zh) | 一种适用于大机动无人机垂直陀螺仪的惯性测量方法 | |
Rad et al. | Optimal attitude and position determination by integration of INS, star tracker, and horizon sensor | |
CN106979781A (zh) | 基于分布式惯性网络的高精度传递对准方法 | |
CN113551668A (zh) | 一种航天器惯性/恒星星光矢量/星光折射组合导航方法 | |
CN113091731A (zh) | 一种基于恒星视线相对论效应的航天器自主导航方法 | |
CN113253325B (zh) | 惯性卫星序贯紧组合李群滤波方法 | |
CN106352897B (zh) | 一种基于单目视觉传感器的硅mems陀螺误差估计与校正方法 | |
CN113295162A (zh) | 基于无人机状态信息的广义因子图融合导航方法 | |
CN116105730A (zh) | 基于合作目标卫星甚短弧观测的仅测角光学组合导航方法 | |
CN110243362A (zh) | 一种中高空超声速靶标导航方法 | |
CN112880669A (zh) | 一种航天器星光折射和单轴旋转调制惯性组合导航方法 | |
CN116222551A (zh) | 一种融合多种数据的水下导航方法及装置 | |
Zhao et al. | A high-accuracy autonomous navigation scheme for the Mars rover | |
CN115355906B (zh) | 一种基于惯导和卫星方向矢量的组合导航方法 | |
CN113008229A (zh) | 一种基于低成本车载传感器的分布式自主组合导航方法 | |
Paluszek et al. | Optical navigation system | |
CN115420280A (zh) | 一种航天器脉冲星/星光折射组合导航方法 | |
CN113465570B (zh) | 一种基于高精度imu的气浮台初始对准方法及系统 | |
CN115326060B (zh) | 一种基于星光角距和方向矢量的自主导航方法 | |
CN115479605A (zh) | 基于空间目标定向观测的高空长航时无人机自主导航方法 | |
CN110579784B (zh) | 基于卫星组合导航系统的卫星自主导航方法 | |
CN115326061B (zh) | 一种基于已编目空间目标序贯观测的自主导航方法 | |
Radi et al. | GNSS Only Reduced Navigation System Performance Evaluation for High-Speed Smart Projectile Attitudes Estimation |
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 |