基于序列图像状态表达的航天器自主导航鲁棒滤波算法
摘要:
本发明涉及基于序列图像状态表达的航天器自主导航鲁棒滤波算法,属于自主导航技术领域;步骤一、构建空间非合作目标自主相对导航系统状态方程;步骤二、构建单目相机序列图像测量方程;步骤三、构建基于序列图像的状态表达模型,进而利用三角函数公式将测量值和测量误差值分离并根据测量误差分布获得测量噪声期望矩阵εk;步骤四、获得k时刻一步状态预测值#imgabs0#和k时刻一步预测协方差矩阵Pk|k‑1;步骤五、计算得到状态估计的最优增益Kk;步骤六、计算得到k时刻的状态估计值xk|k和状态估计协方差矩阵Pk|k;本发明可以提高对系统状态初值不准确的抗干扰性,从而获得更高精度的状态估计结果。
0/0