基于三阶锁相环的旋转弹滚转姿态测量方法

杨登红, 李东光, 申强, 曾广裕, 杨瑞伟

(北京理工大学 机电动态控制重点实验室，北京 100081)



基于三阶锁相环的旋转弹滚转姿态测量方法

杨登红, 李东光, 申强, 曾广裕, 杨瑞伟

(北京理工大学 机电动态控制重点实验室，北京 100081)

摘要：为解决低量程陀螺测量旋转弹滚转姿态的问题，在对旋转弹角运动特性进行分析研究的基础上，建立低量程陀螺测量滚转姿态的数学模型，提出基于三阶锁相环和低量程陀螺的旋转弹滚转姿态测量方法。先对三阶锁相环及其特性进行研究，再根据旋转弹角运动特性和低量程陀螺测量信号特性确定三阶锁相环环路滤波参数，并确定基于三阶锁相环和低量程陀螺的旋转弹滚转姿态测量模型，即可根据模型进行锁相跟踪计算得到滚转角速度和滚转姿态。实验结果表明，三阶锁相跟踪环路能对旋转弹滚转信号进行有效跟踪，能够获取滚转角速度和滚转角，且精度较高。

关键词：旋转弹；低量程陀螺；滚转姿态；锁相跟踪；三阶锁相环

通过对旋转弹的角运动特性进行分析发现，以俯仰轴为敏感轴安装的单轴陀螺所敏感的角速度由俯仰、偏航和滚转速率耦合而成，在短时间内，该耦合角速度信号可以看成是以俯仰角速度为幅值、滚转角为相位和滚转角频率为角频率的周期信号与一个幅值远小于俯仰角速度的周期信号之和，总体幅值约等于俯仰角速度、总体角频率约等于滚转角频率且在低量程陀螺测量带宽内，因此可以利用低量程陀螺测量该耦合角速度信号并将其近似为正弦信号进行处理。锁相跟踪是对具有周期特性的信号进行相位跟踪锁定，进而得到信号的频率和相位的算法，锁相跟踪算法对这种短时间内可以近似为周期信号的信号具有良好的跟踪特性。因此，利用锁相跟踪方法提取上述耦合角速度中含有的滚转姿态信息是可行的。因此，本文在对锁相跟踪原理及三阶锁相环特性进行深入研究的基础上，提出利用三阶锁相环对旋转弹滚转角进行跟踪，进而获取滚转姿态的旋转弹滚转姿态测量方法。

1弹体耦合角运动信号特性研究

1.1弹体角运动耦合

图1　单轴陀螺安装位置及敏感轴示意图Fig.1　The installation of single-axis gyroscope

陀螺受到弹体滚转运动和偏航运动的影响，测到的数据受到滚转角速度和偏航角速度的调制，根据旋转弹体坐标系、非旋转弹体坐标系与地面惯性坐标转换关系可得

(1)

1.2耦合参数特性

式(1)可根据三角函数关系改写为

(2)

2三阶锁相跟踪环路研究

三阶锁相环能跟踪频率加加信号，但有恒定的跟踪误差，其跟踪更高阶激励信号将导致发散，会导致跟踪失锁。其特性由其特征频率ωn和阻尼系数ξ决定，若环路所采用的特征频率ωn越高，则其达到稳态所需时间就越少，即较高的ωn能让系统具有相应较快的跟踪性能。若阻尼系数ξ越大，则环路的通带增益显得越为平坦，但是增益幅度在阻带段下降得越慢，环路对噪声的滤波效果越不理想。噪声带宽越窄，则由于越少频率成分的噪声被允许进入环路，因而环路的滤波效果越好，环路对信号的跟踪效果就越精确，若噪声带宽越宽，则环路的噪声性能越差，信号跟踪就越不准确。

因为弹体运动特别是弹体章动会引起弹体角运动的急剧变化，进而引起频率和相位跟踪误差的激烈震荡，所以环路带宽BL能保证适应弹体的这种激烈运动导致的频率和相位的正常波动，以保证环路对信号的持续跟踪；否则，如果BL过小，则由弹体高动态应力所致的频率和相位变化中有用的高频信号成分可能会同噪声一起被滤除，进而破坏信号的真实性，使环路容易发生信号失锁。因此，环路带宽BL是锁相环的一个重要参数，越大的环路带宽使锁相跟踪环路具有满足较强动态运动测试的能力，但也同时降低其噪声性能。

参考文献[10]取三阶锁相跟踪环路的二阶环路滤波器的各参数如下：

a3=1.1,b3=2.4,

上述参数是ξ=0.707时计算得出的，当选定带宽BL，则可以确定ωn的值，即可实现环路滤波器设计。

3弹体滚转姿态跟踪

