CN104061928B - 一种自主择优使用星敏感器信息的方法 - Google Patents
一种自主择优使用星敏感器信息的方法 Download PDFInfo
- Publication number
- CN104061928B CN104061928B CN201410295720.5A CN201410295720A CN104061928B CN 104061928 B CN104061928 B CN 104061928B CN 201410295720 A CN201410295720 A CN 201410295720A CN 104061928 B CN104061928 B CN 104061928B
- Authority
- CN
- China
- Prior art keywords
- star sensor
- star
- information
- sensor
- star sensors
- 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
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/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/20—Instruments for performing navigational calculations
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)
- Length Measuring Devices By Optical Means (AREA)
Abstract
一种自主择优使用星敏感器信息的方法,(1)对所有星敏感器分别进行自检信息判断、星敏感器输出信息与预估值一致性判断以及星敏感器之间的一致性判断,当星敏感器同时满足上述三个判断时,标记为有效星敏感器,否则为无效星敏感器;(2)将上述有效星敏感器的时标统一到同一个时标下;并计算上述有效星敏感器两两之间测量的光轴、横轴矢量夹角与相应标称夹角的误差,根据误差的大小,给星敏感器记分;(3)根据星敏感器的分数对星敏感器进行排序,若出现星敏感器分数相同,则进一步考虑分数相同星敏感器的遮光性能满足裕度、星敏感器之间光轴夹角标称大小进行排序;根据工程需要,按照排序顺序选择星敏感器信息。
Description
技术领域
本发明属于飞行器(航空和航天)的自动控制领域,涉及一种自主择优使用星敏感器信息的方法。
背景技术
随着空间任务要求的不断提高,星敏感器得到广泛使用,星敏感器的配置个数也越来越多,星敏感器不仅用于飞行器姿态控制,而且作为载荷的辅助测量设备以提高载荷技术水平。考虑到星敏感器的使用要求和测量误差影响因素,各星敏感器的实际性能在飞行期间会有不同变化,甚至会出现星敏感器数据短期无效,为了充分利用星敏感器,需要自主择优使用星敏感器信息,否则将无效数据或误差大的数据引入闭环控制系统,会影响姿态控制性能。
以往关于星敏感器的文献有很多,但是只是关注星敏感器设计及其性能提高的方法、偏差标定、姿态确定滤波算法研究等,而未见自主择优使用星敏感器信息的文献。
发明内容
本发明的技术解决问题是:针对星敏感器使用的问题,提供了一种自主择优使用星敏感器信息的方法。
本发明的技术解决方案是:一种自主择优使用星敏感器信息的方法,包括以下步骤:
(1)对所有星敏感器分别进行自检信息判断、星敏感器输出信息与预估值一致性判断以及星敏感器之间的一致性判断,当星敏感器同时满足上述三个判断时,标记为有效星敏感器,否则为无效星敏感器;
(2)将上述有效星敏感器的时标统一到同一个时标下;并计算上述有效星敏感器两两之间测量的光轴、横轴矢量夹角与相应标称夹角的误差,根据误差的大小,给星敏感器记分;
(3)根据星敏感器的分数对星敏感器进行排序,若出现星敏感器分数相同,则进一步考虑分数相同星敏感器的遮光性能满足裕度、星敏感器之间光轴夹角标称大小进行排序;根据工程需要,按照排序顺序选择星敏感器信息。
在步骤(1)之前对星敏感器信息进行补偿或者步骤(3)之后对选择的星敏感器信息进行补偿。
所述步骤(2)中的记分与误差之间的关系:
其中Ni,j代表星敏感器i和j的记分器Ni和Nj,即对记分器Ni和Nj同时进行记分操作,δzij为测量的光轴矢量夹角与相应标称夹角的误差,δxij为测量的横轴矢量夹角与相应标称夹角的误差,εzij1、εxij1、εzij2、εxij2为可信度区间值,一般取εzij1=(1.5~3)εzij2、εxij1=(1.5~3)εxij2。
本发明与现有技术相比具有如下优点:
1)可以自主择优使用星敏感器信息,既适应于飞行器在轨使用,也适用于地面应用系统使用,工程可实现性强。
2)“多数表决”择优方法,设计了不同的奇偶方程、设置了多个可信度区间及其相应的记分规则,并综合考虑了星敏感器光轴标称夹角、遮光性能满足裕度等情况。
3)所设计的奇偶方程融合了测量值、预估值和标称值等多种信息源,既考虑了测量值与实时预估值之间的关系,又考虑了测量值与装订的标称值之间的关系。
附图说明
图1为本发明流程图。
具体实施方式
如图1所示,本发明提供了一种自主择优使用星敏感器信息的方法,如果从设计之初就开始考虑星敏感器的择优使用问题,则在设计时,应尽可能的使得星敏感器同步和采样满足下列要求:
星敏感器同步:根据星敏感器内部计时精度、同步信号源及其精度、星敏感器数据时标精度要求等确定同步方法(含同步间隔),满足:(内部计时精度+同步信号源精度)<时标精度。
星敏感器采样:根据星敏感器更新频率及时序和精度、姿态精度要求等确定采样方法(含采样时刻和间隔)。采样间隔不小于星敏感器更新周期,根据星敏感器时序和数据更新时间精度,确定星敏感器同步更新数据的时间范围,考虑设计裕度确定采样时刻(采样时刻在该时间范围内),满足:时延小、星敏感器数据时标相同。
针对已有星敏感器,自主择优使用的步骤如下:
(1)数据有效性判断
对所有星敏感器输出信息进行如下三个判断,当某一星敏感器同时满足下列三个判断条件时,将该星敏感器标记为有效,否则无效。
自检信息判断:根据星敏感器的姿态数据包信息进行自检信息判断(如有效标志位信息、时延、通讯状态等),有效标志位显示有效、通讯正常且时延小于阈值(如3个控制周期)则数据有效。
星敏感器输出信息与预估值之间的一致性判断:利用星敏感器光轴、横轴的测量值与估计的相应预估值的一致性来判断该星敏感器的数据有效性。如:其中Z1I(X1I)和分别为星敏感器1光轴(横轴)的测量值和预估值,ε1、ε2为判断一致性的阈值,且ε1<ε2,Z1B、X1B分别为星敏感器1的光轴、横轴的安装方位,Cbi为飞行器本体系相对赤道惯性系的姿态矩阵。
星敏感器之间的一致性判断:利用两两星敏感器之间测量的光轴、横轴矢量夹角与相应标称夹角的一致性来判断星敏感器的数据有效性。如: 其中Z1I(X1I)和Z2I(X2I)分别为星敏感器1和2的光轴(横轴)的测量值,Z1B(X1B)和Z2B(X2B)分别为星敏感器1和2的光轴(横轴)的安装方位,ε3、ε4为判断一致性的阈值,且ε3<ε4,一般分别取为1~3度、4~6度。若不满足上述两个不等式,则认为星敏感器1、2都不满足上述一致性判断,标记为无效。
(2)数据择优表决
将上述有效星敏感器的时标统一到同一个时标下,例如预估值的时标下,或者某一星敏感器的时标下。
例如:将星敏感器1统一到星敏感器2的时标方法为: 其中Z1I和X1I为星敏感器1光轴、横轴的测量值,Z1Im和X1Im为统一时标后的星敏感器1的光轴、横轴值,tss1和tss2分别为星敏感器1和2数据的对应时间,为卫星本体系相对赤道惯性系的角速度在惯性系的表示。
计算星敏感器两两之间测量的光轴、横轴矢量夹角与相应标称夹角的误差,设置多个可信度区间,可信度高的记高分,对星敏感器数据两两之间(例如:星敏感器1和2、1和3、2和3等)进行判断,给相应星敏感器进行记分。
记星敏感器i和j的记分器分别为Ni、Nj,测量的光轴矢量夹角与相应标称夹角的误差为δzij,测量的横轴矢量夹角与相应标称夹角的误差为δxij,其它组合类似,只是下标i和j与相应星敏感器对应。择优表决的记分规则如下:
上述公式的含义是:当两个星敏感器i和j的误差分别满足上述公式右边的判断条件即可信度区间时,两个星敏感器i和j的记分器值Ni、Nj分别在各自计分器已计分基础上增加相应的分值。各个星敏感器的计分器在进行数据择优表决前清0。
其中Ni,j代表Ni和Nj,即对记分器Ni和Nj同时进行记分操作,εzij1、εxij1、εzij2、εxij2为可信度区间值,一般取εzij1=(1.5~3)εzij2、εxij1=(1.5~3)εxij2,且εzij1=(0.85~0.95)ε3、εxij1=(0.85~0.95)ε4。同样地,对星敏感器的其它两两组合进行上述记分判断。
例如,择优表决第一次判断,当标号为1的星敏感器与标号为2的星敏感器对应误差值满足上述第一个条件时,则N1=0+2=2,N2=0+2=2;继续对标号为1的星敏感器与标号为3的星敏感器进行择优表决,假设满足第二个条件,则此时,N1=2+5=7,N3=0+5=5;依次类推,直至所有星敏感器两两表决完成。
若出现星敏感器分数相同的情况,则进一步根据遮光性能满足裕度、星敏感器之间光轴夹角标称大小等确定优秀星敏感器,确定原则为记分优、遮光性能满足裕度大、星敏感器之间光轴夹角接近90度。
这样就能够得到一个从优到次的星敏感器排序,实际工程应用时,则按照上述排序,择优选择需要的星敏感器。
(3)数据补偿
安装偏差补偿:其中CSB分别为补偿前、后的星敏感器安装位置矩阵,CΔ为安装偏差补偿矩阵。
时间补偿:t0为飞行器当前时间,对应飞行器姿态为惯性角速度为ω。ts为星敏感器1数据时间,对应测量的光轴、横轴矢量分别为Z1I(ts)、X1I(ts),Δt=t0-ts,则统一到飞行器当前时间的星敏感器相应数据为:其中Z1B和X1B为星敏感器光轴和横轴在飞行器本体系的安装方位。
光行差补偿:如果星敏感器没有进行光行差自校正,则需要根据飞行器轨道信息对星敏感器数据进行光行差补偿;
岁差补偿:如果星敏感器数据的惯性坐标系定义与飞行器采用的不一致,则需要根据飞行器轨道信息对星敏感器数据进行岁差补偿。
上述补偿为目前本领域公知常识,此处不过多进行说明。
(4)联合姿态确定
对选择的星敏感器(例如双星敏感器1和2、1和3、2和3、…,单星敏感器1、2、3、…)进行卡尔曼滤波修正,利用优秀星敏感器补偿后的测量信息和陀螺信息来修正飞行器姿态,并估计陀螺常值漂移。卡尔曼滤波修正参数可以通过地面注入修改。
本发明未详细说明部分属本领域技术人员公知常识。
Claims (2)
1.一种自主择优使用星敏感器信息的方法,其特征在于,包括以下步骤:
(1)对所有星敏感器分别进行自检信息判断、星敏感器输出信息与预估值一致性判断以及星敏感器之间的一致性判断,当星敏感器同时满足上述三个判断时,标记为有效星敏感器,否则为无效星敏感器;
(2)将上述有效星敏感器的时标统一到同一个时标下;并计算上述有效星敏感器两两之间测量的光轴、横轴矢量夹角与相应标称夹角的误差,根据误差的大小,给星敏感器记分;所述步骤(2)中的记分与误差之间的关系:
其中Ni,j代表星敏感器i和j的记分器Ni和Nj,即对记分器Ni和Nj同时进行记分操作,δzij为测量的光轴矢量夹角与相应标称夹角的误差,δxij为测量的横轴矢量夹角与相应标称夹角的误差,εzij1、εxij1、εzij2、εxij2为可信度区间值,一般取εzij1=(1.5~3)εzij2、εxij1=(1.5~3)εxij2;
(3)根据星敏感器的分数对星敏感器进行排序,若出现星敏感器分数相同,则进一步考虑分数相同星敏感器的遮光性能满足裕度、星敏感器之间光轴夹角标称大小进行排序;根据工程需要,按照排序顺序选择星敏感器信息。
2.根据权利要求1所述的一种自主择优使用星敏感器信息的方法,其特征在于:在步骤(1)之前对星敏感器信息进行补偿或者步骤(3)之后对选择的星敏感器信息进行补偿。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410295720.5A CN104061928B (zh) | 2014-06-26 | 2014-06-26 | 一种自主择优使用星敏感器信息的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410295720.5A CN104061928B (zh) | 2014-06-26 | 2014-06-26 | 一种自主择优使用星敏感器信息的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104061928A CN104061928A (zh) | 2014-09-24 |
CN104061928B true CN104061928B (zh) | 2017-05-03 |
Family
ID=51549755
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410295720.5A Active CN104061928B (zh) | 2014-06-26 | 2014-06-26 | 一种自主择优使用星敏感器信息的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104061928B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105136150B (zh) * | 2015-08-18 | 2018-01-05 | 北京控制工程研究所 | 一种基于多次星敏感器测量信息融合的姿态确定方法 |
CN106568462A (zh) * | 2016-10-28 | 2017-04-19 | 北京控制工程研究所 | 一种多探头星敏感器融合姿态测试方法 |
CN106494648B (zh) * | 2016-11-21 | 2019-02-26 | 上海航天控制技术研究所 | 两台星敏感器的在轨表决系统和方法 |
CN106643808A (zh) * | 2017-01-22 | 2017-05-10 | 上海航天控制技术研究所 | 一种星敏感器在轨数据多级故障诊断方法 |
CN111323021B (zh) * | 2020-02-25 | 2022-04-19 | 上海航天控制技术研究所 | 一种适用于火星探测的星敏感器及陀螺在轨联合使用方法 |
CN111623784B (zh) * | 2020-07-15 | 2021-09-07 | 中国科学院微小卫星创新研究院 | 多个星敏感器的优先级变更方法及系统 |
CN113916218B (zh) * | 2021-10-12 | 2024-01-26 | 中国科学院微小卫星创新研究院 | 星敏感器互判和仲裁方法及系统 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0752091A1 (en) * | 1994-03-25 | 1997-01-08 | Honeywell Inc. | Automatic calibration of redundant sensors |
CN101214861A (zh) * | 2007-12-26 | 2008-07-09 | 北京控制工程研究所 | 一种自主恢复轨控故障时的星敏感器定姿方法 |
CN102999042A (zh) * | 2012-11-30 | 2013-03-27 | 北京控制工程研究所 | 深空探测器gnc系统分层自主故障诊断方法 |
DE102012219478A1 (de) * | 2011-10-24 | 2013-04-25 | Continental Teves Ag & Co. Ohg | Sensorsystem zur eigenständigen Bewertung der Integrität seiner Daten |
CN103759740A (zh) * | 2014-01-03 | 2014-04-30 | 北京控制工程研究所 | 一种巡视器静态时陀螺故障自主诊断方法 |
WO2014086340A1 (de) * | 2012-12-04 | 2014-06-12 | Jena Optronik Gmbh | Verfahren zur automatischen korrektur von ausrichtungsfehlern in sternsensorsystemen |
-
2014
- 2014-06-26 CN CN201410295720.5A patent/CN104061928B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0752091A1 (en) * | 1994-03-25 | 1997-01-08 | Honeywell Inc. | Automatic calibration of redundant sensors |
CN101214861A (zh) * | 2007-12-26 | 2008-07-09 | 北京控制工程研究所 | 一种自主恢复轨控故障时的星敏感器定姿方法 |
DE102012219478A1 (de) * | 2011-10-24 | 2013-04-25 | Continental Teves Ag & Co. Ohg | Sensorsystem zur eigenständigen Bewertung der Integrität seiner Daten |
CN102999042A (zh) * | 2012-11-30 | 2013-03-27 | 北京控制工程研究所 | 深空探测器gnc系统分层自主故障诊断方法 |
WO2014086340A1 (de) * | 2012-12-04 | 2014-06-12 | Jena Optronik Gmbh | Verfahren zur automatischen korrektur von ausrichtungsfehlern in sternsensorsystemen |
CN103759740A (zh) * | 2014-01-03 | 2014-04-30 | 北京控制工程研究所 | 一种巡视器静态时陀螺故障自主诊断方法 |
Also Published As
Publication number | Publication date |
---|---|
CN104061928A (zh) | 2014-09-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104061928B (zh) | 一种自主择优使用星敏感器信息的方法 | |
CN111721289A (zh) | 车辆定位方法、装置、设备、存储介质及车辆 | |
CN103697889B (zh) | 一种基于多模型分布式滤波的无人机自主导航与定位方法 | |
CN102608596B (zh) | 一种用于机载惯性/多普勒雷达组合导航系统的信息融合方法 | |
CN103913181B (zh) | 一种基于参数辨识的机载分布式pos传递对准方法 | |
CN110702143B (zh) | 基于李群描述的sins捷联惯性导航系统动基座快速初始对准方法 | |
CN107747953B (zh) | 一种多敏感器数据与轨道信息时间同步方法 | |
US20080195304A1 (en) | Sensor fusion for navigation | |
CN106568436B (zh) | 一种利用陀螺修正星敏感器轨道周期系统误差的方法 | |
CN106564622B (zh) | 一种基于视线测量的同步轨道卫星相对倾角远距离修正方法 | |
Wilson et al. | Vision‐aided Guidance and Navigation for Close Formation Flight | |
CN103697894A (zh) | 基于滤波器方差阵修正的多源信息非等间隔联邦滤波方法 | |
CN108287564A (zh) | 一种多旋翼无人机航线抗风方法 | |
CN104236586A (zh) | 基于量测失准角的动基座传递对准方法 | |
CN106895855B (zh) | 一种惯性导航初始基准的估计与补偿方法 | |
CN109489661A (zh) | 一种卫星初始入轨时陀螺组合常值漂移估计方法 | |
Allerton et al. | Distributed data fusion algorithms for inertial network systems | |
CN107764268B (zh) | 一种机载分布式pos传递对准的方法和装置 | |
CN110132267A (zh) | 空天地一体化飞行器的光纤惯导系统及光纤惯导在轨对准方法 | |
KR101656777B1 (ko) | 타칸 정보를 이용한 비행 경로 추종 방법 및 상기 방법을 이용하여 동작하는 장치 | |
Wang et al. | Double‐layer fusion algorithm for EGI‐based system | |
CN103292808A (zh) | 一种惯性系下仅使用位置信息的捷联惯导系统陀螺漂移和航向误差校正方法 | |
Mirabile et al. | Pilot‐Assisted INS Aiding Using Bearings‐Only Measurements Taken Over Time | |
Fuquan et al. | Initial alignment of strap down inertial navigation system using Kalman filter | |
Zhang et al. | An improved MCS/INS integrated navigation algorithm for multi-rotor UAV in indoor flight |
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 |