基于自适应频率估计的舰船瞬时线运动测量方法-袁书明.pdf
《基于自适应频率估计的舰船瞬时线运动测量方法-袁书明.pdf》由会员分享,可在线阅读,更多相关《基于自适应频率估计的舰船瞬时线运动测量方法-袁书明.pdf(6页珍藏版)》请在得力文库 - 分享文档赚钱的网站上搜索。
1、万方数据566 中国惯性技术学报 第24卷息还存在发散问题。针对这种情况,需要通过添加数字高通滤波器的方式来滤除低频的舒勒周期信号及解决垂向信息发散的问题。文献7】采用添加数字高通滤波器的方法来滤除低频的舒勒周期信号及解决垂向信息发散的问题,并分析对比了FIR(Finite ImpulseResponse)和IIR(Infinite Impulse Response)两种滤波器的优缺点,最终选择了使用IIR滤波器,但是没有解决由于采用IIR数字高通滤波器带来的输出信息相位超前的问题;文献89在添加IIR数字高通滤波器的基础上,提出将多普勒计程仪与惯导系统做组合,并利用卡尔曼滤波实现对舰船姿态角
2、误差的准确估计,从而提高了瞬时线运动测量精度;针对输出信息存在相位差超前的问题,文献10】采用了基于卡尔曼滤波法和应用时间序列法两种方法对舰船纵横摇和升沉运动进行了预报,但只实现了短期的预报,随着时间的增长,预报精度会大大降低,不适合长时间的瞬时线运动的测量;文献1l】简要介绍了一种自适应频率估计算法,即加权傅立叶线性组合算法(Weightedfrequency Fourier Linear Combiner,WFLC),并说明了其在电脑输入滤波、临床震颤的量化和显微外科的主动震颤取消上的应用。基于此,本文拟引入WFLC算法,设计一种基于自适应频率估计的舰船瞬时线运动测量方法。通过自适应频率估
3、计算法估计瞬时线运动信号频率,然后计算出超前相角及超前时间,进而通过延时校正算法对超前量进行校正,有效地对数字高通滤波器导致的超前时间量进行校正,实现IIR实时瞬时线运动信息精确测量。1 传统瞬时线运动信息测量方法11 基于捷联惯导算法的瞬时线运动测量舰船的瞬时线运动运动,包括横荡、纵荡和升沉运动,是舰船沿半固定坐标系(简称d系,由地理坐标系顺时针转向舰船的航向角矽得到)的三个轴向相对于海平面的一种线运动的高频分量,分别包括沿粕、Yd、Zd轴向的速度和位移量。由于捷联惯导系统能输出舰船的三维线运动和角运动信息,因此通过对捷联惯导算法进行调整,即可实现对瞬时线运动信息的提取。捷联惯导系统利用陀螺
4、仪的测量信息,通过矩阵更新算法能实现姿态矩阵更新和姿态信息解算:靠=础 (1)式中:为姿态矩阵,代表载体系(b系)至地理系(t系)的坐标变换矩阵;投kb由陀螺仪测量信息计算获得。通过姿态矩阵可将捷联惯导系统加速度计测量信息投影至地理系,实现沿地理系轴向线运动信息解算,即:晖哆彬=砖建一【(嘭。+皑。)I r-o+f 0 (2)lgJ式中:、E分别是沿地理系方向的速度信息;g是对应高度h处的重力加速度,与地球表面重力加速度g。的关系为g=g。(12hR) (3)再通过对地理系方向速度信息的积分运算,即可获得地理系方向的位置矢量信息,包括经度、纬度和高度信息。然而,捷联惯导系统输出的线运动与舰船瞬
5、时线运动信息有所区别:1)由于地理系与半固定坐标系指向差异性,需要将地理系的线运动信息投影至半固定坐标系,即:f V4:掣V1,d_菇,t (4)式中,cos sinb 0F=|_sin#cos#0 (5)l 0 0 1J式中,矽为舰船的航向角。2)捷联惯导输出的线运动信息是相对地球、沿地理坐标系的绝对速度和绝对位置信息,需要通过数字滤波器实现其高频分量的提取。因此,数字高通滤波器的性能指标直接决定了舰船瞬时线运动信息的测量精度。12传统瞬时线运动测量方法性能分析数字滤波器分为IIR滤波器和FIR滤波器两种,在技术指标要求相同的情况下,FIR滤波器的阶数要比IIR滤波器的阶数高很多12】。因此
6、,瞬时线运动信息的提取选用IIR高通滤波器。以垂向通道为例,舰船升沉运动的周期在1-20 S之间,由此可得IIR高通滤波器的各项参数为:通带边缘频率正=003Hz;阻带截止频率,=0olHz;通带最大衰减Ap=1dB;阻带最小衰减As=30dB;采样周期五=001 S。根据上述滤波器参数指标,可得数字滤波器的转移函数如式(6)所示:、099861299583z-1+299583z一099861z。爿I z)2了、710000029972 lz“+299444z一099722z。(6)万方数据第5期 袁书明等:基于自适应频率估计的舰船瞬时线运动测量方法 一567一设定舰船初始纬度(o=34218
7、 3。,初始经度五=108911 7。,初始速度0kn,初始横摇角0。,纵摇角0。,航向角45。,升沉幅值为l m,升沉运动频率01 Hz。图lgU图2按照上述的仿真条件及滤波器参数,给出了垂向速度和升沉运动的提取结果。_| 理论输出值 未延时输出值Ij I 。, |f , jj il i| | | i|夺。霄 纩 中 一弭一 i|-一基 督 业 f| :|;|? 一毒 :| 沁 霄浩 +尊;| 小jl。 计。j| | | I;| 0 il 墨 ;l、 j75 80 85 90 95 100时间s图1 垂向速度信息测量仿真结果Vertical velocity information meas
8、urementsimulation results理论输出值未延时输出值l倒I 溺一I 卿l jj 溺 漆幽 !,泌 95 100图2升沉信息测量仿真结果Fig2 Simulation results ofheave information measurement通过图1、图2的仿真结果可以看出,由于IIR高通滤波器的相位超前效应,产生了滤波输出与原始信号的相位差异。通过理论计算可知,兰iIIR滤波器相位超前为口,对。=a sin(cot+Oto)信号产生的升沉测量误差为Ah2alsin(a。2)l,即当超前相角为10。,升沉运动幅值为l m时,由超前相角带来的误差大小为0124m。因此,传统
9、方法采用高通滤波器提取瞬时线运动信息时,存在超前相角导致输出信息在时间上超前的问题,进而影响到升沉信息测量的实时性与测量精度。2基于自适应频率估计的瞬时线运动信息测量方法通过传统方法的问题分析可知,采用数字高通滤波器进行瞬时线运动信息提取,其问题在于滤波器对不同频率线运动信息产生的相位超前,导致提取后的信息产生误差。由于相位超前值与输入信号频率有关,因此无法设计固定的相位延迟进行补偿1 31。为此,设计自适应频率估计和自适应延时校正算法,实现对瞬时线运动信息的精确提取。21 瞬时线运动信息的自适应频率估计算法由于IIR数字高通滤波器的超前相角的大小与滤波器输入信号的频率有关,因此需要实时地估计
10、出滤波器输入信号的频率。舰船瞬时线运动是一种准周期运动,可视为周期性信号来处理,即在满足狄利克雷条件下,周期信号可以用傅里叶级数来表示,如下式所示:x(f)=睾+(sinnCOot+bcosnr_00t) (7)二 n=l式中,CO。=了27,an=亍2fr,2:x(删nnc00fdf,Pr2b=导I,。x(t)cosncootdt。FLC(Fourier Linear Combiner)算法通过选取合适的基频和谐波次数,使拟合信号的频带能够覆盖原信号的频率带,实现对原信号的估计。由于是自适应算法,FLC在迭代过程中能根据输入信号的变化自动调整各谐波分量的权值以达到最好的估计效果,但FLC算法
11、中的估计信号基频分量和谐波数量都是固定的,适用于频率固定信号估计。对于舰船瞬时线运动信号,在不同海况下的信号频率在实时发生变化,因此必须使FLC算法各频率成分谐波的幅值能跟随原始信号的频率变化而实时调整。WFLC算法是在FLC算法基础上,在估计过程中对拟合信号的基频分量不断优化以实现对拟合信号基频分量和各频率分量幅值同时进行调整的目的,最终实现最优的估计效果14-16。WFLC算法示意图如图3所示,相对应的加权线性傅里叶组合递归形式为守1 1 1-丫J,二!尘Li:老热、 。r、醮甚躐一心 : r7”y,7l,、:伍巫一必形r。娑_if二么-r赢-,K_-_一7“赢兰!竺坠壁墨_面_j藁悻i8
12、642O24680000O000csE一、恻利叵常万方数据568 中国惯性技术学报 第24卷渤(rr纠t=0sin旧I cos卜螂籼)1rMM+1,2M(N=f(面)T),在设计位数据缓冲区,实现延时位数据达到延时校正目的。具体算法如图4所示。(8)缓冲区数据移位&=&一哌T黾 (9)M。=wo。+2胁&f(Kh+tWM+k气) (10)i=1+l=+2px。& (11)式中:为输入参考量,Xk=【五t X2I工2脚】T9=w1。w2。w2腑1,为以对应谐波分量权值;Wo。为基频分量;S。是k时刻瞬时线运动信号真实值;&是k时刻瞬时线运动信号拟合误差;是收敛系数,其决定是否收敛以及收敛的快慢;
13、T是采样时间。通过式(8)(1 1)的递推算法可知,WFLC算法在递推过程中实现了对基频分量的实时调整,因此可以很好地解决了FLC算法只能适用于对固定频率信号估计的问题,实现了对频率变化的信号的估计。而在FLC算法中,基频分量W0。为固定值,不参与实时递推。22自适应延时校正算法通过WFLC自适应频率估计算法,可以估计瞬时线运动信号频率面,则可以计算出由IIR数字高通滤波器带来的超前相角。以式(6)为例,其超前相角为乡(面)=arg H(exp(jfT)=t狮l_二型塑垫墅堕生型塑llao+a1 cos(fT)+a2 cos(2fT)+a3 cos(3fT)Jtan-bI sin(fiT)+b
14、2 sin(2fT)+b3 sin(3fT)一lL1+bl cos(fT)+b2 cos(2c西T)+b3 cos(3fT)J(12)式中:a,和6l为滤波器的系数;T为采样周期。由式(12)可得超前时间为f(面)=目(面)面 (13)通过对IIR数字高通滤波数据进行延时输出,就可以得到真实的实时信息。例如,对于式(6)所示的IIR数字高通滤波器的设计结果,当输入信号频率为01 Hz,由式(22)可以计算得出超前相角o(f)=0381 78 rad,然后由式(13)就可以计算出此时的超前时间t(f)=0607 6 S,此时只需将信号延迟0607 6 s即可。在已知信号采样周期啪情况下,可根据超
15、前时间t(f)和采样周期丁计算数据延时位数竺堕鍪塑皇卜叫尸粼计bl算结果厂,1hl 2X2扔H延躲N据2扔 ,I 输出一X12X2图4 自适应延时算法原理Fig4 Principle of adaptive delay algorithmIIR数字高通滤波器的输出信息经过自适应频率估计和自适应延时校正模块,就可以得到实时的瞬时线运动信息,提高信息测量精度。23改进方法的测量实现步骤改进的舰船瞬时线运动信息测量流程图如图5所示。陀螺仪 。测量信息q;捷联姿态矩阵觯算未镁兰厂6姿态矩阵F 删:引t一息。f爿鹭嘞1!兰 童!o刊坐标变换 坐标变换h一1r r6数字高通滤波丫频率估计L。1 一延时校正
16、审矿a 丫F4图5实时瞬时线运动信息测量流程图Fig5 Real-time measurement of the instantaneouslinear motion information由于仍然采用捷联惯导系统测量瞬时线运动信息,因此改进方法相比传统方法的区别主要是IIR数字高通滤波后的自适应频率估计和自适应延时校正两个模块。其中,自适应频率估计模块能够实时地估计出升沉信号的频率大小,自适应延时校正可以根据自适应频率估计模块估计出的频率计算出输出信号超前量的大小并进行延时校正。通过添加这两个模块,能够有效地解决由IIR数字高通滤波器带来的输出信息超前的问题,实现实时的瞬时线运动信息测量。一
17、波一一一慕薹品字一一频延数一万方数据堑!塑 查主望竺:叁主!兰皇壑兰竺盐竺垫丝堕竺垡兰黧型兰主兰二丝=_I_ll;=目=jllI_I_ll_llE_目i=_I_EII_II=I_-。1。一3 仿真验证 表1 不同频率的升沉运动仿真结果基于自适应频率估计和自适应延时校正的改进Tab1 Simulation results ofheave motion with舰船瞬时线运动信息测量方法,可以有效抑制输出信息相对于真实信息存在的超前相位差,并提高测量的精度。为了验证改进的瞬时线运动信息测量方法可行性,按照与第22节相同的仿真初始条件,进行幅值频率升沉信号的仿真,基于改进方法和传统方法的瞬时线运动信
18、息测量与传统方法做对比的方式,验证改进方法的实时性和精确性。仿真结果如图6、图7所示。对于幅值为l m的不同频率的升沉运动进行了仿真,传统方法和改进方法的误差大小如表1所示。从图6、图7和表1中可以看出,基于自适应频率估计的舰船瞬时线测量方法能够精确估计舰船瞬时线运动的频率并对滤波器输出值进行延时补偿。多组仿真结果表明,通过精确延时将瞬时线运动信息的测量精度由之前的013 m提高到了002 in,验证了算法的有效性。1理论输出值未延时输出值 一诞时后输出值h|f ;| ; l li i| | | 。;| j l连嚣一 争 F1 I、 一J|!;| ;l ;| ;l、t i| 0 | | 疆!|
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 基于 自适应 频率 估计 舰船 瞬时 运动 测量方法 袁书明
限制150内