航天器光学测量指向修正导航定位方法

摘要: 本发明涉及一种航天器光学测量指向修正导航定位方法,属于深空探测。背景技术:1、随着深空探测、在轨服务、星座组网等空间任务的日益复杂与多样化,航天器对高精度、高自...
航天器光学测量指向修正导航定位方法

本发明涉及一种航天器光学测量指向修正导航定位方法,属于深空探测。

背景技术:

1、随着深空探测、在轨服务、星座组网等空间任务的日益复杂与多样化,航天器对高精度、高自主性的导航能力提出了更高的需求。基于光学敏感器的天文导航方法具有信息源丰富、无累积误差等优点,然而在实际工程应用中,光学测量系统的系统性误差会引起导航信息误差,影响定位精度。

2、现有的星敏感器光学测量误差修正方法主要包括以下几种:1)对光学敏感器进行严格的地面标定,事先消除大部分系统误差,但发射过程中的力学环境、在轨的热真空环境变化都可能导致标定参数发生漂移;2)航天器通过特定机动,使星敏感器观测特定天区或对已知目标进行连续观测,从而解算误差参数,该方法依赖精确机动、消耗燃料和时间,且无法频繁进行,难以实现实时误差抑制;3)在导航滤波器中将测量误差作为状态变量之一与其他导航参数一同估计,该方法由于维度增加可能导致可观测性弱,收敛速度慢且估计精度易受初始值影响等问题,修正效果不理想。

技术实现思路

1、为了解决现有修正方法修正效果不理想,导致定位精度差的问题  精度差导致导航定位不准确的问题,本发明目的是提供一种航天器光学测量指向修正导航定位方法,该方法基于星敏感器拍摄星图中包含的背景恒星与目标卫星,从图像中获取恒星星光矢量信息,基于恒星星光矢量信息和星表数据,得到恒星视线矢量观测模型,将姿态矩阵和测量误差同时作为优化变量,利用最小二乘估计原理得到精确姿态矩阵和测量误差估计值;针对星敏感器光轴指向误差引起导航估计精度下降的问题,基于得到的姿态矩阵和测量误差估计值,修正目标卫星视线矢量信息,构建高精度目标卫星视线矢量观测模型,通过ekf算法对航天器状态进行实时估计,得到高精度的定位测速结果;在测量误差修正及导航状态估计模型,设计观测目标优化选取方法,构造最大熵减优化指标,结合ekf算法推导优化指标解析形式,筛选信息增益最大的导航观测目标,提升航天器状态估计精度。

2、本发明的目的是通过下述技术方案实现的。

3、本发明公开的航天器光学测量指向修正导航定位方法,包括如下步骤:

4、步骤一、星敏感器拍摄星图中包含背景恒星与目标卫星,从图像中获取恒星星光矢量信息;基于恒星星光矢量信息和星表数据,得到恒星视线矢量观测模型,将姿态矩阵和测量误差同时作为优化变量,利用最小二乘估计原理得到精确姿态矩阵和测量误差估计值。

5、由小孔成像原理得到恒星位置在星敏感器成像平面上的投影坐标与星敏感器本体系下的恒星视线单位矢量之间的关系:

6、

7、式中表示星敏感器相机的焦距;

8、由星表数据检索恒星的赤经赤纬,得到地心惯性系eci下的恒星视线单位矢量:

9、

10、受空间热环境变化影响,星敏感器的本体结构和安装结构存在热弹性形变,使得测量数据呈现周期性波动,即姿态低频误差;因此需要在考虑姿态低频误差的情况下,建立恒星视线矢量观测模型:

11、

12、其中表示恒星视线方向矢量的观测值,即存在测量误差的情况下星敏感器实际获取的恒星视线方向矢量,c表示地心惯性坐标系到星敏感器本体坐标系之间的方向余弦矩阵,即姿态矩阵,d为星敏感器测量误差。

13、星敏感器获取的单帧星图中通常包含多颗恒星的视线方向矢量信息,令第i颗恒星在星敏感器本体系下的视线方向矢量观测值为,在地心惯性系下的视线方向矢量为,则有

14、

15、基于恒星视线矢量观测模型和最小二乘估计原理,给出以下损失函数:

16、

17、其中为权重系数,表示欧几里得范数;为星敏感器给出的恒星视线方向矢量数目,构造联合估计最小二乘问题为:

18、

19、式(6)将姿态矩阵和测量误差同时作为优化变量,通过迭代算法最小化观测残差,从而实现联合最优估计,得到精确姿态矩阵和测量误差估计值。

20、步骤二、基于步骤一得到的姿态矩阵和测量误差估计值,修正目标卫星视线矢量信息,构建高精度目标卫星视线矢量观测模型,通过ekf算法对航天器状态进行实时估计,得到高精度的定位测速结果。

