CN110672128B - 一种星光/惯性组合导航及误差在线标定方法 - Google Patents
一种星光/惯性组合导航及误差在线标定方法 Download PDFInfo
- Publication number
- CN110672128B CN110672128B CN201911070463.4A CN201911070463A CN110672128B CN 110672128 B CN110672128 B CN 110672128B CN 201911070463 A CN201911070463 A CN 201911070463A CN 110672128 B CN110672128 B CN 110672128B
- Authority
- CN
- China
- Prior art keywords
- star sensor
- coordinate system
- star
- platform
- ideal
- 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
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
-
- 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
Abstract
本发明公开了一种星光/惯性组合导航及误差在线标定方法,基于星敏感器三次转弹测星结果,根据三颗恒星在发射惯性坐标系的星光方向单位矢量,利用最小二乘法估计出平台失准角和星敏感器安装误差,从而提高星光/惯性组合导航精度。本发明在线同时标定出平台失准角和星敏感器安装误差,有利于提高星敏感器对惯导系统的修正精度。
Description
技术领域
本发明涉及导航领域,可应用于弹道导弹/运载火箭的捷联星光/惯性组合导航,尤其适用于导航中平台失准角和星敏感器安装误差的确定。。
背景技术
星光/惯性组合导航是在惯性导航的基础上辅以星光量测信息来修正惯导系统的姿态误差,进一步修正陀螺的漂移误差、初始失准角以及初始位置误差,从而获得高精度的位置、速度、姿态。
根据星敏感器/陀螺仪和加速度计在载体上的不同安装方式,惯性系统可分为平台式和捷联式。捷联式惯性导航系统没有物理平台,星敏感器和惯性器件直接安装在弹体/箭体上,直接承受弹体/箭体的振动和冲击,工作环境恶劣,使得测量精度降低,但系统结构简单/成本价格方面占优,同时对被测星体的方位要求不是很严,可以找到比较亮的星体,便于提高星光导航系统的整体工作效果,进而可使得导弹武器系统具有较好的机动性和快速发射能力,在今后特殊的弹道导弹/运载火箭系统制导领域中会得到不断地应用和实现。
星敏感器用来测量恒星在星敏感器坐标系中的星光矢量,是星光/惯性复合导航系统中的重要组成部分。然而其安装误差在实际应用中可达角分级,严重影响着测量恒星方位的精准度,从而对复合导航的精度产生影响。当前标定星敏感器安装误差的方法主要有两种:一种是基于光学理论进行标定,但造价昂贵;另一种是根据惯导转位信息进行标定,但依赖于惯导的转位精度。并且这两种方法都是在地面进行标定,但弹道导弹/运载火箭在点火发射过程中,由于弹体/箭体的震动,也会使实际的安装误差偏离事先标定的误差,为此提出一种星光/惯性组合导航及误差在线标定方法。
发明内容
本发明所要解决的技术问题是,针对现有技术不足,提供一种星光/惯性组合导航及误差在线标定方法,提高星光/惯性组合导航精度。
为解决上述技术问题,本发明所采用的技术方案是一种星光/惯性组合导航及误差在线标定方法,包括以下步骤:
1)根据给定的星敏感器安装角和待估计的星敏感器安装误差将弹体体坐标系B分别绕YB、ZB轴旋转-ψ0+ψ0、后与星敏感器坐标系S重合,计算出弹体体坐标系到星敏感器坐标系的姿态转换矩阵从而得到星敏感器坐标系中的星光矢量SS与SI的转换关系;ψ0分别为俯仰角、偏航角;Δψ0分别为俯仰方向、偏航方向;
步骤1)的具体实现过程包括:
其中,
2)通过所选恒星的高低角es和方位角σs,计算出在理想发射惯性系I中的星光方向单位矢量SI;
3)根据理想发射惯性系中的星光方向单位矢量SI,理想发射惯性系I与惯导平台系P间的转换矩阵惯导平台系P到弹体体坐标系B间的转换矩阵以及弹体体坐标系B到星敏感器坐标系S的转换矩阵得到星敏感器坐标系中的星光矢量SS与SI的转换关系:
步骤2)的具体实现过程包括:
2)根据理想发射惯性系中的星光方向单位矢量SI,理想发射惯性系I与惯导平台系P间的转换矩阵惯导平台系P到弹体体坐标系B间的转换矩阵以及弹体体坐标系B到星敏感器理想坐标系S'的转换矩阵得到星敏感器坐标系中的理想星光矢量SS'与SI的转换关系:
其中,
S(·)表示正弦,C(·)表示余弦。
步骤3)的具体实现过程包括以下步骤:
1)测量三颗导航星,恒星的方位分别为[es1 σs1]、[es2 σs2]、[es3 σs3],得到三次测星的矢量[ξ1 η1]、[ξ2 η2]、[ξ3 η3],此时的测量方程为
2)记上式为Z=HX,平台失准角与星敏感器的安装误差利用最小二
乘法估计得出:
X=(HTH)-1HTZ。
与现有技术相比,本发明所具有的有益效果为:本发明基于星敏感器三次转弹测星结果,根据三颗恒星在发射惯性坐标系的星光方向单位矢量,利用最小二乘法估计出平台失准角和星敏感器安装误差,从而提高星光/惯性组合导航精度。其优点在于:在线同时标定出平台失准角和星敏感器安装误差,有利于提高星敏感器对惯导系统的修正精度。
附图说明
图1星光矢量在惯性系中的表示;
图2平台失准角和星敏感器安装误差在线标定流程图。
具体实施方式
平台失准角表征的是数学平台与理想发射惯性坐标系之间的误差角,误差角会引起导航偏差,进而影响落点精度。星光/惯性复合制导正是利用平台失准角进行综合补偿和修正。
初始对准误差和定向误差可用实际数学平台坐标系分别对发射惯性坐标系三个轴的失准角来表示,记为[ε0x ε0y ε0z]T,ε0y中包括定向/瞄准误差两部分。[αdx αdy αdz]T表示实际数学平台坐标系相对与理想数学平台坐标系的失准角,在不考虑其他误差影响的情况下,理想的数学平台坐标系与发射惯性坐标系平行,因此有下式成立
[αdx αdy αdz]T=[ε0x ε0y ε0z]T (1)
陀螺漂移误差的模型为
其中,ωXωYωZ为角速度在弹体坐标系中的投影;EX0 EY0 EZ0为陀螺的零次项;EX1EY1 EZ1为陀螺的一次项。
针对本实施例的弹道导弹,本发明的具体实施步骤如下:
S1.按照如下步骤,计算星敏感器坐标系中的星光矢量SS与发射惯性坐标系中的星光单位矢量SI的转换关系:
(S1-b)根据所选恒星的高低角es和方位角σs,计算理想发射惯性系I中的星光方向单位矢量SI:
SI=[cosescosσs sines cosessinσs]T (4)
(S1-c)星光矢量在星敏感器坐标系中可表示为:
SS=[1,-ξ,-η]T (5)
根据坐标系之间的转换关系有
(S2-b)理想情况下星敏感器的输出为:
Ss′=[1 0 0]T (10)
根据坐标系之间的转换关系有
式中,
式中,S(·)表示正弦,C(·)表示余弦。
S4.按照如下步骤,利用最小二乘估计出平台失准角和星敏感器的安装误差:
(S4-a)测量三颗导航下,恒星的方位分别为[es1 σs1]、[es2 σs2]、[es3 σs3],得到三次测星的矢量[ξ1 η1]、[ξ2 η2]、[ξ3 η3],此时的测量方程为
(S4-b)记上式为Z=HX,平台失准角与星敏感器的安装误差可以利用最小二乘估计得出:
X=(HTH)-1HTZ (14)
为进一步说明本发明对,此处给出仿真算例。假设某弹道导弹的发射时间为2016年12月1日10时6分15秒,发射点的大地经度为30°,大地纬度为0°,大地高程为0m,发射的方位角为-90°。仅考虑初始对准误差/陀螺漂移误差/星敏感器安装误差的影响,星敏感器的安装角度为[20 20]”,安装误差为[100 100]”。初始对准误差和陀螺漂移误差如表1所示,利用最小二乘估计出的平台失准角和星敏感器安装误差如表2所示。
表1仿真误差参数(3σ)
初始对准误差(”) | 陀螺零次项(°/h) | 陀螺一次项(ppm) | |
仿真条件A | [30 100 30] | 0.01 | 5 |
仿真条件B | [100 300 100] | 0.01 | 5 |
仿真条件C | [30 100 30] | 0.1 | 50 |
仿真条件D | [100 300 100] | 0.1 | 50 |
表2利用最小二乘估计出的平台失准角和星敏感器安装误差
参考文献:
[1]全伟,刘百奇,宫晓琳,房建成.惯性/天文/卫星组合导航技术[M].国防工业出版社,2011.
[2]张洪波.空间快速响应发射转移轨道设计与制导方法研究[D].长沙:国防科技大学研究生院,2009.
[3]王融,熊智,刘建业,钟丽娜.一种星敏感器安装误差标定模型仿真研究[J].系统仿真技术,2013,9(4):288-291.
[4]陈伟雄,惯性/星光导航系统星敏感器安装误差测试方法研究[D].太原:中北大学,2018.
Claims (1)
1.一种星光/惯性组合导航及误差在线标定方法,其特征在于,包括以下步骤:
1)根据给定的星敏感器安装角和待估计的星敏感器安装误差将弹体体坐标系B分别绕YB、ZB轴旋转-ψ0+Δψ0、后与星敏感器坐标系S重合,计算出弹体体坐标系到星敏感器坐标系的姿态转换矩阵从而得到星敏感器坐标系中的星光矢量SS与SI的转换关系;ψ0分别为俯仰角、偏航角;Δψ0分别为俯仰方向、偏航方向;
步骤1)的具体实现过程包括:
其中,
12)通过所选恒星的高低角es和方位角σs,计算出在理想发射惯性系I中的星光方向单位矢量SI;
13)根据理想发射惯性系中的星光方向单位矢量SI,理想发射惯性系I与惯导平台系P间的转换矩阵惯导平台系P到弹体体坐标系B间的转换矩阵以及弹体体坐标系B到星敏感器坐标系S的转换矩阵得到星敏感器坐标系中的星光矢量SS与SI的转换关系:
步骤2)的具体实现过程包括:
22)根据理想发射惯性系中的星光方向单位矢量SI,理想发射惯性系I与惯导平台系P间的转换矩阵惯导平台系P到弹体体坐标系B间的转换矩阵以及弹体体坐标系B到理想星敏感器坐标系S'的转换矩阵得到星敏感器坐标系中的理想星光矢量SS'与SI的转换关系:
其中,
步骤3)的具体实现过程包括以下步骤:
31)测量三颗导航星,恒星的方位分别为[es1 σs1]、[es2 σs2]、[es3 σs3],得到三次测星的矢量[ξ1 η1]、[ξ2 η2]、[ξ3 η3],此时的测量方程为
32)记上式为Z=HX,平台失准角与星敏感器的安装误差利用最小二乘法估计得出:
X=(HTH)-1HTZ;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911070463.4A CN110672128B (zh) | 2019-11-05 | 2019-11-05 | 一种星光/惯性组合导航及误差在线标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911070463.4A CN110672128B (zh) | 2019-11-05 | 2019-11-05 | 一种星光/惯性组合导航及误差在线标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110672128A CN110672128A (zh) | 2020-01-10 |
CN110672128B true CN110672128B (zh) | 2021-07-02 |
Family
ID=69085999
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911070463.4A Active CN110672128B (zh) | 2019-11-05 | 2019-11-05 | 一种星光/惯性组合导航及误差在线标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110672128B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112013878B (zh) * | 2020-09-04 | 2022-06-24 | 南京理工大学 | 基于灰色模型的星敏感器在线标定、校正及报错方法 |
CN112344965B (zh) * | 2020-11-17 | 2022-07-22 | 中北大学 | 磁测信号与弹体坐标系间姿态失准角的在线标定补偿方法 |
CN113984069B (zh) * | 2021-04-30 | 2023-06-06 | 北京临近空间飞行器系统工程研究所 | 基于人造卫星的星光定位导航方法 |
CN115355906B (zh) * | 2022-10-19 | 2022-12-20 | 中国人民解放军国防科技大学 | 一种基于惯导和卫星方向矢量的组合导航方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102564455A (zh) * | 2011-12-29 | 2012-07-11 | 南京航空航天大学 | 星敏感器安装误差四位置标定与补偿方法 |
CN103076015A (zh) * | 2013-01-04 | 2013-05-01 | 北京航空航天大学 | 一种基于全面最优校正的sins/cns组合导航系统及其导航方法 |
CN103994763A (zh) * | 2014-05-21 | 2014-08-20 | 北京航空航天大学 | 一种火星车的sins/cns深组合导航系统及其实现方法 |
CN104154928A (zh) * | 2014-05-26 | 2014-11-19 | 北京航天控制仪器研究所 | 一种适用于惯性平台内置式星敏感器的安装误差标定方法 |
CN104165640A (zh) * | 2014-08-11 | 2014-11-26 | 东南大学 | 基于星敏感器的近空间弹载捷联惯导系统传递对准方法 |
CN104833375A (zh) * | 2015-05-19 | 2015-08-12 | 北京控制工程研究所 | 一种借助星敏感器的imu两位置对准方法 |
CN108507569A (zh) * | 2017-11-10 | 2018-09-07 | 中国人民解放军国防科技大学 | 用于星光/惯性复合制导的弹载恒星星库快速生成方法 |
CN109708663A (zh) * | 2018-12-11 | 2019-05-03 | 上海航天控制技术研究所 | 基于空天飞机sins辅助的星敏感器在线标定方法 |
CN110296719A (zh) * | 2019-08-07 | 2019-10-01 | 中南大学 | 一种在轨标定方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2004046748A2 (en) * | 2002-11-15 | 2004-06-03 | Lockheed Martin Corporation | All-weather precision guidance and navigation system |
CN105253330B (zh) * | 2015-10-30 | 2017-04-05 | 中国空间技术研究院 | 一种基于优化的信息融合geo卫星控制系统菜单式设计方法 |
CN108562305B (zh) * | 2018-01-15 | 2021-08-17 | 北京航空航天大学 | 一种惯性/天文深组合导航系统安装误差五位置快速粗标定方法 |
-
2019
- 2019-11-05 CN CN201911070463.4A patent/CN110672128B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102564455A (zh) * | 2011-12-29 | 2012-07-11 | 南京航空航天大学 | 星敏感器安装误差四位置标定与补偿方法 |
CN103076015A (zh) * | 2013-01-04 | 2013-05-01 | 北京航空航天大学 | 一种基于全面最优校正的sins/cns组合导航系统及其导航方法 |
CN103994763A (zh) * | 2014-05-21 | 2014-08-20 | 北京航空航天大学 | 一种火星车的sins/cns深组合导航系统及其实现方法 |
CN104154928A (zh) * | 2014-05-26 | 2014-11-19 | 北京航天控制仪器研究所 | 一种适用于惯性平台内置式星敏感器的安装误差标定方法 |
CN104165640A (zh) * | 2014-08-11 | 2014-11-26 | 东南大学 | 基于星敏感器的近空间弹载捷联惯导系统传递对准方法 |
CN104833375A (zh) * | 2015-05-19 | 2015-08-12 | 北京控制工程研究所 | 一种借助星敏感器的imu两位置对准方法 |
CN108507569A (zh) * | 2017-11-10 | 2018-09-07 | 中国人民解放军国防科技大学 | 用于星光/惯性复合制导的弹载恒星星库快速生成方法 |
CN109708663A (zh) * | 2018-12-11 | 2019-05-03 | 上海航天控制技术研究所 | 基于空天飞机sins辅助的星敏感器在线标定方法 |
CN110296719A (zh) * | 2019-08-07 | 2019-10-01 | 中南大学 | 一种在轨标定方法 |
Non-Patent Citations (8)
Title |
---|
"Analysis of key parameters sensitivity and calibration accuracy of signal timing algorithm";Zhao Yi等;《Journal of Southeast University (English Edition)》;20170930;第33卷(第3期);316-321 * |
"On-Orbit Star-Based Calibration and Modulation Transfer Function Measurements for PLEIADES High-Resolution Optical Sensors";Meygret, Aime等;《IEEE TRANSACTIONS ON GEOSCIENCE AND REMOTE SENSING》;20190831;第57卷(第8期);5525-5534 * |
"SINS / CNS 组合导航的导航星表构建方法";马宝林等;《国防科技大学学报》;20160630;第38卷(第3期);61-67 * |
"SINS辅助星敏感器安装误差标定方法研究";夏家和等;《中国航空学会2007年学术年会》;20071231;1-6 * |
"Star sensor installation error calibration in stellar-inertial navigation system with a regularized backpropagation neural network";Hao Zhang等;《Measurement Science and Technology》;20180619;1-9 * |
"一种星敏感器安装误差标定模型仿真研究";王融等;《系统仿真技术》;20131130;第9卷(第4期);287-291,298 * |
"一种星敏感器安装误差自动化测量方法";陈伟雄等;《中国测试》;20190228;第45卷(第2期);111-115 * |
"惯性/天文/卫星组合导航误差在线标定方法";踪华等;《哈尔滨工业大学学报》;20170430;第49卷(第4期);88-94 * |
Also Published As
Publication number | Publication date |
---|---|
CN110672128A (zh) | 2020-01-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110672128B (zh) | 一种星光/惯性组合导航及误差在线标定方法 | |
CN109596018B (zh) | 基于磁测滚转角速率信息的旋转弹飞行姿态高精度估计方法 | |
CN104792340B (zh) | 一种星敏感器安装误差矩阵与导航系统星地联合标定与校正的方法 | |
CN110926468B (zh) | 基于传递对准的动中通天线多平台航姿确定方法 | |
CN108871326B (zh) | 一种单轴旋转调制惯性-天文深组合导航方法 | |
CN105180728B (zh) | 基于前数据的旋转制导炮弹快速空中对准方法 | |
CN104406583B (zh) | 双星敏感器联合确定载体姿态方法 | |
CN105115508A (zh) | 基于后数据的旋转制导炮弹快速空中对准方法 | |
CN110398242B (zh) | 一种高旋高过载条件飞行器的姿态角确定方法 | |
CN109708663B (zh) | 基于空天飞机sins辅助的星敏感器在线标定方法 | |
CN111351481A (zh) | 一种基于发射惯性坐标系的传递对准方法 | |
CN113551668A (zh) | 一种航天器惯性/恒星星光矢量/星光折射组合导航方法 | |
CN111780752B (zh) | 一种姿态误差可观测的提高惯性制导精度方法 | |
CN116105730A (zh) | 基于合作目标卫星甚短弧观测的仅测角光学组合导航方法 | |
CN112284412B (zh) | 一种避免欧拉转换奇异导致精度下降的地面静态对准方法 | |
CN113418499B (zh) | 一种旋转飞行器滚转角解算方法及系统 | |
CN108507569B (zh) | 用于星光/惯性复合制导的弹载恒星星库快速生成方法 | |
CN111220182B (zh) | 一种火箭传递对准方法及系统 | |
Zhang et al. | Research on auto compensation technique of strap-down inertial navigation systems | |
CN109813302B (zh) | 最佳可用导航星快速确定方法 | |
CN110006455A (zh) | 用于冗余惯导系统中加速度计误差参数的快速标定方法 | |
CN114111805A (zh) | 运载火箭多源多类测量数据位置基准高精度对齐方法 | |
Xiong et al. | Online calibration research on the lever arm effect for the hypersonic vehicle | |
CN111090830A (zh) | 一种高轨非合作目标在轨光压辨识方法 | |
CN110986926A (zh) | 一种基于地磁要素的飞行弹体旋转姿态测量方法 |
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 |