一种适用于旋转炮弹的动态环路跟踪方法及装置制造方法及图纸

本发明专利技术公开了一种适用于旋转炮弹的动态环路跟踪方法及装置。本发明专利技术在接收机环路中增加转速估计单元，并利用环路跟踪原始信息进行卡尔曼滤波，获得卫星入射方向的俯仰角和方位角，再结合在地面估计出的相位中心偏差，计算得到因天线相位中心偏差导致的多普勒误差估计值，补偿到跟踪环路的码频率和载波频率中，以实现对旋转调制的误差补偿。本发明专利技术地面可操作性强，算法应用简单，无复杂或运算量巨大的算式，实时性和运算量方面都可保证在DSP或FPGA硬件平台上的算法编程实现，即易于工程实现。现。现。

【技术实现步骤摘要】
一种适用于旋转炮弹的动态环路跟踪方法及装置


[0001]本专利技术属于卫星导航信息处理领域，涉及一种适用于旋转炮弹的卫星导航接收机动态环路跟踪的方法。

技术介绍

[0002]卫星导航接收机因体积小、成本低已成为旋转炮弹常用的导航设备。炮弹在飞行过程中，存在弹体轴向和切向运动叠加。传统卫星导航接收机应用于炮弹时，面临诸多问题，主要问题如下：1)弹体旋转引起的信号遮挡问题；2)旋转引起的切向运动导致测速误差问题；3)旋转时的动态适应性问题；4)对信号相位的旋转调制效应。
[0003]目前，解决问题1)～2)的主要技术手段是双天线合成方法，即采用对称安装于弹体表面的两个共形天线，合路形成一个垂直弹轴的全向方向图，使得天线收星不会受旋转影响。同时，将两个共形天线单元并馈，使得天线相位中心设计在弹轴上，理论上消除了切向运动，但实际上，共形天线设计、安装误差、弹体天线安装面公差等因素，共形天线相位中心与弹轴会存在偏差，偏差导致的切向运动难以消除。解决问题3)的主要方法是采用锁频环辅助锁相环设计，通过调整滤波器带宽参数来适应高动态性能，或将旋转调制效应误差笼统地视为噪声，采用纯锁频环设计。前者能够克服轴向大动态导致的环路失锁，同时保证了一定的跟踪精度，但其易受弹体转速影响，环路稳定性与适应性较差；后者环路结构简单、动态适应性较好，但跟踪精度较差。解决问题4)的主要方法是通过地磁传感器或单天线收星预测弹体的转速，并进行旋转调制效应误差补偿，但地磁测量使用制约因素较多，使用维护过程复杂，单天线收星转速估计算法复杂，受制约条件较多。
[0004]针对旋转高动态弹体应用场景，需要同时解决上述四个问题，以提高环路跟踪稳定性和跟踪精度。

技术实现思路

