matlab仿真|基于 CW 方程与解析解法的卫星状态解算方法

一、基于 CW 方程的卫星动力学原理

为描述己方卫星与敌方卫星之间的运动和相对运动，引入三个坐标系。在空间动力学研究中，惯性坐标系$N$，也被称作地心赤道惯性坐标系，是一个以地球质心为原点的参考框架，其中$X$轴指向春分点，$Z$轴垂直于赤道平面指向北极方向，而$Y$轴则按右手法则垂直于$X$轴和$Z$轴确定。参考卫星轨道坐标系（记为$C$）的原点同样位于参考卫星的质心，其$x$轴指向从地心到参考卫星的位置矢量，$y$轴在参考卫星轨道平面内并与$x$轴垂直，指向参考卫星运动的前方，$z$轴则垂直于轨道平面，与$x$轴和$y$轴构成右手坐标系。

基本假设包括：地球被视为均质的中心引力场球体，地球和卫星均被简化为质点，且敌方卫星不进行主动控制。这些假设有助于简化问题并使得动力学分析更为可行。

因为惯性坐标系下的位置速度信息都较大（1e7 米起）不利于项目展示或算法计算，因此在参考卫星坐标系中建立相对运动模型（1e5 米起），以方便展示与算法计算。简化后的 C-W 方程如下（简化条件需要自行阅读论文）：

$$\{\begin{array}{l}\ddot{x}-2n\dot{y}-3n^{2}x=a_x\\ \ddot{y}+2n\dot{x}=a_y\\ \ddot{z}+n^{2}z=a_z\end{array}$$

若我们将此参考卫星作为原点，此 C-W 方程则表示的是卫星在参考卫星坐标系下相对于参考卫星的位置，但因为参考卫星为原点因此此公式计算的位置、速度和加速度均为参考卫星坐标系下的绝对位置和状态。其中$n$为参考卫星的平均角速度计算方法如下：

$$n=\sqrt{\frac{\mu }{r^3}}$$

其中$\mu$为地球引力常数，$r$为参考卫星轨道半径，$a_x、a_y、a_z$为对卫星产生的控制加速度。

根据状态转移方程求解能够得到以下公式和矩阵（如有不对请参考代码）：

X i （ t ） = ϕ ( τ ) X i ( t 0 ) + Ψ ( τ ) a