[发明专利]一种基于CW方程的解耦变增益自主相对导航方法

摘要

本发明涉及一种基于CW方程的解耦变增益自主相对导航方法，包括如下步骤：步骤一：建立追踪星轨道直角坐标系，作为相对导航的参考直角坐标系，建立该坐标系下CW方程，作为状态方程；步骤二：将星上雷达直接测量的星间数据转换到参考直角坐标系下，建立观测方程；步骤三：忽略轨道角速度的平方及其高阶项，分别对状态方程和观测方程进行解耦，设计解耦后各轴独立的卡尔曼滤波器，所述的卡尔曼滤波器为建立在参考直角坐标系下的标准线性系统；步骤四：在上述卡尔曼滤波器的基础上设计变增益滤波器，进行各轴相对运动状态估计，完成相对导航设计。