[发明专利]一种基于曲线坐标的无源探测非合作目标定轨方法

权利要求书

1.一种基于曲线坐标的无源探测非合作目标定轨方法，其特征在于，包括主星的状态信息和从星相对于主星的测量角，还包括以下步骤：

步骤1，根据主星与从星的相对状态建立柱面坐标系下的相对轨道运动动力学模型，并由动力学模型建立视线角测量模型，由视线角测量模型得到从星关于主星的初始相对状态的相对角度的真实值α和β，以及测量值z视线角测量模型；

步骤2，根据所述相对轨道运动动力学方程对主星、从星间的相对轨道进行演化，得到用初始相对状态的柱面坐标来表示t时刻的状态转移矩阵；

步骤3，引入微分进化算法设计寻优函数，找到最优初始状态，完成航天器仅测角初始相对轨道确定；

步骤4，采用平方根容积卡尔曼滤波对确定后的初始相对轨道的状态进行实时估计，完成航天器仅测角相对导航。

2.根据权利要求1所述的基于曲线坐标的无源探测非合作目标定轨方法，其特征在于，所述步骤1具体为：

步骤1.1，将主星与从星的相对状态设为：，其中，，为从星相对于主星的柱面坐标，下标d代表从星， c代表主星，分别为关于时间的导数；

步骤1.2，根据相对状态建立柱面坐标系下的相对动力学模型：

（1）

（2）

（3）

其中，分别为关于时间的二次导数，下标rel表示为从星相对于主星，μ为地球引力常数，下标c表示为主星， t为t时刻 ；

步骤1.3，根据相对状态的几何关系建立视线角测量模型：

（4）

（5）

其中，α和β为主星、从星相对角度的真实值，z为测量值，ρ、θ为状态量，下标d为主星和从星在主星轨道平面上的投影的距离，下标rel为从星相对于主星，下标c为主星；

步骤1.4，最终建立关于α、β测量方程模型：

，，（6）

其中， v_θ、w_θ为测量噪声。

3. 根据权利要求2所述的基于曲线坐标的无源探测非合作目标定轨方法，其特征在于，所述步骤2中相对轨道状态的演化采用如下状态转移公式：

X（t）=Φ（t）X（0） （7）

其中，X（t）为由t时刻的相对状态构成的六维列向量，Φ（t）为柱面坐标系下相对运动动力学模型初始时刻到t时刻的状态转移矩阵，X（0）为初始相对状态。

4.根据权利要求3所述的基于曲线坐标的无源探测非合作目标定轨方法，其特征在于，所述步骤3中，寻优函数设计如下：

将步骤1.4的测量方程中的ρ_rel、θ_rel、z_rel由、、代替，得到如下形式：

（8）

（9）

将估计值X₀和任意时刻t代入等式左侧，结果和0作比较以判断估计值X₀的优劣，以找到满足测量方程和动力学方程的初始相对状态。