[发明专利]一种基于动态脉冲累积窗口的X射线脉冲星导航方法有效
申请号: | 201710632232.2 | 申请日: | 2017-07-28 |
公开(公告)号: | CN107328409B | 公开(公告)日: | 2019-01-25 |
发明(设计)人: | 石恒;熊凯;徐超;魏春岭;王磊;梅志武 | 申请(专利权)人: | 北京控制工程研究所 |
主分类号: | G01C21/02 | 分类号: | G01C21/02 |
代理公司: | 中国航天科技专利中心 11009 | 代理人: | 胡健男 |
地址: | 100080 *** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 基于 动态 脉冲 累积 窗口 射线 导航 方法 | ||
1.一种基于动态脉冲累积窗口的X射线脉冲星导航方法,其特征在于包括:初始化阶段、状态预测阶段、光子测量处理阶段、脉冲轮廓动态累积阶段、TDOA求解阶段、滤波估计阶段,
所述初始化阶段步骤如下:
(1)设置光子测量参数,包括:当前累积初始时刻t0;发出光子的脉冲星的信号周期Tp,简称为脉冲信号周期,Tp为正数;每个脉冲周期内的时间窗格数Nb,Nb为正整数,设置轮廓累积参数,包括:累积脉冲周期数Np,Np为正整数;
(2)定义状态变量x:
x=[r v]T
其中r=[rx ry rz]和v=[vx vy vz]分别为航天器在惯性坐标系中的位置矢量、速度矢量,rx表示r在惯性坐标系x轴上的分量,ry表示r在惯性坐标系y轴的分量,rz表示r在惯性坐标系z轴的分量;
设置状态变量x的估计初值包括航天器在惯性坐标系中位置先验估计值r0、速度先验估计值v0;然后设置其他导航滤波参数,包括:对应的协方差矩阵P0,P0为6阶正定对角矩阵;对应的系统噪声协方差矩阵Q0,Q0为6阶正定对角矩阵;对应的测量噪声协方差矩阵初值R0,R0为大于零的标量;
(3)设定当前滤波计算步数为k,k作为下标表示变量在第k步的对应值,k的初值为1,记当前计算时刻为t,记滤波计算步长为Tf,Tf为正数;
(4)在t∈[t0,t0+Np·Tp]时间区间内,按顺序标记X射线脉冲星的脉冲信号周期,脉冲信号周期序号记为j,j=1,2,...,Np;同时,对每个脉冲信号周期,按顺序划分紧邻不重叠的时间窗格,每个时间窗格的宽度为Tp/Nb,时间窗格序号为i,i=1,2,...,Nb;定义Nb×Np维计数器数组C,C中的元素C(i,j)表示序号为j的脉冲周期中,序号为i的时间窗格内的光子累积计数,C(i,j)取值范围为非负整数,初值为0;
所述状态预测阶段步骤如下:
(5)根据第k-1步的状态估计值和误差方差阵Pk-1,以及离散化卫星轨道动力学模型Fk,预测当前,即第k步的状态变量和相应的误差方差阵Pk|k-1,具体公式为:
其中,下标“k|k-1”表示根据第k-1步信息预测得到的第k步信息,若k=1,和Pk-1的初值分别为状态估计初值状态估计协方差矩阵初值P0;
计算离散化卫星轨道动力学模型Fk;
离散状态转移矩阵Dk为:
所述光子测量处理阶段步骤如下:
对每一个到达航天器的光子,都执行步骤(a1)~步骤(a4);
(a1)利用X射线导航敏感器TOA测量值,记录第p个光子到达航天器的时间tp,sc,p为光子的序号,初值为0;
(a2)根据步骤(5)得出的和步骤(a1)获得的tp,sc,进行光子TOA时间转换,得到的第p个光子到达太阳系质心的时间时间转换方程如下所示:
其中,的取值为即中的位置矢量部分;是矢量的大小;c表示真空光速;矢量n是发出光子的脉冲星视线方向单位矢量,由外部提供;D0是太阳系质心到脉冲星的距离,由外部提供;μs表示太阳引力场系数,由外部提供;b是太阳系质心相对于太阳系中心的位置矢量,由外部提供;b是b矢量的大小;
(a3)计算对应的归一化相位值mod(·)表示取余运算:
计算归一化相位对应的时间窗格序号ip,int(·)表示四舍五入取整运算:
以及当前光子对应的脉冲周期序号jp:
然后,设置计数器C(ip,jp)加1;C(ip,jp)的初值为0
(a4)存储C(i,j),i=1,2,...,Nb,j=1,2,...,Np,k加1后继续执行步骤(a1)~(a4)即对下一个观测到的光子进行处理;
所述脉冲轮廓动态累积阶段步骤如下:
(6)定义X射线脉冲星的观测累积时长toc为从t0开始到当前时刻t的时长,即
toc=t-t0
若toc=Np·Tp,则进入步骤(7),否则返回步骤(5);
(7)根据步骤(a4)的[t0,t0+Np·Tp]时间区间内的光子计数数据C(i,j),得到观测脉冲速率函数由Nb个按序排列的非负整数组成;
所述TDOA求解阶段步骤如下:
(8)采用信号相位比较方法,计算观测脉冲速率函数与标准脉冲速率函数λ0(t)的相位差ΔΦ;其中,标准脉冲速率函数表示t0为起始时刻的脉冲周期内太阳系质心处观测到的脉冲星标准计数序列,具体取值取决于所观测的脉冲星,通过外部提供,为已知量;要求标准脉冲速率函数的数据格式与观测脉冲速率函数的数据步长、数据长度保持一致,即由Nb个按序排列的非负整数组成;
(9)计算观测脉冲速率函数与标准脉冲速率函数λ0(t)的对应的到达时间差TDOA;
所述滤波估计阶段步骤如下:
(10)计算当前状态变量的估计值及对应的状态估计协方差矩阵Pk,具体公式为:
其中,观测量yk为步骤(9)给出的TDOA值;Kk表示滤波增益矩阵;为测量函数;
观测方程雅克比矩阵Hk的计算方法为:
Hk=[H11 01×3]
(11)将步骤(10)得到的状态变量估计值作为导航输出,同时判定若满足设定的计算停止条件,则结束计算,即完成导航计算;否则,设置窗口移动步长tm,tm为正数且大于滤波计算步长Tf,用t0+tm替换t0,返回步骤(6),根据窗口长度需要,重新设置累积周期数Np。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京控制工程研究所,未经北京控制工程研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201710632232.2/1.html,转载请声明来源钻瓜专利网。
- 上一篇:导盲机器狗
- 下一篇:基于加速度的矿井下灾害报警系统