利索能及
我要发布
收藏
专利号: 2019108070325
申请人: 桂林电子科技大学
专利类型:发明专利
专利状态:已下证
更新日期:2025-10-14
缴费截止日期: 暂无
联系人

摘要:

权利要求书:

1.一种大失准角下SINS初始对准方法,其特征在于,该方法包括:S1建立初始对准的线性误差模型;

S2建立强跟踪滤波器;

S3求解渐消矩阵;

S4利用模糊理论设置隶属度函数,建立模糊规则对渐消矩阵进行控制;

S5重复步骤S2~S4,直至对准结束。

2.根据权利要求1所述的大失准角下SINS初始对准方法,其特征在于,所述初始对准线性误差模型为:其中,F为转移矩阵,H=[0 I 0 0]为量测矩阵,w和v为系统噪声和量测噪声,Xk为k时刻的状态变量。

3.根据权利要求2所述的大失准角下SINS初始对准方法,其特征在于,强跟踪滤波器为:k时刻的时间更新:

预测协方差矩阵Pk/k-1,

k时刻增益矩阵Kk为:

k时刻的残差序列ξk为:

k-1时刻的状态 更新为k时刻的k时刻的协方差矩阵Pk更新:

Pk=Pk/k-1-KkHkPk/k-1其中,Fk/k-1为k-1时刻的状态转移矩阵, 为k-1时刻的状态变量,其中Qk为白噪声,Rk为量测噪声,Gk为隶属度函数,Pk-1为k-1时刻的协方差矩阵。

4.根据权利要求3所述的大失准角下SINS初始对准方法,其特征在于,渐消矩阵为:其中,pi,i为协方差矩阵Pk在k时刻的协方差矩阵里的因子,κi为比例因子,τk为渐消因子。

5.根据权利要求4所述的大失准角下SINS初始对准方法,其特征在于,隶属度函数为:其中,ξk为残差序列,λk为渐消矩阵,k为第k时刻,ρ为门限值,ρmin表示门限值的最小值。

6.根据权利要求5所述的大失准角下SINS初始对准方法,其特征在于,模糊控制规则为:如果新息的序列残差与期望残差的比值大于门限值ρmin,则认为失准角过大ρ值不变;

如果新息的序列残差与期望残差的比值小于门限值ρmin,则认为失准角满足精度准要求,则令ρ=ρmin。