CN110109470B - 基于无迹卡尔曼滤波的联合定姿方法、卫星姿态控制系统 - Google Patents
基于无迹卡尔曼滤波的联合定姿方法、卫星姿态控制系统 Download PDFInfo
- Publication number
- CN110109470B CN110109470B CN201910281474.0A CN201910281474A CN110109470B CN 110109470 B CN110109470 B CN 110109470B CN 201910281474 A CN201910281474 A CN 201910281474A CN 110109470 B CN110109470 B CN 110109470B
- Authority
- CN
- China
- Prior art keywords
- attitude
- quaternion
- attitude determination
- unscented kalman
- determination method
- 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
Landscapes
- Navigation (AREA)
Abstract
本发明属于卫星姿态确定技术领域,公开了一种基于无迹卡尔曼滤波的联合定姿方法、卫星姿态控制系统;基于UKF的星敏感器和陀螺联合定姿算法,构建微分形式非线性状态方程,并采用四阶龙格‑库塔积分法求解状态变量的时间更新,避免了非线性微分状态方程的离散化过程;利用UKF算法对星敏感器四元数和陀螺角速度进行滤波修正。本发明通过四阶龙格‑库塔积分法进行时间更新,利用四元数乘性误差计算加权均值与协方差,采用无迹卡尔曼滤波算法,引入星敏感器的观测值进行滤波更新,最后利用估计误差四元数对姿态数据进行修正。在姿态敏感器测量误差较大时具有良好的定姿性能,较基于扩展卡尔曼滤波的定姿算法有更高的估计精度。
Description
技术领域
本发明属于卫星姿态确定技术领域,尤其涉及一种基于无迹卡尔曼滤波的联合定姿方法、卫星姿态控制系统。
背景技术
目前,最接近的现有技术:姿态确定技术是通过某种算法,对姿态敏感器带误差测量值进行处理,减小误差,修正测量值的过程,广泛应用于卫星导航定位等领域。对测绘卫星来说,姿态确定的精度是高精度定位的重要前提。当前卫星上主要使用星敏感器和陀螺联合的形式,利用动态估计法进行滤波处理。动态估计法是利用一系列连续时刻的测量信息,采用姿态运动学模型等理论,融合多种姿态设备的测量信息来计算姿态信息。由于卫星导航系统以及卫星姿态确定系统一般都是非线性系统,近年来,卫星上广泛利用扩展卡尔曼滤波算法进行姿态确定。扩展卡尔曼滤波的关键步骤是对卫星的非线性状态方程和量测方程做泰勒级数展开并保留线性项,获得线性模型,之后再利用传统卡尔曼滤波进行处理。但由于EKF近似保留线性项,因此其仅适用于弱非线性系统,当系统为强非线性时,EKF的线性化处理会导致滤波精度降低,甚至滤波发散。为了克服上述缺点,提出无迹卡尔曼滤波算法,无迹卡尔曼滤波在估计点附近确定若干采样点,利用这些采样点所表示的高斯概率密度对非线性函数的概率密度分布进行近似,以替代EKF中的状态方程和量测方程近似过程。但UKF算法在解决状态方程为连续非线性常微分方程组的非线性定姿问题时,通常会对状态方程做离散化处理,一方面离散化过程推导复杂,另一方面会产生离散化误差。另外,传统UKF在解算状态变量的均值和协方差时,将四元数等同于一般向量求解,无法满足四元数归一化条件。
综上所述,现有技术存在的问题是:现有的算法对状态方程和量测方程进行线性化和离散化处理,不可避免地产生线性化和离散化误差,忽略四元数运算特性与物理意义,导致滤波性能下降。
解决上述技术问题的难度:
上述技术问题的难度在于:1)如何避免线性化和离散化处理,有效提升姿态估计的精度;2)如何将四元数的运算特性运用到均值和协方差矩阵的求解过程。
解决上述技术问题的意义:
通过本发明提供的方法,可以解决在系统测量误差较大时传统算法滤波性能下降的问题,对比传统滤波算法有更高的估计精度。
发明内容
针对现有技术存在的问题,本发明提供了一种基于无迹卡尔曼滤波的联合定姿方法、卫星姿态控制系统。
本发明是这样实现的,一种基于无迹卡尔曼滤波的联合定姿方法,所述基于无迹卡尔曼滤波的联合定姿方法采用误差四元数和陀螺常值漂移的非线性微分状态方程的UKF的星敏感器和陀螺联合定姿算法,构建微分形式非线性状态方程,并采用四阶龙格-库塔积分法求解状态变量的时间更新;利用四元数乘性误差计算加权均值与协方差,采用无迹卡尔曼滤波算法,引入星敏感器的观测值进行滤波更新,最后利用估计误差四元数对姿态数据进行修正。
进一步,所述基于无迹卡尔曼滤波的联合定姿方法的系统状态方程和量测方程构建:
(1)陀螺的量测模型表示为式:
ωg=ω+b+d+ng;
卫星三轴稳定,其中ωg、ω分别为陀螺输出的本体坐标系相对于惯性坐标系的三轴角速度测量值和理论真实值;b为陀螺仪的常值漂移噪声,满足ηb为白噪声;d为陀螺的随机漂移噪声,满足Dτ与时间常数τ有关,ηd为白噪声;ηg为陀螺的测量噪声,一般认为是高斯白噪声;
(2)利用星敏感器误差四元数以及陀螺的常值漂移误差定义系统状态变量:
其中Δq4为标量,Δq=[Δq1 Δq2 Δq3]T为矢量,且满足ΔqTΔq+Δq4 2=1;
(3)利用姿态运动学方程和陀螺的量测模型建立非线性微分系统状态方程。基于四元数的姿态运动学方程式:
(4)定义星敏感器的量测残差为星敏感器的估计值与测量值之差,即:
根据建立非线性离散量测方程:
其中zk是误差四元数k时刻的量测值,H=[I4×4 04×3]为观测矩阵,量测噪声υk服从N(0,R)。
进一步,所述基于无迹卡尔曼滤波的联合定姿方法具体包括:
输入:星敏感器量测值、陀螺的量测值;
输出:估计姿态四元数;
1)设置初始状态变量、初始状态协方差矩阵、系统噪声协方差矩阵、量测噪声协方差矩阵;
若无星敏感器测量值,则k+1时刻的姿态估计值等于k+1时刻的姿态预测值,转2);若有星敏感器测量值,转3)进入UKF滤波;
3)对状态变量进行增广,并生成sigma点集;
4)进行时间更新;计算状态变量的统计特性;
5)量测更新,计算得到k+1时刻的误差四元数和陀螺常值漂移估计值;
6)姿态与角速度修正,利用下式对姿态四元数与陀螺角速度进行修正;之后将状态变量置零,转2);
本发明的另一目的在于提供一种应用所述基于无迹卡尔曼滤波的联合定姿方法的航天器姿态控制系统。
本发明的另一目的在于提供一种应用所述基于无迹卡尔曼滤波的联合定姿方法的飞行器。
本发明的另一目的在于提供一种应用所述基于无迹卡尔曼滤波的联合定姿方法的卫星。
综上所述,本发明的优点及积极效果为:星敏感器和陀螺联合定姿是当前获取卫星高精度姿态的主要手段。针对扩展卡尔曼滤波算法存在线性化近似、容易发散的弊端,实现了一种基于无迹卡尔曼滤波的联合定姿方法、卫星姿态控制系统算法。本发明推导了基于误差四元数和陀螺常值漂移的非线性微分状态方程,通过四阶龙格-库塔积分法进行时间更新,利用四元数乘性误差计算加权均值与协方差,采用无迹卡尔曼滤波算法,引入星敏感器的观测值进行滤波更新,最后利用估计误差四元数对姿态数据进行修正。仿真实验结果表明,该算法在姿态敏感器测量误差较大时具有良好的定姿性能,较基于扩展卡尔曼滤波的定姿算法有更高的估计精度。
表1 EKF和UKF定姿中误差对比
附图说明
图1是本发明实施例提供的基于无迹卡尔曼滤波的联合定姿方法流程图。
图2是本发明实施例提供的基于无迹卡尔曼滤波的联合定姿方法实现流程图。
图3是本发明实施例提供的EKF和UKF定姿误差对比曲线(陀螺测量误差:2″/s)示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
本发明基于UKF的星敏感器和陀螺联合定姿算法,构建微分形式非线性状态方程,并采用四阶龙格-库塔积分法求解状态变量的时间更新;避免了非线性微分状态方程的离散化过程,利用UKF算法对星敏感器四元数和陀螺角速度进行滤波修正;另外引入四元数乘性误差以保证四元数的归一化约束性质及几何意义,实验结果验证了算法的有效性。
下面结合附图对本发明的应用原理作详细的描述。
如图1所示,本发明实施例提供的基于无迹卡尔曼滤波的联合定姿方法包括以下步骤:
S101:基于误差四元数和陀螺常值漂移的非线性微分状态方程,通过四阶龙格-库塔积分法进行时间更新;
S102:利用四元数乘性误差计算加权均值与协方差,采用无迹卡尔曼滤波算法,引入星敏感器的观测值进行滤波更新;
S103:利用估计误差四元数对姿态数据进行修正。
下面结合附图对本发明的应用原理作进一步的描述。
1基本原理
1.1无迹变换基本原理
无迹变换(Unscented Transform,UT)在估计点附近确定若干采样点,利用采样点所表示的高斯概率密度对非线性函数的概率密度分布进行近似,以替代EKF滤波中的状态方程和量测方程近似过程。其基本原理如下:假设有一非线性变换y=f(x),x是n维状态变量,均值为协方差为Px,可以通过无迹变换来计算y的均值和协方差矩阵Py。首先构建2n+1个对称分布的采样点(Sigma点):
之后将Sigma点集通过非线性函数y=f(x),得到点集{yi},计算{yi}的统计特征如(2):
权值为:
其中α决定了sigma点的散布程度,10-4≤α≤1;β描述了状态变量的分布,对高斯分布取2达到最优;λ=α2(n+k)-n是缩放比例参数,k保证矩阵(N+λ)P为半正定矩阵,通常取0。
1.2四阶龙格-库塔积分基本原理
龙格-库塔积分法是一种常用的常微分方程的数值解法,是高精度的单步法。利用龙格-库塔积分代替UKF算法中对连续微分方程离散化的过程,避免繁琐的计算,同时四阶龙格-库塔积分能够得到近似四阶泰勒级数的精度。其基本原理如下:
设有m个一阶方程组成的常微分方程组,其矩阵形式为(4):
四阶龙格-库塔公式为(5):
其中:
1.3无迹卡尔曼滤波算法原理
UKF是将UT变换和kalman滤波框架结合的一种算法。将UT变换应用于Kalman滤波中状态和量测的均值及协方差的递推中,即能够得到UKF滤波器。与EKF算法相同,UKF算法沿袭了Kalman滤波框架。但UKF不必对系统做近似线性化处理,避免了雅克比矩阵的求解;EKF算法是对非线性对象的一阶或二阶近似,而UT变换能达到泰勒级数三阶精度;UKF能适用于强非线性系统下的估计,不会滤波发散,且估计精度更高、稳定性更强。
非线性状态方程和量测方程的一般形式分别如(6)、(7):
zk=h(xk,vk) (7)
其中x(t)是t时刻系统状态变量;zk是系统量测向量;w(t)是t时刻系统噪声,服从N(0,Q);vk是量测噪声,服从N(0,R)。
1)初始化。对于非可加性噪声,需要对状态变量进行扩展,将系统噪声和量测噪声向量添加进状态变量中一同进行估计,形成增广状态向量和增广协方差矩阵分为为(8)、(9):
3)时间更新
时间更新时需要计算k+1时刻的状态变量值,通常做法是对式(6)进行离散化处理,但离散化需要对方程进行泰勒展开并忽略二阶以上项,这不可避免地会产生离散化误差,也会带来大量繁琐的计算。因此,本发明利用四阶龙格-库塔法对式(6)在(t,t+Δt)区间内积分,得到式(10):
计算:
4)量测更新
2算法设计与实现
2.1系统状态方程和量测方程构建
陀螺的量测模型可以表示为式(13):
ωg=ω+b+d+ng (13)
假设卫星三轴稳定,其中ωg、ω分别为陀螺输出的本体坐标系相对于惯性坐标系的三轴角速度测量值和理论真实值;b为陀螺仪的常值漂移噪声,满足ηb为白噪声;d为陀螺的随机漂移噪声,满足Dτ与时间常数τ有关,ηd为白噪声;ηg为陀螺的测量噪声,一般认为是高斯白噪声。
星敏感器获得的是星敏坐标系相对于惯性坐标系的四元数数据(可以通过乘安装矩阵转换为本体坐标系相对于惯性坐标系的数据),由于星敏感器精度较高,一般认为测量噪声为高斯白噪声。
利用星敏感器误差四元数以及陀螺的常值漂移误差定义系统状态变量:
其中Δq4为标量,Δq=[Δq1 Aq2 Δq3]T为矢量,且满足ΔqTΔq+Δq4 2=1
利用姿态运动学方程和陀螺的量测模型建立非线性微分系统状态方程。基于四元数的姿态运动学方程如式(14):
定义星敏感器的量测残差为星敏感器的估计值与测量值之差,即:
根据式(17)建立非线性离散量测方程:
其中zk是误差四元数k时刻的量测值(即测量残差),H=[I4×4 O4×3]为观测矩阵,量测噪声vk服从N(0,Q)。
2.2算法具体实现
针对基于无迹卡尔曼滤波的星敏感器和陀螺组合定姿算法做出算法流程图2。
输入:星敏感器量测值(四元数)、陀螺的量测值(角速度)
输出:估计姿态四元数
1)参数初始化。设置初始状态变量、初始状态协方差矩阵、系统噪声协方差矩阵、量测噪声协方差矩阵等;
若无星敏感器测量值,则k+1时刻的姿态估计值等于k+1时刻的姿态预测值,转2);若有星敏感器测量值,转3)进入UKF滤波。
3)生成sigma点集。利用式(8)、(9)对状态变量进行增广,并根据式(1)生成sigma点集。
4)时间更新。利用式(10)、(11)进行时间更新。利用式(3)计算陀螺常值漂移的统计特性。注意四元数在计算均值和协方差矩阵时与普通向量有所区别,应该利用四元数乘性误差进行计算,以保证四元数的归一性及几何意义的完整:
5)量测更新。利用公式(12)计算得到k+1时刻的误差四元数和陀螺常值漂移估计值。
6)姿态与角速度修正。利用式(20)对姿态四元数与陀螺角速度进行修正。之后将状态变量置零,转2)。
下面结合试验对本发明的应用效果作详细的描述。
1、利用仿真数据对UKF定姿算法进行实验。实验数据的参数为:星敏感器采样频率为5Hz,陀螺采样频率为10Hz,星敏感器测量精度为5″,陀螺测量精度为0.1~2.5″/s。同时仿真了无误差的星敏感器姿态四元数,作为对比使用。UKF定姿的参数设置为:状态变量初值07×1,陀螺常值漂移初值03×1,常值漂移噪声均方根值为10-6I3×3。
定姿误差指标为三轴(俯仰、横滚、偏航)姿态中误差(″),首先计算每一时刻的姿态误差四元数,接着将每一时刻的误差四元数转换为三轴姿态角,最后统计每一个轴向的姿态中误差。
给出上述实验条件下的姿态估计结果,如图3、表1所示。
表1 EKF和UKF定姿中误差对比
由图3可知,本发明提出的定姿算法与传统EKF定姿算法相比,更加平稳;由表1可知,在其他条件相同,陀螺精度需≤0.8″/s,EKF定姿精度才能优于1″,而使用本发明提出的UKF算法只需陀螺精度≤1.0″/s;在姿态精度较好时,EKF和UKF差距不大,但在姿态精度较差时,例如陀螺测量精度为2.2″/s时,UKF三轴精度较EKF提升14%、12%、13%,UKF定姿算法优于传统EKF定姿方法,有良好的定姿性能。
本发明为了解决EKF算法存在线性化近似、容易发散的问题,对基于UKF的星敏感器和陀螺联合定姿算法进行研究。经过仿真实验表明,与传统的EKF算法相比,本发明的算法即使在传感器测量精度不高时,也能获得较好的姿态估计结果,而且更加稳定。该算法为进一步提高卫星姿态确定的精度提供了参考,具有重要的意义。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (9)
1.一种基于无迹卡尔曼滤波的联合定姿方法,其特征在于,所述基于无迹卡尔曼滤波的联合定姿方法采用误差四元数和陀螺常值漂移的非线性微分状态方程的UKF的星敏感器和陀螺联合定姿算法,构建微分形式非线性状态方程,并采用四阶龙格-库塔积分法求解状态变量的时间更新;利用四元数乘性误差计算加权均值与协方差,采用无迹卡尔曼滤波算法,引入星敏感器的观测值进行滤波更新,最后利用估计误差四元数对姿态数据进行修正;
所述基于无迹卡尔曼滤波的联合定姿方法的系统状态方程和量测方程构建:
(1)陀螺的量测模型表示为式:
wg=w+b+d+ng;
卫星三轴稳定,其中wg、w分别为陀螺输出的本体坐标系相对于惯性坐标系的三轴角速度测量值和理论真实值;b为陀螺仪的常值漂移噪声,满足ηb为白噪声;d为陀螺的随机漂移噪声,满足Dτ与时间常数τ有关,ηd为白噪声;ηg为陀螺的测量噪声;
(2)利用星敏感器误差四元数以及陀螺的常值漂移误差定义系统状态变量:
(3)利用姿态运动学方程和陀螺的量测模型建立非线性微分系统状态方程;基于四元数的姿态运动学方程式:
(4)定义星敏感器的量测残差为星敏感器的估计值与测量值之差:
建立非线性离散量测方程:
其中zk是误差四元数k时刻的量测残差,H=[I4×4 04×3]为观测矩阵,量测噪声vk服从N(0,R)。
2.如权利要求1所述的基于无迹卡尔曼滤波的联合定姿方法,其特征在于,所述基于无迹卡尔曼滤波的联合定姿方法具体包括:
输入:星敏感器量测值、陀螺的量测值;
输出:估计姿态四元数;
1)设置初始状态变量、初始状态协方差矩阵、系统噪声协方差矩阵、量测噪声协方差矩阵;
2)k+1时刻的姿态预测;
若无星敏感器测量值,则k+1时刻的姿态估计值等于k+1时刻的姿态预测值,转2);若有星敏感器测量值,转3)进入UKF滤波;
3)对状态变量进行增广,并生成sigma点集;
4)进行时间更新,计算状态变量的统计特性;
5)量测更新,计算得到k+1时刻的误差四元数和陀螺常值漂移估计值;
6)姿态与角速度修正,利用下式对姿态四元数与陀螺角速度进行修正;之后将状态变量置零,转2);
7.一种应用权利要求1~6任意一项所述基于无迹卡尔曼滤波的联合定姿方法的航天器姿态控制系统。
8.一种应用权利要求1~6任意一项所述基于无迹卡尔曼滤波的联合定姿方法的飞行器。
9.一种应用权利要求1~6任意一项所述基于无迹卡尔曼滤波的联合定姿方法的卫星。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910281474.0A CN110109470B (zh) | 2019-04-09 | 2019-04-09 | 基于无迹卡尔曼滤波的联合定姿方法、卫星姿态控制系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910281474.0A CN110109470B (zh) | 2019-04-09 | 2019-04-09 | 基于无迹卡尔曼滤波的联合定姿方法、卫星姿态控制系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110109470A CN110109470A (zh) | 2019-08-09 |
CN110109470B true CN110109470B (zh) | 2021-10-29 |
Family
ID=67483953
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910281474.0A Active CN110109470B (zh) | 2019-04-09 | 2019-04-09 | 基于无迹卡尔曼滤波的联合定姿方法、卫星姿态控制系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110109470B (zh) |
Families Citing this family (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111044082B (zh) * | 2020-01-15 | 2021-07-06 | 北京航空航天大学 | 一种基于星敏感器辅助的陀螺误差参数在轨快速标定方法 |
CN111678515A (zh) * | 2020-04-28 | 2020-09-18 | 北京三快在线科技有限公司 | 设备状态估计方法、装置、电子设备及存储介质 |
CN111678512B (zh) * | 2020-06-03 | 2022-03-04 | 中国人民解放军军事科学院国防科技创新研究院 | 一种基于因子图的星敏感器和陀螺组合卫星姿态确定方法 |
CN111798523B (zh) * | 2020-06-19 | 2022-09-02 | 武汉大学 | 星相机在轨定标定姿及遥感影像几何定位方法、系统 |
CN112162563B (zh) * | 2020-09-15 | 2023-01-31 | 郑州轻工业大学 | 基于自适应弱敏无迹Kalman滤波的直升机状态估计方法 |
CN112278329B (zh) * | 2020-10-30 | 2022-02-15 | 长光卫星技术有限公司 | 一种用于遥感卫星定姿的非线性滤波方法 |
CN112461511B (zh) * | 2020-11-10 | 2022-03-25 | 中国科学院长春光学精密机械与物理研究所 | 浮空平台望远镜指向获取方法、装置、设备及存储介质 |
CN112957033B (zh) * | 2021-02-01 | 2022-10-18 | 山东大学 | 人机协作中人体实时室内定位与运动姿态捕捉方法与系统 |
CN113074753A (zh) * | 2021-03-19 | 2021-07-06 | 南京天巡遥感技术研究院有限公司 | 一种星敏感器陀螺联合定姿方法、联合定姿系统及应用 |
CN113204909B (zh) * | 2021-06-04 | 2022-07-19 | 哈尔滨工业大学 | 基于地基观测光度信号的卫星几何特征与姿态估计方法 |
CN113361596B (zh) * | 2021-06-04 | 2022-10-04 | 安徽农业大学 | 一种传感器数据增广方法、系统及存储介质 |
CN113342026B (zh) * | 2021-06-30 | 2022-10-21 | 中国人民解放军军事科学院国防科技创新研究院 | 一种小型无人直升机智能平衡控制装置 |
CN113686334B (zh) * | 2021-07-07 | 2023-08-04 | 上海航天控制技术研究所 | 一种提高星敏感器和陀螺在轨联合滤波精度的方法 |
CN113961012B (zh) * | 2021-09-24 | 2023-09-22 | 中国航空工业集团公司沈阳飞机设计研究所 | 一种基于ekf滤波降噪的增量动态逆控制方法 |
CN114459464A (zh) * | 2022-01-11 | 2022-05-10 | 中国科学院长春光学精密机械与物理研究所 | 一种星敏感器自主姿态优化方法 |
CN114577234B (zh) * | 2022-01-24 | 2023-10-13 | 上海卫星工程研究所 | 卫星相对姿态基准误差分析方法和系统、装置 |
CN115655285B (zh) * | 2022-11-15 | 2023-12-01 | 浙大城市学院 | 一种权值及参考四元数修正的无迹四元数姿态估计方法 |
CN117875226B (zh) * | 2024-03-13 | 2024-06-18 | 江南大学 | 基于流形空间协方差递推的连续离散卡尔曼状态估计方法 |
Citations (11)
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 |
CN101270993A (zh) * | 2007-12-12 | 2008-09-24 | 北京航空航天大学 | 一种远程高精度自主组合导航定位方法 |
CN103398713A (zh) * | 2013-04-26 | 2013-11-20 | 哈尔滨工程大学 | 一种星敏感器/光纤惯性设备量测数据同步方法 |
CN103940433A (zh) * | 2014-05-12 | 2014-07-23 | 哈尔滨工业大学 | 一种基于改进的自适应平方根ukf算法的卫星姿态确定方法 |
CN103950555A (zh) * | 2014-04-22 | 2014-07-30 | 北京控制工程研究所 | 超近距离的高精度相对位置保持控制方法 |
CN104019817A (zh) * | 2014-05-30 | 2014-09-03 | 哈尔滨工程大学 | 一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法 |
US9217643B1 (en) * | 2009-01-08 | 2015-12-22 | Trex Enterprises Corp. | Angles only navigation system |
CN105300384A (zh) * | 2015-04-03 | 2016-02-03 | 东南大学 | 一种用于卫星姿态确定的交互式滤波方法 |
CN107228674A (zh) * | 2017-06-06 | 2017-10-03 | 上海航天控制技术研究所 | 一种针对星敏感器和陀螺联合滤波的改进方法 |
CN108181916A (zh) * | 2017-12-29 | 2018-06-19 | 清华大学 | 小卫星相对姿态的控制方法及装置 |
CN108225337A (zh) * | 2017-12-28 | 2018-06-29 | 西安电子科技大学 | 基于sr-ukf滤波的星敏感器和陀螺组合定姿方法 |
-
2019
- 2019-04-09 CN CN201910281474.0A patent/CN110109470B/zh active Active
Patent Citations (11)
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 |
CN101270993A (zh) * | 2007-12-12 | 2008-09-24 | 北京航空航天大学 | 一种远程高精度自主组合导航定位方法 |
US9217643B1 (en) * | 2009-01-08 | 2015-12-22 | Trex Enterprises Corp. | Angles only navigation system |
CN103398713A (zh) * | 2013-04-26 | 2013-11-20 | 哈尔滨工程大学 | 一种星敏感器/光纤惯性设备量测数据同步方法 |
CN103950555A (zh) * | 2014-04-22 | 2014-07-30 | 北京控制工程研究所 | 超近距离的高精度相对位置保持控制方法 |
CN103940433A (zh) * | 2014-05-12 | 2014-07-23 | 哈尔滨工业大学 | 一种基于改进的自适应平方根ukf算法的卫星姿态确定方法 |
CN104019817A (zh) * | 2014-05-30 | 2014-09-03 | 哈尔滨工程大学 | 一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法 |
CN105300384A (zh) * | 2015-04-03 | 2016-02-03 | 东南大学 | 一种用于卫星姿态确定的交互式滤波方法 |
CN107228674A (zh) * | 2017-06-06 | 2017-10-03 | 上海航天控制技术研究所 | 一种针对星敏感器和陀螺联合滤波的改进方法 |
CN108225337A (zh) * | 2017-12-28 | 2018-06-29 | 西安电子科技大学 | 基于sr-ukf滤波的星敏感器和陀螺组合定姿方法 |
CN108181916A (zh) * | 2017-12-29 | 2018-06-19 | 清华大学 | 小卫星相对姿态的控制方法及装置 |
Non-Patent Citations (2)
Title |
---|
《基于星敏感器和陀螺的卫星定姿新方法》;艾奇等;《现代电子技术》;20120228;第35卷(第4期);第13-17页 * |
《处理带乘性噪声星敏感器/陀螺系统的UKF算法研究》;马凤仙;《中国优秀硕士学位论文全文数据库(电子期刊)》;20120815;第C031-139页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110109470A (zh) | 2019-08-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110109470B (zh) | 基于无迹卡尔曼滤波的联合定姿方法、卫星姿态控制系统 | |
CN108225337B (zh) | 基于sr-ukf滤波的星敏感器和陀螺组合定姿方法 | |
CN109211276B (zh) | 基于gpr与改进的srckf的sins初始对准方法 | |
CN109974714B (zh) | 一种Sage-Husa自适应无迹卡尔曼滤波姿态数据融合方法 | |
CN113155129B (zh) | 一种基于扩展卡尔曼滤波的云台姿态估计方法 | |
CN110044385B (zh) | 一种大失准角情况下的快速传递对准方法 | |
CN110132287A (zh) | 一种基于极限学习机网络补偿的卫星高精度联合定姿方法 | |
CN110567455B (zh) | 一种求积更新容积卡尔曼滤波的紧组合导航方法 | |
CN108645404B (zh) | 一种小型多旋翼无人机姿态解算方法 | |
CN110941285A (zh) | 一种基于双ip核的无人机飞行控制系统 | |
CN113008272B (zh) | 一种用于微小卫星的mems陀螺在轨常值漂移标定方法和系统 | |
CN115033844A (zh) | 一种无人机状态估计方法、系统、设备及可读存储介质 | |
CN113432612B (zh) | 飞行体的导航方法、装置及系统 | |
CN113074753A (zh) | 一种星敏感器陀螺联合定姿方法、联合定姿系统及应用 | |
CN110595434A (zh) | 基于mems传感器的四元数融合姿态估计方法 | |
CN112444644A (zh) | 一种三轴加速度计标定方法 | |
CN113587926A (zh) | 一种航天器空间自主交会对接相对导航方法 | |
CN110912535B (zh) | 一种新型无先导卡尔曼滤波方法 | |
CN115655285B (zh) | 一种权值及参考四元数修正的无迹四元数姿态估计方法 | |
CN113449384A (zh) | 一种基于中心误差熵准则扩展卡尔曼滤波的姿态确定方法 | |
CN111707292A (zh) | 一种自适应滤波的快速传递对准方法 | |
CN107886058B (zh) | 噪声相关的两阶段容积Kalman滤波估计方法及系统 | |
Brunke et al. | Square root sigma point filtering for real-time, nonlinear estimation | |
CN113432608B (zh) | 用于ins/cns组合导航系统的基于最大相关熵的广义高阶ckf方法 | |
CN112013849A (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 |