21、将状态量构造为航天器在地心惯性系下的位置矢量和速度矢量的组合:

22、

23、其中

24、

25、基于航天器轨道动力学模型,建立状态方程:

26、

27、其中表示对状态量取导数,为系统状态噪声,即零均值高斯白噪声,其方差为;

28、根据ekf滤波算法,通过式(10)进行系统状态的一步预测:

29、

30、其中为系统状态的一步预测结果,表示k-1时刻系统状态的估计结果,为积分变量。

31、对状态方程进行线性化处理得到状态转移矩阵:

32、

33、其中,表示6维单位矩阵,为采样步长,f由下式计算得到:

34、

35、表示加速度对位置的偏导。

36、由ekf滤波算法进一步计算一步预测误差协方差矩阵:

37、

38、其中为上一时刻的估计误差协方差矩阵,为状态噪声协方差矩阵, 由下式计算得到:

39、

40、基于步骤一,构建高精度目标卫星视线矢量观测模型。以时刻目标卫星视线矢量在星敏感器成像平面的投影坐标为导航观测量,基于步骤一得到的测量误差估计值对导航观测量进行修正,修正后的观测量为:

41、

42、其中为测量误差,通过下式计算得到:

43、

44、式中、、为步骤一中得到的测量误差估计值的各分量,则观测方程为:

45、

46、其中,为随机噪声,观测函数由下式得到:

47、

48、其中,为目标卫星视线矢量在星敏感器成像平面的投影坐标的预测值,即观测预测值,、、为航天器在地心惯性坐标系下的位置矢量的各分量,、、为空间目标在地心惯性坐标系下的位置矢量的各分量,由卫星星历获得。为步骤一得到的精确姿态矩阵估计值的分量;计算观测函数的雅各比矩阵得到观测矩阵:

49、

50、

51、由ekf算法,滤波增益为:

52、

53、其中为测量噪声协方差矩阵,结合观测信息对状态一步预测进行修正,修正后的估计结果为:

54、

55、估计误差协方差矩阵为:

56、

57、式中表示单位矩阵,综上,通过对光学测量指向误差进行修正,得到高精度观测模型,基于非线性滤波算法进行状态估计,能够得到高精度测速定位结果。

58、步骤三、基于步骤二建立的测量误差修正及导航状态估计模型,设计观测目标优化选取方法,构造最大熵减优化指标,结合ekf算法推导优化指标解析形式,筛选信息增益最大的导航观测目标,提升航天器状态估计精度,得到高精度航天器状态估计结果。

59、系统状态的不确定性可由其信息熵来描述:

60、

61、其中,x表示系统状态,x为系统状态的具体取值,表示系统状态的概率函数,则引入目标卫星视线方向观测信息后状态向量的信息熵表示为:

62、

63、其中z表示导航观测信息,表示引入目标卫星视线方向观测信息后状态向量的概率函数。

64、将优化指标定义为引入目标卫星视线方向观测信息前后,状态向量的信息熵之差;优化指标表示为

65、

66、对于满足高斯分布的状态量,信息熵的具体计算方式为:

67、

68、其中n为随机变量的维度;基于此,将优化指标改写为:

69、

70、和分别为引入目标卫星视线方向观测信息前后的状态估计误差协方差矩阵,其中即为,即为;

71、后验状态估计误差协方差的等价计算公式为:

72、

73、将(29)代入式(28)中得:

74、

75、通过最大化该优化指标,选取最优的目标卫星,以实现导航精度的提升;

76、还包括步骤四、利用步骤三得到的高精度航天器状态估计结果,实现航天器实时轨道规划与修正。

77、有益效果:

78、1、本发明公开的航天器光学测量指向修正导航定位方法,星敏感器拍摄星图中包含背景恒星与目标卫星,从图像中获取恒星星光矢量信息;基于恒星星光矢量信息和星表数据,得到恒星视线矢量观测模型,将姿态矩阵和测量误差同时作为优化变量,利用最小二乘估计原理得到精确姿态矩阵和测量误差估计值,提高星敏感器光轴指向测量精度,为高精度导航提供可靠姿态信息与指向修正信息。

79、2、本发明公开的航天器光学测量指向修正导航定位方法,针对星敏感器光轴指向误差引起导航估计精度下降的问题,基于步骤一得到的姿态矩阵和测量误差估计值,修正目标卫星视线矢量信息,构建高精度目标卫星视线矢量观测模型,通过ekf算法对航天器状态进行实时估计,得到高精度的定位测速结果。

80、3、本发明公开的航天器光学测量指向修正导航定位方法,基于步骤二建立的测量误差修正及导航状态估计框架,设计观测目标优化选取方法,构造最大熵减优化指标,结合ekf算法推导优化指标解析形式,筛选信息增益最大的导航观测目标,提升航天器状态估计精度。