动中通卫星通信系统级联卡尔曼滤波载体姿态估计方法
【技术领域】
[0001] 本发明属于卫星通信系统天线波束控制技术领域，涉及一种动中通卫星通信系统 级联卡尔曼滤波载体姿态估计方法。
【背景技术】
[0002] 古往今来，信息对于战争的重要性人所共知。无论是烽火台、信号旗、消息树，还是 雷达站、无线电、GPS/北斗，尽管手段不一，但是目的相同，那就是为指战员们"通风报信"。 随着科学技术的发展，高射速武器以及远程精确武器不断出现，一方面要求作战部队分散 部署、灵活机动来提高生存能力；另一方面，武器系统产生了分化，出现了专门负责态势感 知的传感器平台、专门负责打击的武器平台以及兼有传感器和武器功能的作战平台。武器 系统的分化与作战部队的分散、机动成为一对不可调和的矛盾，如何在机动、分散部署的同 时遂行有效作战成为军事理论和武器发展过程中亟需解决的新问题。解决该问题的核心就 在于建立联接传感器平台与武器平台的军事信息与通信网络，军事需求的强力驱动催生了 动中通的诞生和发展。
[0003] 动中通就是利用固定业务卫星资源和安装于载体上的天线系统，在静止和运动状 态下建立和保持载体与目标卫星之间卫星链路的宽带移动卫星通信系统。其实质就是在运 动状态下，满足和保持FSS频段卫星通信的使用条件：时刻保持方位、俯仰、极化三维对准 卫星。这对于安装在移动载体上的卫星通信系统来说是一个极大的挑战。测控系统是车载 卫星动中通系统终端保持与目标卫星之间通信链路通畅的关键，决定了整个系统的性能。 但是测控系统往往需要昂贵的姿态航向参考系统（AHRS)来得到载体姿态，进而补偿天线 由于载体姿态变化引起的扰动，始终保持与目标卫星的三维对准。这些高精度的AHRS造价 不菲，动辄数十万甚至百万的造价往往占到整个卫星动中通系统成本的60~70%，因此， 寻找低廉而有效的AHRS替代产品，已经成为当前动中通系统的研究热点。
[0004] 目前，应用于动中通低成本姿态估计的算法有传感器直接融合算法，互补滤波算 法等。多传感器直接融合姿态估计算法易受机动加速度和侧滑角等外界因素干扰、姿态估 计误差难以完全校正，姿态估计的精度受限。互补滤波是一个常增益卡尔曼滤波器，姿态估 计精度与基于非线性滤波器的传感器融合算法相近。GPS/INS组合导航算法融合了 GPS和 INS的信息，提供了更为精确和可靠的导航信息，已经成为导航领域的标准算法以及互补信 息融合的典范，广泛应用于各种需要可靠的位置、速度以及姿态信息的导航、制导与控制系 统中。采用成本低、可大批量生产的微机械传感器作为测控系统的硬件测量部分，利用GPS 作为辅助传感器，基于组合导航实现姿态估计可以克服传感器直接融合算法易受机动加速 度和侧滑角等外界因素干扰、估计误差大且难以校正的问题，在姿态估计领域具有良好的 应用前景。
【发明内容】
[0005] 本发明的目的在于克服上述现有技术的缺点，提供了一种动中通卫星通信系统级 联卡尔曼滤波载体姿态估计方法，该方法可以实现天线与卫星的准确对准，并且成本低。
[0006] 为达到上述目的，本发明所述的动中通卫星通信系统级联卡尔曼滤波载体姿态估 计方法包括以下步骤：
[0007] 包括以下步骤：
[0008] 1)主控制器设定组合导航姿态估计算法，得航向角单独估计的卡尔曼滤波系统方 程，然后建立航向角单独估计的卡尔曼滤波量测方程It ni= Φ SPS+v，其中，Itni为航向角单独 估计的卡尔曼滤波量测值，Φμ为单天线GPS测量得到的伪航向角，V为零均值高斯白噪 声；
[0009] 2)通过航向角陀螺去除航向角单独估计中的侧滑角，则卡尔曼滤波器中伪航向角 观测噪声方差设定倡
，其中，μ为加权开关，
，<#为单天线 GPS航向角的实际测量方差，ωζ(τ)为航向角陀螺测量值，K为转弯判断阈值；
[0010] 3)根据卡尔曼滤波器中伪航向角观测噪声方差设定值、加权开关μ、航向角单独 估计的卡尔曼滤波系统方程以及航向角单独估计的卡尔曼滤波量测方程使用扩展卡尔曼 滤波进行姿态解算，得载体的三维姿态角，然后根据载体的三维姿态角控制电机调整天线 波束的指向，使天线对准卫星。
[0011] 步骤1)中主控制器设定组合导航姿态估计算法包括动中通组合导航系统方程建 立、动中通组合导航姿态估计算法观测量设置以及动中通组合导航量测方程建立。
[0012] 动中通组合导航系统方程建立的具体过程为：
[0013] 设将组合导航姿态估计系统的状态量X为载体的位置误差δ r、速度误差δ V和姿 态角误差Φ，即X= [Sr, δ ν，φ]Τ，则动中通组合导航系统方程为：
?其中，《4为i系相对于b系的旋转角速率，Cf为b系到η系的方向余 弦矩阵，及分别为i系相对于e系的旋转角速率、e系相对于η系的旋转角速率、 i系相对于η系的旋转角速率，炉及f η分别为b系和η系下的比力测量值，g η为重力加速 度向量。
[0014] 动中通组合导航姿态估计算法观测量设置的具体操作为：设动中通组合导航姿态 估计算法观测量Z k为微机械陀螺解算的载体的位置r INS和速度V INS分别与单天线GPS输出 的载体的位置Aps和速度V (；ps的差值，即
P
[0015] 动中通组合导航量测方程为：zk= Hkxk+ek，其中，Zk为动中通组合导航量测值，
，I3x3为3X3单位阵，O3x3为3X3零矩阵，e k为量测噪声。
[0016] 本发明具有以下有益效果：
[0017] 本发明所述的动中通卫星通信系统级联卡尔曼滤波载体姿态估计方法在实现天 线与卫星对准时，通过根据卡尔曼滤波器中伪航向角观测噪声方差设定值、加权开关、航向 角单独估计的卡尔曼滤波系统方程以及航向角单独估计的卡尔曼滤波量测方程使用扩展 卡尔曼滤波进行姿态解算，得载体的三维姿态角，然后再根据三维姿态角实现天线对准卫 星。通过航向角陀螺去除航向角单独估计中的侧滑角，提高了天线对准卫星的精度。同时， 航向角的单独解算解决了航向角可观性低对姿态估计精度造成的影响，克服了传感器直接 融合姿态估计算法易受外界因素干扰、估计误差难以校正的缺点，姿态估计精度高，很好地 满足了动中通天线波束指向需求。另外，本发明简便易行，成本低，有效促进了动中通的推 广和应用，能够很好地满足动中通天线波束指向需求。
【附图说明】
[0018] 图1为本发明中动中通卫星通信系统的结构示意图。
【具体实施方式】
[0019] 下面结合附图对本发明做进一步详细描述：
[0