CN104118578A - 一种微小卫星平台多个敏感器数据动态融合系统及方法 - Google Patents
一种微小卫星平台多个敏感器数据动态融合系统及方法 Download PDFInfo
- Publication number
- CN104118578A CN104118578A CN201410286502.5A CN201410286502A CN104118578A CN 104118578 A CN104118578 A CN 104118578A CN 201410286502 A CN201410286502 A CN 201410286502A CN 104118578 A CN104118578 A CN 104118578A
- Authority
- CN
- China
- Prior art keywords
- module
- attitude
- state variable
- information distribution
- error 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.)
- Granted
Links
- 108091092878 Microsatellite Proteins 0.000 title claims abstract description 27
- 238000000034 method Methods 0.000 title claims description 17
- 230000004927 fusion Effects 0.000 claims description 84
- 238000005192 partition Methods 0.000 claims description 24
- 230000005389 magnetism Effects 0.000 claims description 7
- 238000009987 spinning Methods 0.000 abstract 5
- 238000001914 filtration Methods 0.000 description 4
- 230000010354 integration Effects 0.000 description 4
- 238000005259 measurement Methods 0.000 description 3
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000007500 overflow downdraw method Methods 0.000 description 2
- 230000035945 sensitivity Effects 0.000 description 2
- 230000009897 systematic effect Effects 0.000 description 2
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000001737 promoting effect Effects 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Landscapes
- Gyroscopes (AREA)
- Navigation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明一种微小卫星平台多个敏感器数据动态融合系统包括:一陀螺,连接至一姿态预估模块;一星敏感器,输出的姿态角和陀螺输出的姿态参数误差值以及一第一信息分配系数通过第一子滤波器输出第一误差状态变量估计值并传送至数据融合模块;一太阳敏感器,输出的太阳矢量和陀螺所输出的姿态参数误差值以及一第二信息分配系数通过第二子滤波器输出第二误差状态变量估计值并传送至数据融合模块;一磁强计,输出的地磁矢量和陀螺输出的姿态参数误差值以及一第三信息分配系数通过第三子滤波器输出第三误差状态变量估计值并传送至数据融合模块;所述数据融合模块分别与第一、第二、第三子滤波器相连;一姿态修正模块,与姿态预估模块和数据融合模块相连。
Description
技术领域
本发明涉及航天姿态控制技术领域,具体的说,是一种微小卫星平台多个敏感器数据动态融合系统及方法。
背景技术
卫星的姿态信息是卫星正确完成飞行任务的重要依据。随着航天技术的发展,对卫星姿态确定精度和可靠度提出了越来越高的要求。由于各种敏感器的基准不同以及产生误差的机理不同,因此必须采用多敏感器数据信息融合技术来提高定姿的精度和可靠度。现有的多敏感器数据信息融合技术只是将输入的各个敏感器数据信息进行融合,但是未考虑敏感器失效的情况。不同的敏感器在卫星不同的任务段为有效。为了使多敏感器数据信息融合方法有效,需要通过多敏感器的数据信息以判断其有效状态,而且当只有两种敏感器的数据信息进行融合时,若其中一种敏感器的数据信息失效时,则整个数据信息融合技术就失效了。因此,现有技术不能充分发挥多敏感器数据信息动态融合的优势。
有鉴于此,亟需提供一种微小卫星平台多个敏感器数据动态融合系统及方法,以保证卫星能够精确实现其任务需求以及提高卫星的安全性。
发明内容
本发明的目的在于,提供一种微小卫星平台多个敏感器数据动态融合系统及方法,其能够更好地解决敏感器有效性对数据信息融合的影响,提高数据信息融合的灵活性和可靠性,有效提高卫星的精度和安全性。
为实现上述目的,本发明采用以下技术方案。
一种微小卫星平台多个敏感器数据动态融合系统,包括:一陀螺,用于测量姿态角速度,并且连接至一姿态预估模块;一星敏感器,用于测量姿态角,并且所述姿态角和所述陀螺所输出的姿态参数误差值以及一信息分配模块所输出的一第一信息分配系数一起通过一第一子滤波器输出一第一误差状态变量估计值并传送至一数据融合模块;一太阳敏感器,用于测量太阳矢量,并且所述太阳矢量和所述陀螺所输出的姿态参数误差值以及所述信息分配模块所输出的一第二信息分配系数一起通过一第二子滤波器输出一第二误差状态变量估计值并传送至所述数据融合模块;一磁强计,用于测量地磁矢量,并且所述地磁矢量和所述陀螺所输出的姿态参数误差值以及所述信息分配模块所输出的一第三信息分配系数一起通过一第三子滤波器输出一第三误差状态变量估计值并传送至所述数据融合模块;所述数据融合模块分别与所述第一子滤波器、第二子滤波器和第三子滤波器相连,用于根据第一误差状态变量估计值、第二误差状态变量估计值和第三误差状态变量估计值,进行数据信息融合,以获得误差状态变量全局估计值;一姿态修正模块,分别与所述姿态预估模块和数据融合模块相连,用于根据所述数据融合模块的误差状态变量全局估计值,对所述姿态预估模块输出的姿态预估值进行修正,以获得卫星的姿态信息。
作为可选的技术方案,所述姿态预估模块与所述信息分配模块相连,用于控制信息分配模块中的第一信息分配系数、第二信息分配系数和第三信息分配系数。
作为可选的技术方案,所述第一子滤波器、第二子滤波器和第三子滤波器均为扩展卡尔曼滤波器。
作为可选的技术方案,所述第一信息分配系数、第二信息分配系数和第三信息分配系数相加等于1。
作为可选的技术方案,所述姿态预估模块、数据融合模块以及姿态修正模块均设置在同一主滤波器中。
本发明的另一目的,在于提供一种微小卫星平台多个敏感器数据动态融合方法,采用上述的微小卫星平台多个敏感器数据动态融合系统,包括以下步骤:(1)一陀螺输出一姿态角速度至一姿态预估模块;(2)通过一星敏感器所输出的一姿态角和所述陀螺所输出的姿态参数误差值以及一信息分配模块所输出的一第一信息分配系数一起输入一第一子滤波器,以获得一第一误差状态变量估计值,并且传送至一数据融合模块;(3)通过一太阳敏感器所输出的一太阳矢量和所述陀螺所输出的姿态参数误差值以及所述信息分配模块所输出的一第二信息分配系数一起输入一第二子滤波器,以获得一第二误差状态变量估计值,并且传送至所述数据融合模块;(4)通过一磁强计所输出的一地磁矢量和所述陀螺所输出的姿态参数误差值以及所述信息分配模块所输出的一第三信息分配系数一起输入一第三子滤波器,以获得一第三误差状态变量估计值,并且传送至所述数据融合模块;(5)通过所述数据融合模块所接收到的第一误差状态变量估计值、第二误差状态变量估计值和第三误差状态变量估计值进行数据信息融合,并且获得误差状态变量全局估计值;(6)通过所述误差状态变量全局估计值对所述姿态预估模块所输出的一姿态预估值进行修正,以获得卫星的姿态信息。
作为可选的技术方案,在步骤(1)之前进一步包括步骤:分别判断所述陀螺的第一标志位、所述星敏感器的第二标志位、所述太阳敏感器的第三标志位以及所述磁强计的第四标志位是否有效;若所述第一标志位、第二标志位、第三标志位和第四标志位均为有效,则分别判断所述陀螺与星敏感器之间形成的第一标准差、所述陀螺与太阳敏感器之间形成的第二标准差、以及所述陀螺与磁强计之间形成的第三标准差是否分别在预设定的第一阈值范围、第二阈值范围和第三阈值范围之内;若是,则确定所述陀螺、星敏感器、太阳敏感器和磁强计为有效。
作为可选的技术方案,所述第一子滤波器、第二子滤波器和第三子滤波器均为扩展卡尔曼滤波器。
作为可选的技术方案,所述第一信息分配系数、第二信息分配系数和第三信息分配系数相加等于1。
作为可选的技术方案,所述姿态预估模块、数据融合模块以及姿态修正模块均设置在同一主滤波器中。
本发明的优点在于,在卫星姿态信息高精度、高可靠度需求的要求下,提供一种改进的多个敏感器数据信息动态融合系统及方法。该系统通过敏感器的仲裁判读,选择有效的敏感器的数据信息进行融合,从而提高系统的可靠性;每个子滤波器能够通过分配的数据信息系数来确定对结果的影响程度,从而得出最优的姿态结果。本系统及其方法为姿态精度的提高提供了一个新的思路,并且能够在轨试验考核的条件下满足要求。因此,本系统及其方法能够为多颗在研科学试验卫星所借鉴继承,并且具有较好的工程应用前景和推广价值。
附图说明
图1是本发明一实施例的微小卫星平台多个敏感器数据动态融合系统的结构示意图。
图2是本发明一实施例的微小卫星平台多个敏感器数据动态融合方法的步骤示意图。
具体实施方式
下面结合附图对本发明提供的一种微小卫星平台多个敏感器数据动态融合系统及方法的具体实施方式做详细说明。
参见图1所示,本发明提供一种微小卫星平台多个敏感器数据动态融合系统,包括:一陀螺101、一星敏感器102、一太阳敏感器103、一磁强计104、一分别与所述陀螺101和星敏感器102相连的第一子滤波器112、一分别与所述陀螺101和太阳敏感器103相连的第二子滤波器113、一分别与所述陀螺101和磁强计104相连的第三子滤波器114、一分别与第一子滤波器112、第二子滤波器113和第三子滤波器114相连的信息分配模块111、一与所述陀螺101相连的姿态预估模块121、一分别与所述第一子滤波器112、第二子滤波器113和第三子滤波器114相连的数据融合模块122,以及一分别与所述姿态预估模块121和数据融合模块122相连的姿态修正模块131。
其中,所述陀螺101用于测量姿态角速度,并且输出一姿态角速度并传送至所述姿态预估模块121。所述星敏感器102用于测量姿态角,并且其输出的一姿态角和所述陀螺101所输出的姿态参数误差值以及所述信息分配模块111所输出的一第一信息分配系数一起通过所述第一子滤波器112输出一第一误差状态变量估计值并传送至所述数据融合模块122。
所述太阳敏感器103用于测量太阳矢量,并且其输出的一太阳矢量和所述陀螺101所输出的姿态参数误差值以及所述信息分配模块111所输出的一第二信息分配系数一起通过所述第二子滤波器113输出一第二误差状态变量估计值并传送至所述数据融合模块122。
所述磁强计104用于测量地磁矢量,并且其输出的一地磁矢量和所述陀螺101所输出的姿态参数误差值以及所述信息分配模块111所输出的一第三信息分配系数一起通过所述第三子滤波器114输出一第三误差状态变量估计值并传送至所述数据融合模块122。
所述数据融合模块122分别与所述第一子滤波器112、第二子滤波器113和第三子滤波器114相连,用于根据第一误差状态变量估计值、第二误差状态变量估计值和第三误差状态变量估计值,进行数据信息融合,以获得误差状态变量全局估计值。
所述姿态修正模块131,分别与所述姿态预估模块121和数据融合模块122相连,用于根据所述数据融合模块122的误差状态变量全局估计值,对所述姿态预估模块121输出的姿态预估值进行修正,从而获得陀螺101的姿态参数,进而可以正确获得卫星的姿态信息。
进一步,所述第一子滤波器112、第二子滤波器113和第三子滤波器114均为扩展卡尔曼滤波器。
在本发明的实施中,所述姿态预估模块121与所述信息分配模块111相连,用于控制信息分配模块111中的第一信息分配系数、第二信息分配系数和第三信息分配系数。所述第一信息分配系数、第二信息分配系数和第三信息分配系数相加等于1,可以消除子滤波器之间由于公用的陀螺信息所带来的相关性,各自滤波器的滤波可以独立进行。而在其他实施例中,所述信息分配模块111直接控制第一信息分配系数、第二信息分配系数和第三信息分配系数。其中,第一信息分配系数为第二信息分配系数为第三信息分配系数为所述第一信息分配系数、第二信息分配系数和第三信息分配系数相加等于1,即P为估计的均方误差阵,β为信息分配系数,下标g的含义为建立在所有测量上的滤波结果,即全局估计,i(i=1,2,3)为子滤波器,c为公共参考系统的陀螺。另外,第一误差状态变量估计值为δXc1,Pc1;第二误差状态变量估计值为δXc2,Pc2;第三误差状态变量估计值为δXc3,Pc3。误差状态变量全局估计值为δXcg,Pcg。δX为误差状态变量的估计,P为估计的均方误差阵,β为信息分配系数;下标g的含义为建立在所有测量上的滤波结果,即全局估计,i(i=1,2,3)为子滤波器,c为公共参考系统陀螺。
其中:
所述第一信息分配系数、第二信息分配系数和第三信息分配系数符合信息守恒定律。根据所述第一子滤波器112、第二子滤波器113和第三子滤波器114对所述微小卫星平台多个敏感器数据动态融合系统的影响大小不同而分配不同的系数(第一信息分配系数、第二信息分配系数以及第三信息分配系数)。例如,所述星敏感器102的敏感系数较高,精度较高,对所述系统影响较大,因此,对第一信息分配系数设定相对较大的值。而磁强计104的敏感系数较低,精度较低,对所述系统影响较小,因此,对第二信息分配系数设定相对较小的值。本发明对第一信息分配系数、第二信息分配系数以及第三信息分配系数的分配需根据实际情况而定,而并非上述所举例的情况。
另外,在本发明的实施例中,所述姿态预估模块121、数据融合模块122以及姿态修正模块131均设置在同一主滤波器140中。
参见图2,本发明还提供一种微小卫星平台多个敏感器数据动态融合方法,采用所述的微小卫星平台多个敏感器数据动态融合系统,包括以下步骤:步骤S210、一陀螺输出一姿态角速度至一姿态预估模块;步骤S220、通过一星敏感器所输出的一姿态角和所述陀螺所输出的姿态参数误差值以及一信息分配模块所输出的一第一信息分配系数一起输入一第一子滤波器,以获得一第一误差状态变量估计值,并且传送至一数据融合模块;步骤S230、通过一太阳敏感器所输出的一太阳矢量和所述陀螺所输出的姿态参数误差值以及所述信息分配模块所输出的一第二信息分配系数一起输入一第二子滤波器,以获得一第二误差状态变量估计值,并且传送至所述数据融合模块;步骤S240、通过一磁强计所输出的一地磁矢量和所述陀螺所输出的姿态参数误差值以及所述信息分配模块所输出的一第三信息分配系数一起输入一第三子滤波器,以获得一第三误差状态变量估计值,并且传送至所述数据融合模块;步骤S250、通过所述数据融合模块所接收到的第一误差状态变量估计值、第二误差状态变量估计值和第三误差状态变量估计值进行数据信息融合,并且获得误差状态变量全局估计值;步骤S260、通过所述误差状态变量全局估计值对所述姿态预估模块所输出的一姿态预估值进行修正,以获得卫星的姿态信息。
以下将结合图1和图2对上述步骤进行详细说明。
步骤S210:一陀螺输出一姿态角速度至一姿态预估模块。
所述陀螺所输出的姿态参数误差值为一公共参数值。所述陀螺分别与其他敏感器可以组成“陀螺+星敏感器”、“陀螺+太阳敏感器”、“陀螺+磁强计”,以分别对应三个子滤波器(第一子滤波器、第二子滤波器和第三子滤波器),各个子滤波器相互独立。
步骤S220:通过一星敏感器所输出的一姿态角和所述陀螺所输出的姿态参数误差值以及一信息分配模块所输出的一第一信息分配系数一起输入一第一子滤波器,以获得一第一误差状态变量估计值,并且传送至一数据融合模块。
步骤S230:通过一太阳敏感器所输出的一太阳矢量和所述陀螺所输出的姿态参数误差值以及所述信息分配模块所输出的一第二信息分配系数一起输入一第二子滤波器,以获得一第二误差状态变量估计值,并且传送至所述数据融合模块。
步骤S240:通过一磁强计所输出的一地磁矢量和所述陀螺所输出的姿态参数误差值以及所述信息分配模块所输出的一第三信息分配系数一起输入一第三子滤波器,以获得一第三误差状态变量估计值,并且传送至所述数据融合模块。
通过上述步骤S220至步骤S240可知,所述陀螺所输出的姿态参数误差值作为三个子滤波器的公共参数值,各个敏感器(例如星敏感器、太阳敏感器和磁强计)进行测量分别输出姿态角、太阳矢量和地磁矢量,并且分别与姿态参数误差值以及相对应的第一信息分配系数、第二信息分配系数和第三信息分配系数一起输入相应的子滤波器,以获得相应第一、第二和第三误差状态变量估计值,即提供陀螺的局部估计值。所述第一信息分配系数、第二信息分配系数和第三信息分配系数相加等于1,可以消除子滤波器之间由于公用的陀螺信息所带来的相关性,各自滤波器的滤波可以独立进行。
步骤S250:通过所述数据融合模块所接收到的第一误差状态变量估计值、第二误差状态变量估计值和第三误差状态变量估计值进行数据信息融合,并且获得误差状态变量全局估计值。
当获得陀螺的误差状态变量全局估计值后,将该误差状态变量全局估计值与姿态预估值进行融合。
步骤S260:通过所述误差状态变量全局估计值对所述陀螺进行校正,以获得卫星姿态参数。
根据误差状态变量全局估计值对陀螺进行校正,以获得卫星姿态参数,进一步获得卫星的三轴姿态信息。
在步骤S210执行之前,可以进一步包括以下步骤:
步骤S201:分别判断所述陀螺的第一标志位、所述星敏感器的第二标志位、所述太阳敏感器的第三标志位以及所述磁强计的第四标志位是否有效。若判断出第一标志位、第二标志位、第三标志位以及第四标志位均无效,则停止所述融合方法的执行。
步骤S202:若所述第一标志位、第二标志位、第三标志位和第四标志位均为有效,则分别判断所述陀螺与星敏感器之间形成的第一标准差、所述陀螺与太阳敏感器之间形成的第二标准差、以及所述陀螺与磁强计之间形成的第三标准差是否分别在预设定的第一阈值范围、第二阈值范围和第三阈值范围之内。
在本实施例中,第一阈值范围、第二阈值范围和第三阈值范围均为E=5/57.3rad。当S1<E时,星敏感器有效;当S2<E时,太阳敏感器有效;当S3<E时,磁强计有效。
第一标准差为
第二标准差为
第三标准差为
式中,θGY,ψGY——当前时刻陀螺积分得到惯性坐标系下姿态角欧拉角(rad);
θST,ψST——当前时刻星敏感器得到的惯性坐标系下姿态角欧拉角(rad);
θSS,ψSS——当前时刻太阳敏感器得到的惯性坐标系下姿态角欧拉角(rad);
θGM,ψGM——当前时刻磁强计得到的惯性坐标系下姿态角欧拉角(rad)。
步骤S203:若是,则确定所述陀螺、星敏感器、太阳敏感器和磁强计为有效。
通过执行步骤S201至步骤S203,以便对卫星姿态测量的多敏感器的有效性进行仲裁判读,从而选择有效的敏感器数据信息与陀螺的输出信息进行数据信息融合。例如所述陀螺与星敏感器之间形成的第一标准差、所述陀螺与太阳敏感器之间形成的第二标准差、以及所述陀螺与磁强计之间形成的第三标准差中任一标准差满足相应的预设定的第一阈值范围、第二阈值范围和第三阈值范围,那么该标准差所对应的陀螺和相应的敏感器为有效。
例如,在所述数据融合模块中,获得该标准差所对应的误差状态变量估计值,并且进行数据融合,以获得所述陀螺的误差状态变量全局估计值,从而在所述姿态修正模块131中通过所述误差状态变量全局估计值对姿态预估值进行校正,并且获得陀螺的姿态参数,进而获得卫星的姿态信息。当然,若所述陀螺与星敏感器之间形成的第一标准差、所述陀螺与太阳敏感器之间形成的第二标准差、以及所述陀螺与磁强计之间形成的第三标准差中任意两个标准差满足相应的预设定的第一阈值范围、第二阈值范围和第三阈值范围,那么该两个标准差所对应的陀螺和相应两个敏感器为有效。
例如,在所述数据融合模块中,获得所述两个标准差所对应的误差状态变量估计值,并且进行数据融合,以获得所述陀螺的误差状态变量全局估计值,从而在所述姿态修正模块中通过所述误差状态变量全局估计值对姿态预估值进行校正,并且获得陀螺的姿态参数,进而获得卫星的姿态信息。
当然,若所述陀螺与星敏感器之间形成的第一标准差、所述陀螺与太阳敏感器之间形成的第二标准差、以及所述陀螺与磁强计之间形成的第三标准差中三个标准差均满足相应的预设定的第一阈值范围、第二阈值范围和第三阈值范围,那么该三个标准差所对应的陀螺和相应三个敏感器为有效。在所述数据融合模块中,获得所述三个标准差所对应的误差状态变量估计值,并且进行数据融合,以获得所述陀螺的误差状态变量全局估计值,从而在所述姿态修正模块中通过所述误差状态变量全局估计值对姿态预估值进行校正,并且获得陀螺的姿态参数,进而获得卫星的姿态信息。
进一步举例,例如,若在所述陀螺与星敏感器之间形成的第一标准差、所述陀螺与太阳敏感器之间形成的第二标准差、以及所述陀螺与磁强计之间形成的第三标准差中,第一标准差和第三标准差满足相应的预设定的第一阈值范围、第三阈值范围,而第二标准差未满足第二阈值范围,则第一标准差和第三标准差所对应的陀螺和相应的星敏感器和磁强计为有效。
在所述数据融合模块中,获得第一标准差所对应的第一误差状态变量估计值以及第三标准差所对应的第三误差状态变量估计值,并且进行数据融合,以获得所述陀螺的误差状态变量全局估计值,从而在所述姿态修正模块中通过所述误差状态变量全局估计值对姿态预估值进行校正,并且获得陀螺的姿态参数,进而获得卫星的姿态信息。
本发明选择有效的敏感器不仅限于上述例子中的星敏感器或磁强计,只要满足敏感器有效性的仲裁判读即可。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (10)
1.一种微小卫星平台多个敏感器数据动态融合系统,其特征在于,包括:
一陀螺,用于测量姿态角速度,并且连接至一姿态预估模块;
一星敏感器,用于测量姿态角,并且所述姿态角和所述陀螺所输出的姿态参数误差值以及一信息分配模块所输出的一第一信息分配系数一起通过一第一子滤波器输出一第一误差状态变量估计值并传送至一数据融合模块;
一太阳敏感器,用于测量太阳矢量,并且所述太阳矢量和所述陀螺所输出的姿态参数误差值以及所述信息分配模块所输出的一第二信息分配系数一起通过一第二子滤波器输出一第二误差状态变量估计值并传送至所述数据融合模块;
一磁强计,用于测量地磁矢量,并且所述地磁矢量和所述陀螺所输出的姿态参数误差值以及所述信息分配模块所输出的一第三信息分配系数一起通过一第三子滤波器输出一第三误差状态变量估计值并传送至所述数据融合模块;
所述数据融合模块分别与所述第一子滤波器、第二子滤波器和第三子滤波器相连,用于根据第一误差状态变量估计值、第二误差状态变量估计值和第三误差状态变量估计值,进行数据信息融合,以获得误差状态变量全局估计值;
一姿态修正模块,分别与所述姿态预估模块和数据融合模块相连,用于根据所述数据融合模块的误差状态变量全局估计值,对所述姿态预估模块输出的姿态预估值进行修正,以获得卫星的姿态信息。
2.根据权利要求1所述的微小卫星平台多个敏感器数据动态融合系统,其特征在于,所述姿态预估模块与所述信息分配模块相连,用于控制信息分配模块中的第一信息分配系数、第二信息分配系数和第三信息分配系数。
3.根据权利要求1所述的微小卫星平台多个敏感器数据动态融合系统,其特征在于,所述第一子滤波器、第二子滤波器和第三子滤波器均为扩展卡尔曼滤波器。
4.根据权利要求1所述的微小卫星平台多个敏感器数据动态融合系统,其特征在于,所述第一信息分配系数、第二信息分配系数和第三信息分配系数相加等于1。
5.根据权利要求1所述的微小卫星平台多个敏感器数据动态融合系统,其特征在于,所述姿态预估模块、数据融合模块以及姿态修正模块均设置在同一主滤波器中。
6.一种微小卫星平台多个敏感器数据动态融合方法,采用权利要求1所述的微小卫星平台多个敏感器数据动态融合系统,其特征在于,包括以下步骤:
(1)一陀螺输出一姿态角速度至一姿态预估模块;
(2)通过一星敏感器所输出的一姿态角和所述陀螺所输出的姿态参数误差值以及一信息分配模块所输出的一第一信息分配系数一起输入一第一子滤波器,以获得一第一误差状态变量估计值,并且传送至一数据融合模块;
(3)通过一太阳敏感器所输出的一太阳矢量和所述陀螺所输出的姿态参数误差值以及所述信息分配模块所输出的一第二信息分配系数一起输入一第二子滤波器,以获得一第二误差状态变量估计值,并且传送至所述数据融合模块;
(4)通过一磁强计所输出的一地磁矢量和所述陀螺所输出的姿态参数误差值以及所述信息分配模块所输出的一第三信息分配系数一起输入一第三子滤波器,以获得一第三误差状态变量估计值,并且传送至所述数据融合模块;
(5)通过所述数据融合模块所接收到的第一误差状态变量估计值、第二误差状态变量估计值和第三误差状态变量估计值进行数据信息融合,并且获得误差状态变量全局估计值;
(6)通过所述误差状态变量全局估计值对所述姿态预估模块所输出的一姿态预估值进行修正,以获得卫星的姿态信息。
7.根据权利要求6所述的微小卫星平台多个敏感器数据动态融合方法,其特征在于,在步骤(1)之前进一步包括步骤:
分别判断所述陀螺的第一标志位、所述星敏感器的第二标志位、所述太阳敏感器的第三标志位以及所述磁强计的第四标志位是否有效;
若所述第一标志位、第二标志位、第三标志位和第四标志位均为有效,则分别判断所述陀螺与星敏感器之间形成的第一标准差、所述陀螺与太阳敏感器之间形成的第二标准差、以及所述陀螺与磁强计之间形成的第三标准差是否分别在预设定的第一阈值范围、第二阈值范围和第三阈值范围之内;
若是,则确定所述陀螺、星敏感器、太阳敏感器和磁强计为有效。
8.根据权利要求6所述的微小卫星平台多个敏感器数据动态融合方法,其特征在于,所述第一子滤波器、第二子滤波器和第三子滤波器均为扩展卡尔曼滤波器。
9.根据权利要求6所述的微小卫星平台多个敏感器数据动态融合方法,其特征在于,所述第一信息分配系数、第二信息分配系数和第三信息分配系数相加等于1。
10.根据权利要求6所述的微小卫星平台多个敏感器数据动态融合方法,其特征在于,所述姿态预估模块、数据融合模块以及姿态修正模块均设置在同一主滤波器中。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410286502.5A CN104118578B (zh) | 2014-06-24 | 2014-06-24 | 一种微小卫星平台多个敏感器数据动态融合系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410286502.5A CN104118578B (zh) | 2014-06-24 | 2014-06-24 | 一种微小卫星平台多个敏感器数据动态融合系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104118578A true CN104118578A (zh) | 2014-10-29 |
CN104118578B CN104118578B (zh) | 2016-02-03 |
Family
ID=51764264
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410286502.5A Active CN104118578B (zh) | 2014-06-24 | 2014-06-24 | 一种微小卫星平台多个敏感器数据动态融合系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104118578B (zh) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105253330A (zh) * | 2015-10-30 | 2016-01-20 | 中国空间技术研究院 | 一种基于优化的信息融合geo卫星控制系统菜单式设计方法 |
CN106249590A (zh) * | 2016-08-09 | 2016-12-21 | 中国科学院软件研究所 | 一体化自适应纳卫星姿态确定的方法 |
CN108072387A (zh) * | 2016-11-14 | 2018-05-25 | 上海微小卫星工程中心 | 一种低精度敏感器在轨偏差的地面校正方法及系统 |
CN108072372A (zh) * | 2017-11-28 | 2018-05-25 | 西北工业大学 | 一种用于微小卫星的集成姿态测量系统 |
CN108313329A (zh) * | 2018-04-03 | 2018-07-24 | 上海微小卫星工程中心 | 一种卫星平台数据动态融合系统及方法 |
CN108759818A (zh) * | 2018-04-26 | 2018-11-06 | 上海微小卫星工程中心 | 一种超高精度导星敏感器姿态确定的方法 |
CN110209185A (zh) * | 2019-06-26 | 2019-09-06 | 北京控制工程研究所 | 一种利用星敏信息姿态重置的航天器姿态机动稳定方法 |
CN110285815A (zh) * | 2019-05-28 | 2019-09-27 | 山东航天电子技术研究所 | 一种可在轨全程应用的微纳卫星多源信息姿态确定方法 |
CN113220017A (zh) * | 2021-04-16 | 2021-08-06 | 同济大学 | 一种地下无人机飞行方法及系统 |
CN113291493A (zh) * | 2021-05-13 | 2021-08-24 | 航天科工空间工程发展有限公司 | 一种卫星多敏感器融合姿态确定方法和系统 |
CN116203491A (zh) * | 2023-02-24 | 2023-06-02 | 中国科学院微小卫星创新研究院 | 一种卫星磁强计综合仲裁方法及装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5109346A (en) * | 1990-02-01 | 1992-04-28 | Microcosm, Inc. | Autonomous spacecraft navigation system |
CN1644456A (zh) * | 2005-01-21 | 2005-07-27 | 清华大学 | 用于微小卫星的微型组合姿态测量系统 |
CN101093397A (zh) * | 2006-06-23 | 2007-12-26 | 航天东方红卫星有限公司 | 基于星上网的卫星姿态和轨道控制系统 |
CN101556155A (zh) * | 2009-05-20 | 2009-10-14 | 上海微小卫星工程中心 | 小卫星姿态确定系统及方法 |
CN101712381A (zh) * | 2009-11-13 | 2010-05-26 | 北京航空航天大学 | 一种基于多敏感器的定姿系统 |
-
2014
- 2014-06-24 CN CN201410286502.5A patent/CN104118578B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5109346A (en) * | 1990-02-01 | 1992-04-28 | Microcosm, Inc. | Autonomous spacecraft navigation system |
CN1644456A (zh) * | 2005-01-21 | 2005-07-27 | 清华大学 | 用于微小卫星的微型组合姿态测量系统 |
CN101093397A (zh) * | 2006-06-23 | 2007-12-26 | 航天东方红卫星有限公司 | 基于星上网的卫星姿态和轨道控制系统 |
CN101556155A (zh) * | 2009-05-20 | 2009-10-14 | 上海微小卫星工程中心 | 小卫星姿态确定系统及方法 |
CN101712381A (zh) * | 2009-11-13 | 2010-05-26 | 北京航空航天大学 | 一种基于多敏感器的定姿系统 |
Non-Patent Citations (1)
Title |
---|
谢祥华 等: "基于磁强计与太阳敏感器的卫星自主定轨算法", 《宇航学报》 * |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105253330A (zh) * | 2015-10-30 | 2016-01-20 | 中国空间技术研究院 | 一种基于优化的信息融合geo卫星控制系统菜单式设计方法 |
CN106249590A (zh) * | 2016-08-09 | 2016-12-21 | 中国科学院软件研究所 | 一体化自适应纳卫星姿态确定的方法 |
CN106249590B (zh) * | 2016-08-09 | 2019-03-19 | 中国科学院软件研究所 | 一体化自适应纳卫星姿态确定的方法 |
CN108072387A (zh) * | 2016-11-14 | 2018-05-25 | 上海微小卫星工程中心 | 一种低精度敏感器在轨偏差的地面校正方法及系统 |
CN108072372A (zh) * | 2017-11-28 | 2018-05-25 | 西北工业大学 | 一种用于微小卫星的集成姿态测量系统 |
CN108313329A (zh) * | 2018-04-03 | 2018-07-24 | 上海微小卫星工程中心 | 一种卫星平台数据动态融合系统及方法 |
CN108759818A (zh) * | 2018-04-26 | 2018-11-06 | 上海微小卫星工程中心 | 一种超高精度导星敏感器姿态确定的方法 |
CN110285815A (zh) * | 2019-05-28 | 2019-09-27 | 山东航天电子技术研究所 | 一种可在轨全程应用的微纳卫星多源信息姿态确定方法 |
CN110285815B (zh) * | 2019-05-28 | 2023-10-20 | 山东航天电子技术研究所 | 一种可在轨全程应用的微纳卫星多源信息姿态确定方法 |
CN110209185A (zh) * | 2019-06-26 | 2019-09-06 | 北京控制工程研究所 | 一种利用星敏信息姿态重置的航天器姿态机动稳定方法 |
CN110209185B (zh) * | 2019-06-26 | 2022-02-01 | 北京控制工程研究所 | 一种利用星敏信息姿态重置的航天器姿态机动稳定方法 |
CN113220017A (zh) * | 2021-04-16 | 2021-08-06 | 同济大学 | 一种地下无人机飞行方法及系统 |
CN113291493A (zh) * | 2021-05-13 | 2021-08-24 | 航天科工空间工程发展有限公司 | 一种卫星多敏感器融合姿态确定方法和系统 |
CN113291493B (zh) * | 2021-05-13 | 2022-09-23 | 航天科工空间工程发展有限公司 | 一种卫星多敏感器融合姿态确定方法和系统 |
CN116203491A (zh) * | 2023-02-24 | 2023-06-02 | 中国科学院微小卫星创新研究院 | 一种卫星磁强计综合仲裁方法及装置 |
CN116203491B (zh) * | 2023-02-24 | 2024-06-14 | 中国科学院微小卫星创新研究院 | 一种卫星磁强计综合仲裁方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN104118578B (zh) | 2016-02-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104118578B (zh) | 一种微小卫星平台多个敏感器数据动态融合系统及方法 | |
EP2927641B1 (en) | Positioning apparatus comprising an inertial sensor and inertial sensor temperature compensation method | |
US9939532B2 (en) | Heading for a hybrid navigation solution based on magnetically calibrated measurements | |
CN100356139C (zh) | 用于微小卫星的微型组合姿态测量系统 | |
CN103323026B (zh) | 星敏感器和有效载荷的姿态基准偏差估计与修正方法 | |
CN106767787A (zh) | 一种紧耦合gnss/ins组合导航装置 | |
CN105607093B (zh) | 一种组合导航系统及获取导航坐标的方法 | |
CN105910602B (zh) | 一种组合导航方法 | |
CN103148853B (zh) | 基于星敏感器的卫星姿态确定方法及系统 | |
CN109489661B (zh) | 一种卫星初始入轨时陀螺组合常值漂移估计方法 | |
CN105371844A (zh) | 一种基于惯性/天文互助的惯性导航系统初始化方法 | |
CN103674021A (zh) | 基于捷联惯导与星敏感器的组合导航系统及方法 | |
CN104374388A (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN114018242B (zh) | 一种基于偏振/太阳/惯性信息智能匹配的自主定姿方法 | |
US11448771B2 (en) | Method and apparatus for evaluating data, device, and computer-readable storage medium | |
CN106896819A (zh) | 基于三星敏感器的卫星姿态确定方法和系统 | |
CN111189474A (zh) | 基于mems的marg传感器的自主校准方法 | |
CN103398725A (zh) | 一种基于星敏感器的捷联惯导系统初始对准的方法 | |
CN103278165A (zh) | 基于剩磁标定的磁测及星光备份的自主导航方法 | |
CN102679999A (zh) | 星敏感器安装误差四位置标定与补偿方法 | |
CN105043416A (zh) | 一种半球谐振陀螺组合在轨故障诊断方法 | |
Wang et al. | Attitude determination method by fusing single antenna GPS and low cost MEMS sensors using intelligent Kalman filter algorithm | |
CN110332933A (zh) | 车辆定位方法、终端及计算机可读存储介质 | |
CN102607563B (zh) | 利用背景天文信息对于航天器进行相对导航的系统 | |
Zhao et al. | A time‐controllable Allan variance method for MEMS IMU |
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 |