由于弹丸在全弹道非旋转弹体坐标系俯仰、偏航角速度幅值比较小，在各种气动干扰条件下，传感器测量信号还会产生较多噪声，因此如何从惯性传感器的低信噪比信号中提取出有用信号是本文的关键。将借鉴在数字通信信号处理中普遍采用的锁相跟踪技术，该技术的优点能在信噪比低的条件下实现对信号的跟踪和锁定，提取出滚转姿态数据。

基于以俯仰轴为敏感轴的单轴陀螺所测数据及锁相跟踪算法，设计弹体滚转姿态测量模型。以图1安装方式安装的陀螺敏感到的角速度测量值积分作为A路信号，本地生成转速(NCO)经积分作为本地滚转角，经误差校正后，生成两路相互正交的正弦信号B1和B2作为本地参考信号，分别与A路信号进行相关运算(乘加)，两路相关运算结果C1和C2通过鉴相得到滚转相位误差估计值，经环路滤波器进一步估计后，形成滚转角误差校正值，对本地滚转角进行校正，经过若干次循环后最终可达到对陀螺测量值中所含滚转相位的锁定，再经过误差校正后的滚转姿态接近真实值。为提高滚转姿态估计精度，进一步采用补偿滤波器，根据本地转速对经校正后的滚转角估计值。

图2　基于三阶锁相环和陀螺的滚转姿态信息提取方法Fig.2　Roll attitude solve method based on three phase-locked loops and low-range gyroscope

4补偿滤波器

补偿滤波算法是根据三阶锁相环路稳态误差模型和相关参数估计进行补偿滤波，以提高锁相跟踪输出结果精度。根据锁相跟踪结果误差特性，将补偿滤波分为锁相跟踪稳态常值偏置误差补偿和呈正弦规律变化误差的线性递推最小二乘滤波补偿。

(3)

由于旋转稳定弹的俯仰角速度和偏航角速度变化较小，可以近似为直线，而滚转角速度变化较大，所以在短时间内，假定旋转稳定弹角运动如式(4)所示。

(4)

由式(4)可知

(5)

则将式(5)求导可得

(6)

即

(7)

则由三阶锁相环的稳态输出可得

(8)

根据实际弹道计算出a0、a1、d3和c1的值，根据锁相环特性和参数确定b0、b1和b2的值即可计算出稳态跟踪误差θe(n)，用该稳态误差对锁相跟踪误差进行补偿，即可得到更加精确的输出结果。

2)线性递推最小二乘滤波。如式(2)所示的信号，经过积分清除和锁相跟踪计算后其稳态误差存在如式(8)所示的误差，可以将这种沿真值附近正负变化的误差通过线性递推最小二乘滤波法滤除，滤波结果即为锁相跟踪最终补偿后的计算结果，该结果精度更高，满足锁相跟踪的要求。

经按阶递推最小二乘滤波，得到锁相跟踪频率误差和相位误差，再经过稳态常值偏置补偿得滤波估计值，即最佳误差量，再通过本地生成频率和相位进行误差补偿后得到载体滚转速度和相位结果。

5弹体滚转姿态跟踪实验

对于上述滚转姿态跟踪算法，采用两组弹道数据模拟出垂直于弹轴安装的陀螺测量数据进行跟踪运算，计算弹体滚转角速度和滚转相位，根据跟踪误差对所提姿态跟踪算法进行验证。

第一组弹道数据为初速为780 m/s、射角为45°、转速为252 r/s，且随机风干扰较大的弹体角运动数据，锁相跟踪结果如图3～5所示。第二组弹道数据为初速为900 m/s、射角为45°、转速为286 r/s且随机风干扰较大的弹体角运动数据，锁相跟踪结果如图6～8所示。可见，与采用第一组弹道数据进行滚转姿态检测仿真的结果相比，第二组弹道数据的速度较高，转速较大，但滚转姿态检测误差相差不大，转速跟踪误差也为0.5 r/s，相位稳态误差也可达2°以内。

图3　第一组弹道耦合角速度曲线及局部放大图Fig.3　The coupled angular rate and its partial curve of the first group trajectory

图4　第一组弹道滚转角速度锁相跟踪计算结果Fig.4　The calculated results of roll angular rates of the first group trajectory

图5　第一组弹道滚转相位锁相跟踪计算结果及局部放大图Fig.5　The roll phase calculated results and its partial curve of the first group trajectory

图6　第二组弹道耦合角速度曲线及局部放大图Fig.6　The coupled angular rate and its partial curve of the second group trajectory

图7　第二组弹道滚转角速度锁相跟踪计算结果Fig.7　The calculated results roll of angular rates of the second group trajectory

图8　第二组弹道滚转相位锁相跟踪计算结果及局部放大图Fig.8　The roll phase calculated results and its partial curve of the second group trajectory