[0005]本专利技术的目的是提供一种跟踪稳定性好、测速精度高、适用于旋转炮弹的卫星导航接收机动态环路跟踪的方法及装置。
[0006]为解决上述技术问题，本专利技术提供了一种适用于旋转炮弹的动态环路跟踪方法，采取技术方案包括如下步骤：
[0007]步骤1.构建偏差激励和基准伪距环境，对固定俯仰角下的误差输出进行幅值估计，实现在地面对炮弹天线相位中心偏差的估计；
[0008]步骤2.获取短时内的弹体转速估计值；
[0009]步骤3.结合在地面估计出的相位中心偏差、弹体转速值，与卫星入射方向的俯仰角和方位角，计算多普勒误差估计值；
[0010]步骤4.将步骤3获得的多普勒误差估计值补偿到跟踪环路的码频率和载波频率中，实现对旋转调制的误差补偿。
[0011]根据本专利技术的又一方面，提供了一种适用于旋转炮弹的动态环路跟踪装置，采取
技术方案如下：
[0012]所述跟踪装置包括相位中心偏差估计模块、弹体转速估计模块、多普勒误差估计模块和误差补偿补偿模块。
[0013]所述相位中心偏差估计模块基于构建的偏差激励和基准伪距环境，对固定俯仰角下的误差输出进行幅值估计，实现在地面对炮弹天线相位中心偏差的估计；
[0014]所述弹体转速估计模块用于获取短时内的弹体转速估计值；
[0015]所述多普勒误差估计模块利用卡尔曼滤波解算出的卫星入射方向的俯仰角和方位角，结合在地面估计出的相位中心偏差以及弹体转速值，计算出多普勒误差估计值；
[0016]所述误差补偿补偿模块将获得的多普勒误差估计值补偿到跟踪环路的码频率和载波频率中，实现对旋转调制的误差补偿。
[0017]本专利技术技术解决方案是通过人为构造偏差激励条件与基准伪距条件，对固定俯仰角下的误差输出进行幅值估计，从而实现在地面对炮弹天线相位中心偏差的估计；在已知天线相位中心偏差的前提下，利用载波相位鉴别器和码相位鉴别器输出作为卡尔曼滤波器的量测，利用接收机位置、速度和星历作为载波和码NCO预测，经滤波后计算出卫星入射方向的俯仰角和方位角。同时，构造弹体转速估计模块，结合在地面估计出的相位中心偏差，并结合转速估计值与卫星入射方向的俯仰角和方位角，从而计算出因天线相位中心偏差引起的多普勒误差估计值，用于多普勒测量值的补偿，从而有效消除了旋转导致的多普勒频率误差，实现接收机动态环路的稳定跟踪，提高了旋转条件下接收机的测速精度。
[0018]本专利技术的优点是利用天线相位中心偏差引起的旋转调制误差与卫星信号入射俯仰角和方位角的关系，并采用地面相位中心偏差估计的方式，获取多普勒误差，补偿到跟踪环路中，能够解决旋转时测速误差大的问题。创新性地提出了通过构造偏差激励条件与基准伪距条件，对固定俯仰角下的误差输出进行幅值估计，进而实现在地面进行天线相位中心估计的方法；创新性地提出了采用环路原始参数解算出卫星信号入射角，并结合弹体转速估计，对计算出的多普勒误差进行环路补偿的方法，从根本上突破了采用纯锁频环进行笼统跟踪的方法，有效提升了锁频环辅助锁相环的跟踪精度。
[0019]本专利技术考虑了利用环路原始信息和星历、位置等信息进行卡尔曼滤波，利用滤波计算的入射角、估计的转速、地面估计的相位中心偏差等信息，计算多普勒并进行环路补偿。地面可操作性强，算法应用简单，无复杂或运算量巨大的算式，实时性和运算量方面都可保证在DSP或FPGA硬件平台上的算法编程实现，即易于工程实现。
附图说明
[0020]图1是本专利技术提供的一种适用于旋转炮弹的卫星导航接收机动态环路跟踪的方法原理框图；
[0021]图2是炮弹旋转运动坐标系的示意图；
具体实施方式
[0022]下面结合附图和实施例对本专利技术进一步说明。
[0023]图1是本专利技术所提出的一种适用于旋转炮弹的卫星导航接收机动态环路跟踪的方法原理框图。图1中，引入了旋转调制导致的多普勒误差估计环节，使环路进行多普勒误差
修正，分为地面偏差估计阶段和飞行实时修正两个阶段实施。具体方法如下：
[0024]地面偏差估计阶段是在伪距基准已知的条件下，利用偏差激励方法对弹体天线相位中心的偏差l0进行估计，用以为飞行实时修正提供参数要素。天线相位中心偏差主要是由安装误差、安装面公差、天线设计制造误差、与时间相关的材料形变误差等，其中，安装误差、安装面公差、天线设计制造误差等占大部分，而与材料形变误差与时间相关。因此，为了维护和使用方便，地面阶段的偏差估计可在炮弹出厂后只进行一次，后续是否再需开展，可根据炮弹贮存时间灵活确定。
[0025]飞行实时修正阶段是利用卡尔曼滤波解算出的卫星入射信号的俯仰角θ、方位角ψ和弹体转速n估计值，结合在地面估计出的相位中心偏差l0，从而计算出因天线相位中心偏差引起的多普勒误差估计值Δf
d
。将多普勒误差Δf
d
引入到跟踪环路的码NCO和载波NCO中，实现旋转调制的频率误差补偿。
[0026]在本专利技术提供的一种实施例中，所述天线相位中心偏差的地面估计包括如下步骤：
[0027]步骤S1、偏差激励和基准伪距环境构建
[0028]将旋转炮弹接收机天线随旋转工装固定于已标定的基准点处，待卫星接收机稳定收星定位后，利用某卫星(设本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种适用于旋转炮弹的动态环路跟踪方法，其特征在于，包括如下步骤：步骤1.构建偏差激励和基准伪距环境，对固定俯仰角下的误差输出进行幅值估计，实现在地面对炮弹天线相位中心偏差的估计；步骤2.获取短时内的弹体转速估计值；步骤3.利用卡尔曼滤波解算出的卫星入射方向的俯仰角和方位角，结合在地面估计出的相位中心偏差以及弹体转速值，计算出多普勒误差估计值；步骤4.将步骤3获得的多普勒误差估计值补偿到跟踪环路的码频率和载波频率中，实现对旋转调制的误差补偿。2.根据权利要求1所述的一种适用于旋转炮弹的动态环路跟踪方法，其特征在于，步骤1所述炮弹天线相位中心偏差的估计方法如下：将旋转炮弹接收机天线随旋转工装固定于已标定的基准点处；待卫星接收机稳定收星定位后，开启工装旋转，保持天线于已标定的基准点处，时间不超过2分钟，采集每颗参与定位卫星的方位角ψ
i
和俯仰角θ
i
，得到各个卫星的测距误差ΔL
i
；对采集的各颗卫星的测距误差ΔL
i
进行幅值检测，经极值处理后，取均值和均方根l
rms
，若均方根l
rms
小于门限l
thred
，则认为此次偏差激励有效，进行有效偏差提取，即提取有效偏差为否则，认为此次偏差激励失败，不提取。3.根据权利要求1所述的一种适用于旋转炮弹的动态环路跟踪方法，其特征在于，所述步骤2对跟踪环路I支路的积分累加输出的离散数字量进行滑动FFT频谱分析，得到短时间内的频率，即旋转转速n。4.根据权利要求3所述的一种适用于旋转炮弹的动态环路跟踪方法，其特征在于，滑动时间窗口的取值为4ms～10ms。5.根据权利要求1所述的一种适用于旋转炮弹的动态环路跟踪方法，其特征在于，步骤3所述多普勒误差估计值为：式中，l0为天线相位中心偏移量，n为弹体的旋转转速，ψ为卫星入射信号的初始方位角，θ为卫星入射信号的俯仰角。6.根据权利要求1所述的一种适用于旋转炮弹的动态环路跟踪方法，其特征在于，所述步骤4对多普勒误差补偿值Δf
d
进行补偿前的限幅处理，只有多普勒误差的幅度不大于限定门限，才进行码跟踪环和载波跟踪环的多普勒误差补偿处理，限幅处理的幅度限定原则是：1)转速按照理论最大转速的1.2倍；2)天线相位中心最大偏移量为炮弹弹径的5
‰
...

【专利技术属性】
技术研发人员：王勋，孟为茹，韩舒文，孙艺宁，高亚豪，洪诗聘，祖秉法，庄树峰，刘璞，
申请(专利权)人：北京自动化控制设备研究所，
类型：发明
国别省市：