CN113686334B - 一种提高星敏感器和陀螺在轨联合滤波精度的方法 - Google Patents
一种提高星敏感器和陀螺在轨联合滤波精度的方法 Download PDFInfo
- Publication number
- CN113686334B CN113686334B CN202110767452.2A CN202110767452A CN113686334B CN 113686334 B CN113686334 B CN 113686334B CN 202110767452 A CN202110767452 A CN 202110767452A CN 113686334 B CN113686334 B CN 113686334B
- Authority
- CN
- China
- Prior art keywords
- satellite
- filtering
- attitude
- quaternion
- error
- 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/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/18—Stabilised platforms, e.g. by gyroscope
-
- 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
- G01C21/025—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means with the use of startrackers
-
- 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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02D—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN INFORMATION AND COMMUNICATION TECHNOLOGIES [ICT], I.E. INFORMATION AND COMMUNICATION TECHNOLOGIES AIMING AT THE REDUCTION OF THEIR OWN ENERGY USE
- Y02D30/00—Reducing energy consumption in communication networks
- Y02D30/70—Reducing energy consumption in communication networks in wireless communication networks
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
本发明公开了一种提高星敏感器和陀螺在轨联合滤波精度的方法,包括:获取陀螺测量的卫星三轴惯性角速度,根据所述惯性角速度,得到卫星姿态角速度,并根据卫星运动学方程得到卫星姿态四元数估计值;根据所述卫星姿态四元数估计值和由星敏感器数据计算的姿态四元数,得到姿态误差四元数;进行状态滤波,得到姿态误差四元数估值和陀螺常值漂移残差的估值,本发明通过分步改变滤波增益系数,达到滤波快速收敛和稳态高精度滤波的效果,适用于具有频繁姿态机动功能的卫星姿态确定系统,该方法仅改变滤波增益系数,滤波收敛后切换系数可提高卫星姿态确定精度,星载软件也可方便实现,具备工程实用性。
Description
技术领域
本发明涉及卫星姿态确定技术领域,具体涉及一种提高星敏感器和陀螺在轨联合滤波精度的方法。
背景技术
高精度卫星姿态确定系统为了提高姿态确定精度,一般都采用星敏感器和陀螺组合联合滤波来实现,即通过卡尔曼滤波,利用陀螺组合的输出数据连续性及高频噪声低特性和星敏感器的低频噪声低特性,根据星敏感器的信息估计出陀螺的常值漂移并进行补偿,由陀螺组合的信息获得连续高精度的姿态角度及姿态角速度信息。
由于星载计算机计算能力有限,一般卡尔曼滤波增益系数通过离线计算取为常值,对于稳态运行的卫星,滤波增益系数主要考虑滤波稳态精度,但对以敏捷机动卫星则需要兼顾滤波收敛速度和滤波稳态精度,常值滤波增益系数难以满足系统使用要求。
发明内容
本发明的目的是为了提供一种提高星敏感器和陀螺在轨联合滤波精度的方法。此方法旨在解决传统方法中卡尔曼滤波增益系数通过离线计算取为常值,不能满足敏捷机动卫星需要兼顾滤波收敛速度和滤波稳态精度的系统要求的问题。
为达到上述目的,本发明提供了一种提高星敏感器和陀螺在轨联合滤波精度的方法,其应用于卫星姿态确定系统,包括:
步骤S1:获取陀螺测量的卫星三轴惯性角速度,根据所述惯性角速度,得到卫星姿态角速度,并根据卫星运动学方程得到卫星姿态四元数估计值;
步骤S2:根据所述卫星姿态四元数估计值和由星敏感器数据计算的姿态四元数,得到姿态误差四元数;
步骤S3:对所述卫星姿态确定系统进行状态滤波,得到姿态误差四元数估值和陀螺常值漂移残差的估值,在滤波启动的Δt时间内完成快速收敛,得到第一滤波结果,所述第一滤波结果不接入所述卫星确定系统中;在滤波启动的Δt时间后更换滤波系数,得到第二滤波结果,并将所述第二滤波结果接入所述卫星姿态确定系统中使用;
步骤S4:对所述卫星姿态确定系统进行状态更新,得到卫星姿态四元数估值更新值,根据选定的转序,得到卫星姿态角。
优选的,在步骤S1中,由所述陀螺测量的卫星三轴惯性角速度ωbi,得到卫星三轴惯性角速度的计算值所述陀螺测量的卫星三轴惯性角速度ωbi与所述卫星三轴惯性角速度的计算值/>之间的表达式为:
式中:k表示当前计算周期;k-1表示前一个计算周期;
bi表示卫星本体系b系相对于惯性系i系;
ωbi(k)表示当前计算周期的陀螺测量的卫星三轴惯性角速度;
表示当前计算周期的卫星三轴惯性角速度的计算值;
表示陀螺常值漂移残差(即陀螺真实常值漂移与地面标定的常值漂移之差)的估值在本体系的三轴分量;
表示前一个计算周期的陀螺常值漂移残差的估值在本体系的三轴分量。
优选的,由所述陀螺测量的卫星三轴惯性角速度的计算值得到所述卫星姿态角速度/>再根据所述卫星姿态角速度/>得到所述卫星姿态四元数估计值/>所述卫星姿态角速度/>与所述卫星姿态四元数估计/>之间关系式为:
式中:TS为计算周期;
q1,q2,q3,q4为姿态四元数,q4为标量,[q13×]为反对称矩阵;
表示当前周期卫星姿态四元数估计值;
表示前一个计算周期卫星姿态四元数估计值;
为关于四元数/>的姿态矩阵;
表示当前周期的卫星姿态角速度;
bo表示卫星本体系b系相对于轨道系o系;
ω0为常量,表示卫星轨道角度;
为启动卡尔曼滤波前一拍的值;
为启动卡尔曼滤波前一拍的值。
优选的,在步骤S2中,当所述星敏感器数据正常时,所述姿态误差四元数qe的表达式为:
式中:qe(k)表示当前计算周期姿态误差四元数;
e表示误差(error);
和/>为当前周期姿态四元数,/>为标量。
优选的,在步骤S2中,当所述星敏感器数据异常时,所述姿态误差四元数qe的表达式为:
qe(k)=[0 0 0 1]T
式中:qe(k)=(Qse 1),Qse为所述姿态误差四元数qe(k)的矢量部分;Qse的下标se为自定义,无特殊含义。
优选的,在步骤S3中,卡尔曼滤波初始启动后所述Δt时间内,使用的滤波增益系数为K1和K11,得到所述Δt时间内,滤波后所述姿态误差四元数矢量部分估值的表达式为:
式中:e,k中e表示误差(error),k表示卡尔曼(Kalman)滤波;
所述Δt时间内,滤波后所述陀螺常值漂移残差的估值的表达式为:
式中:的下标k表示卡尔曼(Kalman)滤波;
所述Δt时间内,滤波后所述姿态误差四元数矢量部分估值和陀螺常值漂移残差的估值/>为第一滤波结果。
优选的,在步骤S3中,所述Δt时间后,使用的滤波增益系数K2和K22,得到所述Δt时间后,滤波后所述姿态误差四元数矢量部分的估值的表达式为:
所述Δt时间后,滤波后所述陀螺常值漂移残差的估值的表达式为:
所述Δt时间后,滤波后所述姿态误差四元数矢量部分的估值和所述陀螺常值漂移残差的估值/>为高精度滤波估值,所述高精度滤波估值即为所述第二滤波结果。
优选的,在步骤S4中,根据所述第一滤波结果和所述第二滤波结果,对所述卫星姿态四元数进行更新,得到更新后所述卫星姿态四元数的表达式为:
式中:为姿态误差四元数矢量部分的估值;
为姿态误差四元数矢量部分的估值的转置矩阵。
优选的,在步骤S4中,根据所述第一滤波结果和所述第二滤波结果,得到所述陀螺常值漂移残差的估值在本体系的三轴分量的值,
当星敏感器数据正常时,得到更新后所述陀螺常值漂移残差的估值在本体系的三轴分量的表达式为:
式中:表示当前周期陀螺常值漂移残差的估值在本体系的三轴分量;
表示前一个周期陀螺常值漂移残差的估值在本体系的三轴分量。
当星敏感器数据异常时,得到更新后所述陀螺常值漂移残差的估值在本体系的三轴分量的表达式为:
优选的,所述步骤S3还包括:卡尔曼滤波启动但不接入所述卫星姿态确定系统时,不对所述姿态误差四元数矢量部分的估值进行限幅处理,接入所述卫星姿态确定系统后,对所述姿态误差四元数矢量部分的估值/>进行限幅处理;所述步骤S4还包括:卡尔曼滤波启动但不接入所述卫星姿态确定系统时,不对所述陀螺常值漂移残差的估值/>进行限幅处理,接入所述卫星姿态确定系统后,对所述陀螺常值漂移残差的估值/>进行限幅处理。
与现有技术相比,本发明具有以下有益效果:
本发明不改变卡尔曼滤波算法结构,通过分步改变滤波增益系数,达到滤波快速收敛和稳态高精度滤波的效果,适用于具有频繁姿态机动功能的卫星姿态确定系统,该方法仅改变滤波增益系数,滤波收敛后切换系数可提高卫星姿态确定精度,星载软件也可方便实现,具备工程实用性。
附图说明
为了更清楚地说明本发明的技术方案,下面将对描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本发明的一个实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图:
图1为本发明一实施例提供的一种提高星敏感器和陀螺在轨联合滤波精度的方法的流程示意图。
具体实施方式
以下结合附图1和具体实施方式对本发明提出的一种提高星敏感器和陀螺在轨联合滤波精度的方法作进一步详细说明。根据下面说明,本发明的优点和特征将更清楚。需要说明的是,附图采用非常简化的形式且均使用非精准的比例,仅用以方便、明晰地辅助说明本发明实施方式的目的。为了使本发明的目的、特征和优点能够更加明显易懂,请参阅附图。须知,本说明书所附图式所绘示的结构、比例、大小等,均仅用以配合说明书所揭示的内容,以供熟悉此技术的人士了解与阅读,并非用以限定本发明实施的限定条件,故不具技术上的实质意义,任何结构的修饰、比例关系的改变或大小的调整,在不影响本发明所能产生的功效及所能达成的目的下,均应仍落在本发明所揭示的技术内容能涵盖的范围内。
鉴于现有技术中确定卫星姿态时,卡尔曼滤波增益系数通过离线计算取为常值,不能满足敏捷机动卫星需要兼顾滤波收敛速度和滤波稳态精度的系统要求的不足,为了满足滤波快速收敛和稳态高精度滤波,且适用于具有频繁姿态机动功能的卫星姿态确定系统,本实施例提供了一种提高星敏感器和陀螺在轨联合滤波精度的方法,包括以下步骤:
步骤S1:获取陀螺测量的卫星三轴惯性角速度,根据所述惯性角速度,得到卫星姿态角速度,并根据卫星运动学方程得到卫星姿态四元数估计值;
由所述陀螺测量的卫星三轴惯性角速度ωbi,得到卫星三轴惯性角速度的计算值所述陀螺测量的卫星三轴惯性角速度ωbi与所述卫星三轴惯性角速度的计算值/>之间的表达式为:
式中:k表示当前计算周期;k-1表示前一个计算周期;
bi表示卫星本体系b系相对于惯性系i系;
ωbi(k)表示当前计算周期的陀螺测量的卫星三轴惯性角速度;
表示当前计算周期的卫星三轴惯性角速度的计算值;
表示陀螺常值漂移残差(即陀螺真实常值漂移与地面标定的常值漂移之差)的估值在本体系的三轴分量;
表示前一个计算周期的陀螺常值漂移残差的估值在本体系的三轴分量。
由所述陀螺测量的卫星三轴惯性角速度的计算值得到所述卫星姿态角速度再根据所述卫星姿态角速度/>得到所述卫星姿态四元数估计值/>所述卫星姿态角速度/>与所述卫星姿态四元数估计值/>之间关系式为:
式中:TS为计算周期;
q1,q2,q3,q4为姿态四元数,q4为标量,[q13×]为反对称矩阵;
表示当前周期卫星姿态四元数估计值;
表示前一个计算周期卫星姿态四元数估计值;
为关于四元数/>的姿态矩阵;
表示当前周期的卫星姿态角速度;
bo表示卫星本体系b系相对于轨道系o系;
ω0为常量,表示卫星轨道角度;
为启动卡尔曼滤波前一拍的值;
为启动卡尔曼滤波前一拍的值;
对(3)式中当前周期卫星姿态四元数估计值进行归一化处理,通过(2)式和(3)式,得到当前周期卫星姿态四元数估计值/>与前一个计算周期卫星姿态四元数估计值/>之间的迭代关系,从而解出卫星姿态四元数估计值/>
步骤S2:根据所述卫星姿态四元数估计值和由星敏感器数据计算的姿态四元数,得到姿态误差四元数;
当所述星敏感器数据正常时,所述姿态误差四元数qe的表达式为:
式中:qe(k)表示当前计算周期姿态误差四元数;
e表示误差error;
和/>为当前周期姿态四元数,/>为标量。
当所述星敏感器数据异常时,所述姿态误差四元数qe的表达式为:
qe(k)=[0 0 0 1]T (8)
式中:qe(k)=(Qse 1),Qse为所述姿态误差四元数qe(k)的矢量部分;
Qse的下标se为自定义,无特殊含义。
步骤S3:对所述卫星姿态确定系统进行状态滤波,得到姿态误差四元数估值和陀螺常值漂移残差的估值,在滤波启动的Δt时间内完成快速收敛,得到第一滤波结果,所述第一滤波结果不接入所述卫星确定系统中;在滤波启动的Δt时间后更换滤波系数,得到第二滤波结果,并将所述第二滤波结果接入所述卫星姿态确定系统中使用;
卡尔曼滤波初始启动后所述Δt时间内,使用的滤波增益系数为K1和K11,得到所述Δt时间内,滤波后所述姿态误差四元数矢量部分估值的表达式为:
式中:“e,k”中e表示误差(error),k表示卡尔曼(Kalman)滤波;
所述Δt时间内,滤波后所述陀螺常值漂移残差的估值的表达式为:
式中:的下标k表示卡尔曼(Kalman)滤波;
所述Δt时间内,滤波后所述姿态误差四元数矢量部分估值和陀螺常值漂移残差的估值/>为第一滤波结果。
所述Δt时间后,使用的滤波增益系数K2和K22,得到所述Δt时间后,滤波后所述姿态误差四元数矢量部分的估值的表达式为:
所述Δt时间后,滤波后所述陀螺常值漂移残差的估值的表达式为:
所述Δt时间后,滤波后所述姿态误差四元数矢量部分的估值和所述陀螺常值漂移残差的估值/>为高精度滤波估值,所述高精度滤波估值即为所述第二滤波结果。
卡尔曼滤波启动但不接入所述卫星姿态确定系统时,不对所述姿态误差四元数矢量部分的估值进行限幅处理,接入所述卫星姿态确定系统后,对所述姿态误差四元数矢量部分的估值/>进行限幅处理。
步骤S4:进行状态更新,得到卫星姿态四元数估值更新值,根据选定的转序,得到卫星姿态角,根据所述第一滤波结果和所述第二滤波结果,对所述卫星姿态四元数进行更新,得到更新后所述卫星姿态四元数的表达式为:
式中:为姿态误差四元数矢量部分的估值;
为姿态误差四元数矢量部分的估值的转置矩阵。
根据所述所述第一滤波结果和所述第二滤波结果,得到所述陀螺常值漂移残差的估值在本体系的三轴分量当星敏感器数据正常时,得到更新后所述陀螺常值漂移残差的估值在本体系的三轴分量/>的表达式为:
式中:表示当前周期陀螺常值漂移残差的估值在本体系的三轴分量;
表示前一个周期陀螺常值漂移残差的估值在本体系的三轴分量;当星敏感器数据异常时,得到更新后所述陀螺常值漂移残差的估值在本体系的三轴分量/>的表达式为:
卡尔曼滤波启动但不接入所述卫星姿态确定系统时,不对所述陀螺常值漂移残差的估值进行限幅处理,接入所述卫星姿态确定系统后,对所述陀螺常值漂移残差的估值/>进行限幅处理。
本实施例中根据陀螺测量的卫星三轴惯性角速度ωbi得到卫星的姿态角速度再根据卫星运动学方程得到卫星姿态四元数估计值/>通过卫星姿态四元数估计值和星敏感器数据计算的姿态四元数,得到姿态误差四元数qe;进行状态滤波,得到姿态误差四元数估值/>和陀螺常值漂移残差的估值/>在滤波启动的Δt时间内完成快速收敛,滤波结果不接入系统,在滤波启动的Δt时间后更换滤波系数,得到高精度滤波估值,并接入系统使用;进行状态更新,得到卫星姿态四元数估值更新值,根据选定的转序得到卫星姿态角。
本实施例中提高星敏感器和陀螺在轨联合滤波精度的方法和现有技术相比,现有技术中,由于星载计算机计算能力有限,一般卡尔曼滤波增益系数通过离线计算取为常值,本实施例通过在卡尔曼滤波初始启动后的Δt时间内和Δt时间后,分别使用不同的滤波增益系数,达到滤波快速收敛和稳态高精度滤波的效果,且尤其适用于具有频繁姿态机动功能的卫星姿态确定系统;
本实施例不改变卡尔曼滤波算法结构,通过分步改变滤波增益系数,达到滤波快速收敛和稳态高精度滤波的效果,尤其适用于具有频繁姿态机动功能的卫星姿态确定系统。实施例中提供的方法仅改变滤波增益系数,滤波收敛后切换系数可提高卫星姿态确定精度,星载软件也可方便实现,具备工程实用性。
需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
应当注意的是,在本文的实施方式中所揭露的装置和方法,也可以通过其他的方式实现。以上所描述的装置实施方式仅仅是示意性的,例如,附图中的流程图和框图显示了根据本文的多个实施方式的装置、方法和计算机程序产品的可能实现的体系架构、功能和操作。在这点上,流程图或框图中的每个方框可以代表一个模块、程序或代码的一部分,所述模块、程序段或代码的一部分包含一个或多个用于实现规定的逻辑功能的可执行指令,所述模块、程序段或代码的一部分包含一个或多个用于实现规定的逻辑功能的可执行指令。也应当注意,在有些作为替换的实现方式中,方框中所标注的功能也可以以不同于附图中所标注的顺序发生。例如,两个连续的方框实际上可以基本并行地执行,它们有时也可以按相反的顺序执行,这依所涉及的功能而定。也要注意的是,框图和/或流程图中的每个方框、以及框图和/或流程图中的方框的组合,可以用于执行规定的功能或动作的专用的基于硬件的系统来实现,或者可以用专用硬件与计算机指令的组合来实现。
尽管本发明的内容已经通过上述优选实施例作了详细介绍,但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后,对于本发明的多种修改和替代都将是显而易见的。因此,本发明的保护范围应由所附的权利要求来限定。
Claims (8)
1.一种提高星敏感器和陀螺在轨联合滤波精度的方法,其应用于卫星姿态确定系统,其特征在于,包括:
步骤S1:获取陀螺测量的卫星三轴惯性角速度,根据所述惯性角速度,得到卫星姿态角速度,并根据卫星运动学方程得到卫星姿态四元数估计值;
步骤S2:根据所述卫星姿态四元数估计值和由星敏感器数据计算的姿态四元数,得到姿态误差四元数;
步骤S3:对所述卫星姿态确定系统进行状态滤波,得到姿态误差四元数估值和陀螺常值漂移残差的估值,在滤波启动的Δt时间内完成快速收敛,得到第一滤波结果,所述第一滤波结果不接入所述卫星确定系统中;在滤波启动的Δt时间后更换滤波系数,得到第二滤波结果,并将所述第二滤波结果接入所述卫星姿态确定系统中使用,
卡尔曼滤波初始启动后所述Δt时间内,使用的滤波增益系数为K1和K11,得到所述Δt时间内,滤波后所述姿态误差四元数矢量部分估值的表达式为:
式中:e,k中e表示误差(error),k表示卡尔曼(Kalman)滤波;所述Δt时间内,滤波后所述陀螺常值漂移残差的估值的表达式为:
式中:的下标k表示卡尔曼(Kalman)滤波;
所述Δt时间内,滤波后所述姿态误差四元数矢量部分估值和陀螺常值漂移残差的估值/>为第一滤波结果,
所述Δt时间后,使用的滤波增益系数K2和K22,得到所述Δt时间后,滤波后所述姿态误差四元数矢量部分的估值的表达式为:
所述Δt时间后,滤波后所述陀螺常值漂移残差的估值的表达式为:
所述Δt时间后,滤波后所述姿态误差四元数矢量部分的估值和所述陀螺常值漂移残差的估值/>为高精度滤波估值,所述高精度滤波估值即为所述第二滤波结果;
步骤S4:对所述卫星姿态确定系统进行状态更新,得到卫星姿态四元数估值更新值,根据选定的转序,得到卫星姿态角。
2.如权利要求1所述的提高星敏感器和陀螺在轨联合滤波精度的方法,其特征在于,在步骤S1中,由所述陀螺测量的卫星三轴惯性角速度ωbi,得到卫星三轴惯性角速度的计算值所述陀螺测量的卫星三轴惯性角速度ωbi与所述卫星三轴惯性角速度的计算值/>之间的表达式为:
式中:k表示当前计算周期;k-1表示前一个计算周期;
bi表示卫星本体系b系相对于惯性系i系;
ωbi(k)表示当前计算周期的陀螺测量的卫星三轴惯性角速度;
表示当前计算周期的卫星三轴惯性角速度的计算值;
表示陀螺常值漂移残差(即陀螺真实常值漂移与地面标定的常值漂移之差)的估值在本体系的三轴分量;
表示前一个计算周期的陀螺常值漂移残差的估值在本体系的三轴分量。
3.如权利要求2所述的提高星敏感器和陀螺在轨联合滤波精度的方法,其特征在于,由所述陀螺测量的卫星三轴惯性角速度的计算值得到所述卫星姿态角速度/>再根据所述卫星姿态角速度/>得到所述卫星姿态四元数估计值/>所述卫星姿态角速度/>与所述卫星姿态四元数估计值/>之间关系式为:
式中:TS为计算周期;q1,q2,q3,q4为姿态四元数,q4为标量,[q13×]为反对称矩阵;
表示当前计算周期卫星姿态四元数估计值;
表示前一个计算周期卫星姿态四元数估计值;
为关于四元数/>的姿态矩阵;
表示当前周期的卫星姿态角速度;
bo表示卫星本体系b系相对于轨道系o系;
ω0为常量,表示卫星轨道角度;
为启动卡尔曼滤波前一拍的值;
为启动卡尔曼滤波前一拍的值。
4.如权利要求3所述的提高星敏感器和陀螺在轨联合滤波精度的方法其特征在于,在步骤S2中,当所述星敏感器数据正常时,所述姿态误差四元数qe的表达式为:
式中:qe(k)表示当前计算周期姿态误差四元数;
e表示误差(error);
和/>为当前周期姿态四元数,/>为标量。
5.如权利要求4所述的提高星敏感器和陀螺在轨联合滤波精度的方法其特征在于,在步骤S2中,当所述星敏感器数据异常时,所述姿态误差四元数qe的表达式为:
qe(k)=[0 0 0 1]T
式中:qe(k)=(Qse 1),Qse为所述姿态误差四元数qe(k)的矢量部分;
Qse的下标se为自定义,无特殊含义。
6.如权利要求5所述的提高星敏感器和陀螺在轨联合滤波精度的方法,其特征在于,在步骤S4中,根据所述第一滤波结果和所述第二滤波结果,对所述卫星姿态四元数进行更新,得到更新后所述卫星姿态四元数的表达式为:
式中:为姿态误差四元数矢量部分的估值;
为姿态误差四元数矢量部分的估值的转置矩阵。
7.如权利要求6所述的提高星敏感器和陀螺在轨联合滤波精度的方法,其特征在于,在步骤S4中,根据所述第一滤波结果和所述第二滤波结果,得到所述陀螺常值漂移残差的估值在本体系的三轴分量的值,
当星敏感器数据正常时,得到更新后所述陀螺常值漂移残差的估值在本体系的三轴分量的表达式为:
式中:表示当前周期陀螺常值漂移残差的估值在本体系的三轴分量;
表示前一个周期陀螺常值漂移残差的估值在本体系的三轴分量;
当星敏感器数据异常时,得到更新后所述陀螺常值漂移残差的估值在本体系的三轴分量的表达式为:
8.如权利要求7所述的提高星敏感器和陀螺在轨联合滤波精度的方法,其特征在于,所述步骤S3还包括:卡尔曼滤波启动但不接入所述卫星姿态确定系统时,不对所述姿态误差四元数矢量部分的估值进行限幅处理,接入所述卫星姿态确定系统后,对所述姿态误差四元数矢量部分的估值/>进行限幅处理;所述步骤S4还包括:卡尔曼滤波启动但不接入所述卫星姿态确定系统时,不对所述陀螺常值漂移残差的估值/>进行限幅处理,接入所述卫星姿态确定系统后,对所述陀螺常值漂移残差的估值/>进行限幅处理。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110767452.2A CN113686334B (zh) | 2021-07-07 | 2021-07-07 | 一种提高星敏感器和陀螺在轨联合滤波精度的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110767452.2A CN113686334B (zh) | 2021-07-07 | 2021-07-07 | 一种提高星敏感器和陀螺在轨联合滤波精度的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113686334A CN113686334A (zh) | 2021-11-23 |
CN113686334B true CN113686334B (zh) | 2023-08-04 |
Family
ID=78576768
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110767452.2A Active CN113686334B (zh) | 2021-07-07 | 2021-07-07 | 一种提高星敏感器和陀螺在轨联合滤波精度的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113686334B (zh) |
Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010211282A (ja) * | 2009-03-06 | 2010-09-24 | Mitsubishi Electric Corp | 適応制御装置 |
CN102937450A (zh) * | 2012-10-31 | 2013-02-20 | 北京控制工程研究所 | 一种基于陀螺测量信息的相对姿态确定方法 |
CN103940433A (zh) * | 2014-05-12 | 2014-07-23 | 哈尔滨工业大学 | 一种基于改进的自适应平方根ukf算法的卫星姿态确定方法 |
CN106767767A (zh) * | 2016-11-23 | 2017-05-31 | 上海航天控制技术研究所 | 一种微纳多模星敏感器系统及其数据融合方法 |
CN106767846A (zh) * | 2017-03-13 | 2017-05-31 | 上海航天控制技术研究所 | 三轴稳定卫星不用陀螺的姿态获取方法和系统 |
CN106915477A (zh) * | 2017-03-06 | 2017-07-04 | 上海航天控制技术研究所 | 一种姿态控制方法 |
CN107228674A (zh) * | 2017-06-06 | 2017-10-03 | 上海航天控制技术研究所 | 一种针对星敏感器和陀螺联合滤波的改进方法 |
CN107389069A (zh) * | 2017-07-25 | 2017-11-24 | 上海航天控制技术研究所 | 基于双向卡尔曼滤波的地面姿态处理方法 |
CN107618678A (zh) * | 2017-08-25 | 2018-01-23 | 中国科学院长春光学精密机械与物理研究所 | 卫星姿态角度偏差下的姿控信息联合估计方法 |
CN107702710A (zh) * | 2017-08-17 | 2018-02-16 | 上海航天控制技术研究所 | 一种多陀螺表头常值漂移实时估计方法 |
CN108225337A (zh) * | 2017-12-28 | 2018-06-29 | 西安电子科技大学 | 基于sr-ukf滤波的星敏感器和陀螺组合定姿方法 |
CN110109470A (zh) * | 2019-04-09 | 2019-08-09 | 西安电子科技大学 | 基于无迹卡尔曼滤波的联合定姿方法、卫星姿态控制系统 |
CN110702107A (zh) * | 2019-10-22 | 2020-01-17 | 北京维盛泰科科技有限公司 | 一种单目视觉惯性组合的定位导航方法 |
CN113008272A (zh) * | 2021-03-08 | 2021-06-22 | 航天科工空间工程发展有限公司 | 一种用于微小卫星的mems陀螺在轨常值漂移标定方法和系统 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7142981B2 (en) * | 2003-08-05 | 2006-11-28 | The Boeing Company | Laser range finder closed-loop pointing technology of relative navigation, attitude determination, pointing and tracking for spacecraft rendezvous |
TWI689705B (zh) * | 2018-10-18 | 2020-04-01 | 財團法人國家實驗研究院 | 一種衛星姿態資料融合系統及其方法 |
TWI717726B (zh) * | 2019-04-30 | 2021-02-01 | 財團法人國家實驗研究院 | 一種繞地衛星姿態資料融合系統及其方法 |
-
2021
- 2021-07-07 CN CN202110767452.2A patent/CN113686334B/zh active Active
Patent Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010211282A (ja) * | 2009-03-06 | 2010-09-24 | Mitsubishi Electric Corp | 適応制御装置 |
CN102937450A (zh) * | 2012-10-31 | 2013-02-20 | 北京控制工程研究所 | 一种基于陀螺测量信息的相对姿态确定方法 |
CN103940433A (zh) * | 2014-05-12 | 2014-07-23 | 哈尔滨工业大学 | 一种基于改进的自适应平方根ukf算法的卫星姿态确定方法 |
CN106767767A (zh) * | 2016-11-23 | 2017-05-31 | 上海航天控制技术研究所 | 一种微纳多模星敏感器系统及其数据融合方法 |
CN106915477A (zh) * | 2017-03-06 | 2017-07-04 | 上海航天控制技术研究所 | 一种姿态控制方法 |
CN106767846A (zh) * | 2017-03-13 | 2017-05-31 | 上海航天控制技术研究所 | 三轴稳定卫星不用陀螺的姿态获取方法和系统 |
CN107228674A (zh) * | 2017-06-06 | 2017-10-03 | 上海航天控制技术研究所 | 一种针对星敏感器和陀螺联合滤波的改进方法 |
CN107389069A (zh) * | 2017-07-25 | 2017-11-24 | 上海航天控制技术研究所 | 基于双向卡尔曼滤波的地面姿态处理方法 |
CN107702710A (zh) * | 2017-08-17 | 2018-02-16 | 上海航天控制技术研究所 | 一种多陀螺表头常值漂移实时估计方法 |
CN107618678A (zh) * | 2017-08-25 | 2018-01-23 | 中国科学院长春光学精密机械与物理研究所 | 卫星姿态角度偏差下的姿控信息联合估计方法 |
CN108225337A (zh) * | 2017-12-28 | 2018-06-29 | 西安电子科技大学 | 基于sr-ukf滤波的星敏感器和陀螺组合定姿方法 |
CN110109470A (zh) * | 2019-04-09 | 2019-08-09 | 西安电子科技大学 | 基于无迹卡尔曼滤波的联合定姿方法、卫星姿态控制系统 |
CN110702107A (zh) * | 2019-10-22 | 2020-01-17 | 北京维盛泰科科技有限公司 | 一种单目视觉惯性组合的定位导航方法 |
CN113008272A (zh) * | 2021-03-08 | 2021-06-22 | 航天科工空间工程发展有限公司 | 一种用于微小卫星的mems陀螺在轨常值漂移标定方法和系统 |
Non-Patent Citations (1)
Title |
---|
双星敏感器在轨相对热变形分析及修正;吴敬玉等;《遥感学报》;197-199 * |
Also Published As
Publication number | Publication date |
---|---|
CN113686334A (zh) | 2021-11-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP1585939B1 (en) | Attitude change kalman filter measurement apparatus and method | |
CN111551174A (zh) | 基于多传感器惯性导航系统的高动态车辆姿态计算方法及系统 | |
Stovner et al. | Attitude estimation by multiplicative exogenous Kalman filter | |
CN109931957B (zh) | 基于lgmkf的sins捷联惯性导航系统自对准方法 | |
CN110567461B (zh) | 一种考虑无陀螺仪的非合作航天器姿态和参数估计方法 | |
Stančić et al. | The integration of strap-down INS and GPS based on adaptive error damping | |
CN111721288B (zh) | 一种mems器件零偏修正方法、装置及存储介质 | |
CN108562290B (zh) | 导航数据的滤波方法、装置、计算机设备及存储介质 | |
CN115143954A (zh) | 一种基于多源信息融合的无人车导航方法 | |
JP2002323322A (ja) | 慣性計測装置を用いた姿勢推定装置及び方法並びにプログラム | |
CN113432612B (zh) | 飞行体的导航方法、装置及系统 | |
CN115200578A (zh) | 基于多项式优化的惯性基导航信息融合方法及系统 | |
CN114964222A (zh) | 一种车载imu姿态初始化方法、安装角估计方法及装置 | |
CN110595434A (zh) | 基于mems传感器的四元数融合姿态估计方法 | |
CN113686334B (zh) | 一种提高星敏感器和陀螺在轨联合滤波精度的方法 | |
CN112097728B (zh) | 基于反向解算组合惯性导航系统的惯性双矢量匹配形变测量方法 | |
CN109781103B (zh) | 基于双超平台的姿态角速度测量方法及系统 | |
CN110471293B (zh) | 一种估计时变角速度的z轴陀螺仪滑模控制方法 | |
CN114018262B (zh) | 一种改进的衍生容积卡尔曼滤波组合导航方法 | |
CN108871312B (zh) | 一种重力梯度仪及星敏感器的联合定姿方法 | |
CN116499493A (zh) | 一种基于低频逆向滤波的惯导快速对准方法 | |
Da Forno et al. | Autonomous navigation of MegSat1: Attitude, sensor bias and scale factor estimation by EKF and magnetometer-only measurement | |
CN112304309B (zh) | 一种基于心动阵列的高超飞行器组合导航信息解算方法 | |
CN114323007A (zh) | 一种载体运动状态估计方法及装置 | |
CN108957508B (zh) | 车载pos离线组合估计方法和装置 |
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 |