由图3可以看出耦合角速度曲线具有明显的周期特性，其包络与俯仰角速度相似，包络细节与偏航角速度相似；由图4可知转速跟踪误差在0.5 r/s以内，相对误差可达3‰；由图5可知实际相位曲线和计算相位曲线基本重合，误差在8 s内达到5°以内，稳态误差可达2°以内。由图3～8可知，该滚转姿态锁相跟踪方法能对弹丸的俯仰和滚转耦合信号进行有效跟踪，但对于动态性较高的弹丸，其初始跟踪误差较大，收敛时间较长，但总体收敛时间10 s左右，跟踪精度在2°左右。

6结论

1)弹丸的运动参数变化较为缓慢，以俯仰轴为敏感轴的陀螺所测的弹体角运动耦合信号具有明显的周期特性，其幅值受俯仰角速度调制，可以借鉴所限跟踪算法对其进行处理，提取出耦合信号中的滚转角运动信息，实现弹体滚转姿态测量。

2)三阶锁相环路具有跟踪滚转角加加速度的能力，且具有较高的跟踪精度和跟踪稳定性，能有效跟踪弹体滚转运动，满足跟踪弹体滚转运动的要求。因此，本研究所提的基于锁相跟踪原理的滚转姿态提取方法是可行的，能解决弹体滚转姿态测量的难题。

[1]BEST R E. Phase-locked loops design, simulation and applications[M]. 5th ed. New York: McGraw-Hill, 2003: 1-5.

[2]GUSTAFSON D E, LUCIA D J. Autonomous local vertical determination for guided artillery shells[C]// Proceedings of the 52nd Annual Meeting of the Institute of Navigation. Cambridge, MA, USA, 1996.

[3]DOTY J H. Advanced spinning-vehicle navigation——a new technique in navigation of munitions[C]//Proceedings of the 57th Annual Meeting of the Institute of Navigation. Albuquerque, NM, USA, 2001.

[4]RATKOVIC J A. Projectile guidance with accelerometers and a GPS receiver: US, US6779752[P]. 2004-08-24.

[5]GÉRARD L. Process to control the trajectory of a spinning projectile: US, US7105790[P]. 2006-09-12.

[6]PARK H Y, KIM K J, LEE J Y, et al. Roll angle estimation for smart munitions[C]//Proceedings of the 17th IFAC Symposium on Automatic Control in Aerospace. Universitas Studii Toulouse, France, 2007.

[7]MANSUKHANI A. Phase lock loop stability analysis[R]. Applied Microwave and Wireless, 2000.

[8]KINGSTON D, BEARD R W. Real-time attitude and position estimation for small UAVs using low-cost sensors[C]//Proceedings at AIAA 3rd "Unmanned Unlimited" Technical Conference, Workshop and Exhibit. Chicago, Illinois, 2004.

[9]CHHEDA B, CRASSIDIS A. L, WALTER W W. Attitude estimation using an accelerometer and rate gyro based device[C]//Proceedings at AIAA Atmospheric Flight Mechanics Conference and Exhibit. Keystone, Colorado, 2006.

[10]KAPLAN E D, HEGARTY C J. Understanding GPS: principles and applications[M]. 2nd ed. Boston: Artech House, Inc., 2006.

Technique for determining roll attitude of spin-stabilized projectiles based on third-order phase-locking loops

YANG Denghong, LI Dongguang, SHEN Qiang, ZENG Guangyu, YANG Ruiwei

(Science and Technology on Electromechanical Dynamic Control Laboratory, Beijing Institute of Technology, Beijing 100081, China)

Abstract：An analysis of spin-stabilized projectile angular motion characteristics was performed to determine the roll attitude of a spin-stabilized projectile using a low-range gyroscope. A mathematical model was established, and a method of determining the roll attitude of the spin-stabilized projectile using a low-range gyroscope was proposed based on third-order phase-locking loops. A loop filter parameter of the third-order phase-locking loops was calculated using the characteristics of the spin-stabilized projectile coupled with an angular motion signal and measured signal of the low-range gyroscope. Moreover, the roll angle and angular roll rate can be calculated using the proposed methodology. Experimental results show that the proposed method can effectively lock the angular roll motion signal of the spin-stabilized projectile and calculate the roll attitude of that spin projectile with a high degree of accuracy.

Keywords：spin-stabilized projectile; low-range gyroscope; roll attitude; phase-locking tracking algorithm; third-order phase-locking loops

中图分类号：TP14

文献标志码：A

文章编号：1006-7043(2016)02-0261-05

doi:10.11990/jheu.201410022

作者简介：杨登红(1986-)，男，博士研究生;李东光(1965-)，男，教授，博士生导师;申强(1977-)，男，副教授.通信作者：申强，Email：bit82shen@bit.edu.cn.

基金项目：重点实验室基金资助项目(9140C360204120C36135).

收稿日期：2013-06-25.网络出版日期：2015-12-29.

网络出版地址：http://www.cnki.net/kcms/detail/23.1390.u.20151229.1711.002.html