CN102175260A - 一种自主导航***误差校正方法 - Google Patents
一种自主导航***误差校正方法 Download PDFInfo
- Publication number
- CN102175260A CN102175260A CN 201010623851 CN201010623851A CN102175260A CN 102175260 A CN102175260 A CN 102175260A CN 201010623851 CN201010623851 CN 201010623851 CN 201010623851 A CN201010623851 A CN 201010623851A CN 102175260 A CN102175260 A CN 102175260A
- Authority
- CN
- China
- Prior art keywords
- satellite
- earth
- sensor
- error
- axle
- 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
Landscapes
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
一种自主导航***误差校正方法,基于紫外地球敏感器和星敏感器的自主导航***中,采用紫外敏感器测量得到卫星本体系中地心矢量,采用星敏感器测量得到惯性系到卫星本体系的姿态转换矩阵。由于敏感器不可避免存在相对安装误差,滤波器无法消除该项***误差,导致导航精度变差。本发明方法对紫外敏感器和星敏感器的相对安装误差进行了建模,将安装误差扩充为状态变量进行导航滤波。假定卫星一段时间内能通过GPS接收机或地面定轨获得高精度位置测量信息,则通过滤波可以对***误差进行实时估计和校正。本发明方法操作简单,可以显著提高导航精度。
Description
技术领域
本发明属于航天器自主导航领域,涉及一种航天器导航***误差校正方法。
背景技术
采用成像型地球敏感器和星敏感器进行卫星自主导航是一种典型的天文导航方法,自主导航精度受敏感器测量精度、描述被测目标相关特性的模型精度、导航算法等多种因素的影响。与随机误差相比,导航敏感器的***误差(如测量偏差、安装误差、模型误差等)对导航精度的影响要大的多。这是因为导航滤波器能抑制测量噪声,却对一些常值或有一定规律的测量误差无能为力。因此对常值测量偏差、敏感器安装误差等***误差的在轨标定与补偿是提高卫星自主导航***导航精度的关键技术之一。
张春青、李勇等在2006年3月第27卷第2期宇航学报上发表的论文“卫星自主轨道确定的自校准滤波”中基于线性时变***的可观测性理论证明了***偏差为未知常值时,自主导航***的状态和常值偏差都是可观的,进一步将***偏差作为状态变量,通过自校准滤波器来校正***偏差,但是其中并未涉及如何对敏感器的安装误差进行校正。
发明内容
本发明的技术解决问题是:克服现有技术的不足,提出了一种自主导航***误差校正方法,可以解决敏感器安装误差引起的导航误差过大的问题,通过在线估计安装偏差提高***的导航精度。
本发明的技术解决方案是:自主导航***误差校正方法,步骤如下:
(1)基于紫外地球敏感器和星敏感器的自主导航***中,紫外地球敏感器对地球进行观测,得到卫星本体系下的地心矢量值星敏感器对恒星观测,通过星图识别,得到惯性系到卫星本体系的姿态转换矩阵其中惯性系原点在地球中心,X轴正方向沿地球赤道面和黄道面的交线指向春分点,Z轴为赤道平面的法线,正方向指向北极方向,Y轴与X、Z轴成右手系;卫星本体系的原点在卫星质心,对于对地定向三轴稳定卫星Z轴指向地心,X轴与Z轴垂直并指向卫星速度方向,Y轴与X、Z轴成右手系;
(4)通过GPS接收机或地面定轨获得高精度位置测量信息,将三个安装误差角与卫星位置矢量、卫星速度矢量一起作为状态变量,进行导航滤波解算,对安装误差进行实时估计和校正。
本发明与现有技术相比的优点在于:本发明方法针对“紫外地球敏感器+星敏感器”自主导航***的特点,对紫外地球敏感器和星敏感器的相对安装误差进行了建模,将安装误差扩充为状态变量,与卫星位置矢量、卫星速度矢量一起进行UKF(Unscented Kalman Filter)导航滤波解算。假定卫星一段时间内能通过GPS接收机或地面定轨获得高精度位置测量信息,则滤波器可以对安装误差进行实时估计和校正,从而可以提高导航精度。
附图说明
图1为本发明方法的流程图;
图2为本发明实施例中未对敏感器安装误差校正的导航结果示意图;
图3为本发明实施例中采用本发明方法对敏感器安装误差校正后的导航结果示意图。
具体实施方式
如图1所示,为本发明方法的流程框图,主要步骤如下:
(1)定义坐标系,惯性系原点在地球中心,X轴正方向沿地球赤道面和黄道面的交线指向春分点,Z轴为赤道平面的法线,正方向指向北极方向,Y轴与X、Z轴成右手系。卫星本体系原点在卫星质心,对于对地定向三轴稳定卫星Z轴指向地心,X轴与Z轴垂直并指向卫星速度方向,Y轴与X、Z轴成右手系;
(2)“紫外地球敏感器+星敏感器”自主导航***中,紫外地球敏感器对地球进行观测,得到卫星本体坐标系下的地心矢量值星敏感器对恒星观测,通过星图识别得到惯性姿态四元数q=[q1 q2 q3 q4],计算得到惯性系到卫星本体系的姿态转换矩阵
(3)考虑地球敏感器和星敏感器不可避免存在安装偏差,设安装误差角为Φ=[φx φy φz],φx、φy、φz均为小角度,则有
卫星轨道动力学模型中除中心引力项外,仅考虑J2项摄动,其分量形式为
(5)测量方程为
由于测量值对状态量的偏倒数计算比较困难,因此本发明技术采用无需求导的UKF(Unscented Kalman Filter)滤波算法,具体算法可参考刘伟、杨博在2005年6月第23卷第3期航天控制发表的论文“利用UKF的航天器自主导航方法研究”。
(6)假定卫星一段时间内能通过GPS接收机或地面定轨获得高精度位置测量信息,则滤波器可以对安装误差进行实时估计和校正。
实施例
为了更清楚的表明本方法的优点,在此进行数学仿真,仿真条件:卫星高度500公里,倾角97.4度,地心方向测量误差0.02度,假定紫外敏感器沿三个坐标轴安装误差角分别为50″、40″、30″。
图1为未对安装误差校正的仿真结果,图2为采用本发明方法对安装误差校正后仿真结果图。从图中可以看出,未修正***误差时位置精度为1620.059米,修正***误差后位置精度为125.525米,因此采用本发明方法对安装误差角进行估计校正后,可以大大提高导航精度。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。
Claims (1)
1.一种自主导航***误差校正方法,其特征在于步骤如下:
(1)基于紫外地球敏感器和星敏感器的自主导航***中,紫外地球敏感器对地球进行观测,得到卫星本体系下的地心矢量值星敏感器对恒星观测,通过星图识别,得到惯性系到卫星本体系的姿态转换矩阵其中惯性系原点在地球中心,X轴正方向沿地球赤道面和黄道面的交线指向春分点,Z轴为赤道平面的法线,正方向指向北极方向,Y轴与X、Z轴成右手系;卫星本体系的原点在卫星质心,对于对地定向三轴稳定卫星Z轴指向地心,X轴与Z轴垂直并指向卫星速度方向,Y轴与X、Z轴成右手系;
(4)通过GPS接收机或地面定轨获得高精度位置测量信息,将三个安装误差角与卫星位置矢量、卫星速度矢量一起作为状态变量,进行导航滤波解算,对安装误差进行实时估计和校正。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010106238513A CN102175260B (zh) | 2010-12-31 | 2010-12-31 | 一种自主导航***误差校正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010106238513A CN102175260B (zh) | 2010-12-31 | 2010-12-31 | 一种自主导航***误差校正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102175260A true CN102175260A (zh) | 2011-09-07 |
CN102175260B CN102175260B (zh) | 2012-11-14 |
Family
ID=44518470
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2010106238513A Active CN102175260B (zh) | 2010-12-31 | 2010-12-31 | 一种自主导航***误差校正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102175260B (zh) |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102506876A (zh) * | 2011-12-08 | 2012-06-20 | 北京控制工程研究所 | 一种地球紫外敏感器测量的自主导航方法 |
CN102519455A (zh) * | 2011-12-08 | 2012-06-27 | 北京控制工程研究所 | 基于紫外敏感器的自主导航半物理仿真试验*** |
CN102519472A (zh) * | 2011-12-08 | 2012-06-27 | 北京控制工程研究所 | 一种利用偏航机动的自主导航敏感器***误差校正方法 |
CN102735260A (zh) * | 2012-06-18 | 2012-10-17 | 航天东方红卫星有限公司 | 一种星敏感器在轨测量误差的确定方法 |
CN105277195A (zh) * | 2015-11-04 | 2016-01-27 | 上海新跃仪表厂 | 一种星敏感器单机间相对安装误差在轨辨识方法 |
CN105866808A (zh) * | 2016-06-21 | 2016-08-17 | 上海航天控制技术研究所 | 导航接收机定轨误差对卫星姿态精度的影响的确定方法 |
CN106840159A (zh) * | 2016-12-12 | 2017-06-13 | 西安空间无线电技术研究所 | 一种基于扁率角补偿的坐标变换方法 |
CN106895854A (zh) * | 2017-04-10 | 2017-06-27 | 北京航天自动控制研究所 | 一种星光修正精度地面试验方法 |
CN106996779A (zh) * | 2017-03-30 | 2017-08-01 | 中国人民解放军国防科学技术大学 | 基于gnss的紫外敏感器***误差在轨标定方法 |
CN107024228A (zh) * | 2017-04-12 | 2017-08-08 | 上海航天控制技术研究所 | 一种星敏感器非高频误差在轨修正方法 |
CN109655080A (zh) * | 2018-12-13 | 2019-04-19 | 上海航天控制技术研究所 | 一种数字式太阳敏感器在轨标定方法 |
CN111783271A (zh) * | 2020-05-11 | 2020-10-16 | 北京控制工程研究所 | 一种航天器三超控制***非线性校正方法 |
CN112964275A (zh) * | 2021-02-04 | 2021-06-15 | 上海卫星工程研究所 | 适用于在轨卫星的载荷指向角的测量装置 |
CN113447043A (zh) * | 2021-05-21 | 2021-09-28 | 北京控制工程研究所 | 一种基于gnss的卫星天文导航***误差自主标定方法及*** |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105526951B (zh) * | 2016-01-30 | 2018-08-21 | 武汉大学 | 一种星敏感器原始观测数据预处理方法及*** |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5852792A (en) * | 1996-10-03 | 1998-12-22 | Lockheed Martin Corporation | Spacecraft boresight calibration filter |
CN101178312A (zh) * | 2007-12-12 | 2008-05-14 | 南京航空航天大学 | 基于多信息融合的航天器组合导航方法 |
CN101216319A (zh) * | 2008-01-11 | 2008-07-09 | 南京航空航天大学 | 基于联邦ukf算法的低轨卫星多传感器容错自主导航方法 |
-
2010
- 2010-12-31 CN CN2010106238513A patent/CN102175260B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5852792A (en) * | 1996-10-03 | 1998-12-22 | Lockheed Martin Corporation | Spacecraft boresight calibration filter |
CN101178312A (zh) * | 2007-12-12 | 2008-05-14 | 南京航空航天大学 | 基于多信息融合的航天器组合导航方法 |
CN101216319A (zh) * | 2008-01-11 | 2008-07-09 | 南京航空航天大学 | 基于联邦ukf算法的低轨卫星多传感器容错自主导航方法 |
Non-Patent Citations (1)
Title |
---|
《中国宇航学会深空探测技术专业委员会第六届学术年会暨863计划"深空探测与空间实验技术"重大项目学术研讨会论文集》 20091231 乔国栋等 基于紫外敏感器的慢旋探测器自主导航***设计及可观度分析 第152-159页 1 , * |
Cited By (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102519455A (zh) * | 2011-12-08 | 2012-06-27 | 北京控制工程研究所 | 基于紫外敏感器的自主导航半物理仿真试验*** |
CN102519472A (zh) * | 2011-12-08 | 2012-06-27 | 北京控制工程研究所 | 一种利用偏航机动的自主导航敏感器***误差校正方法 |
CN102519472B (zh) * | 2011-12-08 | 2014-07-02 | 北京控制工程研究所 | 一种利用偏航机动的自主导航敏感器***误差校正方法 |
CN102506876B (zh) * | 2011-12-08 | 2014-07-02 | 北京控制工程研究所 | 一种地球紫外敏感器测量的自主导航方法 |
CN102519455B (zh) * | 2011-12-08 | 2015-03-18 | 北京控制工程研究所 | 基于紫外敏感器的自主导航半物理仿真试验*** |
CN102506876A (zh) * | 2011-12-08 | 2012-06-20 | 北京控制工程研究所 | 一种地球紫外敏感器测量的自主导航方法 |
CN102735260A (zh) * | 2012-06-18 | 2012-10-17 | 航天东方红卫星有限公司 | 一种星敏感器在轨测量误差的确定方法 |
CN102735260B (zh) * | 2012-06-18 | 2015-02-11 | 航天东方红卫星有限公司 | 一种星敏感器在轨测量误差的确定方法 |
CN105277195A (zh) * | 2015-11-04 | 2016-01-27 | 上海新跃仪表厂 | 一种星敏感器单机间相对安装误差在轨辨识方法 |
CN105277195B (zh) * | 2015-11-04 | 2018-06-26 | 上海新跃仪表厂 | 一种星敏感器单机间相对安装误差在轨辨识方法 |
CN105866808B (zh) * | 2016-06-21 | 2018-04-20 | 上海航天控制技术研究所 | 导航接收机定轨误差对卫星姿态精度的影响的确定方法 |
CN105866808A (zh) * | 2016-06-21 | 2016-08-17 | 上海航天控制技术研究所 | 导航接收机定轨误差对卫星姿态精度的影响的确定方法 |
CN106840159B (zh) * | 2016-12-12 | 2019-06-18 | 西安空间无线电技术研究所 | 一种基于扁率角补偿的坐标变换方法 |
CN106840159A (zh) * | 2016-12-12 | 2017-06-13 | 西安空间无线电技术研究所 | 一种基于扁率角补偿的坐标变换方法 |
CN106996779A (zh) * | 2017-03-30 | 2017-08-01 | 中国人民解放军国防科学技术大学 | 基于gnss的紫外敏感器***误差在轨标定方法 |
CN106996779B (zh) * | 2017-03-30 | 2019-08-20 | 中国人民解放军国防科学技术大学 | 基于gnss的紫外敏感器***误差在轨标定方法 |
CN106895854A (zh) * | 2017-04-10 | 2017-06-27 | 北京航天自动控制研究所 | 一种星光修正精度地面试验方法 |
CN106895854B (zh) * | 2017-04-10 | 2019-05-31 | 北京航天自动控制研究所 | 一种星光修正精度地面试验方法 |
CN107024228A (zh) * | 2017-04-12 | 2017-08-08 | 上海航天控制技术研究所 | 一种星敏感器非高频误差在轨修正方法 |
CN107024228B (zh) * | 2017-04-12 | 2019-08-13 | 上海航天控制技术研究所 | 一种星敏感器非高频误差在轨修正方法 |
CN109655080A (zh) * | 2018-12-13 | 2019-04-19 | 上海航天控制技术研究所 | 一种数字式太阳敏感器在轨标定方法 |
CN111783271A (zh) * | 2020-05-11 | 2020-10-16 | 北京控制工程研究所 | 一种航天器三超控制***非线性校正方法 |
CN111783271B (zh) * | 2020-05-11 | 2023-08-29 | 北京控制工程研究所 | 一种航天器三超控制***非线性校正方法 |
CN112964275A (zh) * | 2021-02-04 | 2021-06-15 | 上海卫星工程研究所 | 适用于在轨卫星的载荷指向角的测量装置 |
CN113447043A (zh) * | 2021-05-21 | 2021-09-28 | 北京控制工程研究所 | 一种基于gnss的卫星天文导航***误差自主标定方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN102175260B (zh) | 2012-11-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102175260B (zh) | 一种自主导航***误差校正方法 | |
Wu et al. | Velocity/position integration formula part I: Application to in-flight coarse alignment | |
CN103323026B (zh) | 星敏感器和有效载荷的姿态基准偏差估计与修正方法 | |
CN101788296B (zh) | 一种sins/cns深组合导航***及其实现方法 | |
CN102116634B (zh) | 一种着陆深空天体探测器的降维自主导航方法 | |
CN106289246A (zh) | 一种基于位置和姿态测量***的柔性杆臂测量方法 | |
CN104165640A (zh) | 基于星敏感器的近空间弹载捷联惯导***传递对准方法 | |
CN106292677B (zh) | 基于恒星时角的姿态控制方法和*** | |
Iozan et al. | Using a MEMS gyroscope to measure the Earth’s rotation for gyrocompassing applications | |
CN102853837B (zh) | 一种mimu和gnss信息融合的方法 | |
CN103217174B (zh) | 一种基于低精度微机电***的捷联惯导***初始对准方法 | |
CN104655152A (zh) | 一种基于联邦滤波的机载分布式pos实时传递对准方法 | |
CN104698486A (zh) | 一种分布式pos用数据处理计算机***实时导航方法 | |
CN111189442B (zh) | 基于cepf的无人机多源导航信息状态预测方法 | |
CN103900608A (zh) | 一种基于四元数ckf的低精度惯导初始对准方法 | |
CN103398725A (zh) | 一种基于星敏感器的捷联惯导***初始对准的方法 | |
CN102937450A (zh) | 一种基于陀螺测量信息的相对姿态确定方法 | |
CN102519485A (zh) | 一种引入陀螺信息的二位置捷联惯性导航***初始对准方法 | |
CN103076026A (zh) | 一种捷联惯导***中确定多普勒计程仪测速误差的方法 | |
CN103454665A (zh) | 一种双差gps/sins组合导航姿态测量方法 | |
CN105737834B (zh) | 一种基于轨道平根数的相对导航鲁棒滤波方法 | |
Ning et al. | Initial position and attitude determination of lunar rovers by INS/CNS integration | |
Li et al. | Fast fine initial self-alignment of INS in erecting process on stationary base | |
CN108303120A (zh) | 一种机载分布式pos的实时传递对准的方法及装置 | |
CN102607563B (zh) | 利用背景天文信息对于航天器进行相对导航的*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |