本发明属于水表超声波流量计量领域,具体涉及一种基于改进卡尔曼滤波器的时差超声波流量测量方法,适用于各种管道中水流体的流量测量。
背景技术:
随着智慧水务和物联网技术的发展,超声波水表应运而生。与传统的机械水表相比,超声波水表具有非接触式、压损小、精度高、功耗低、使用寿命长等突出优点,必将成为下一代智能水表的重要选择。超声波水表所采用的超声波测量技术有多种方法,常用的测量方法有时差法、相关法、噪声法、多普勒法和波束偏移法等。
时差法超声波测量的原理是:超声波信号在流体顺流与逆流传播时的传播速度不同,进而产生传播时间差值。由于时间差值的大小与流速大小有关,因此,通过测量时间差值的大小,就可以测量流体的流速。
在超声波水表系统中,由于测量过程会引入噪声,使得测量结果与实际流速值产生一定偏差。偏差值的大小与流体中是否有气泡或颗粒物、超声波信号质量、电路板pcb布局、温度补偿超声波声速值误差、外部电磁干扰等有关。为了减少外部噪声对超声波水表的干扰,提高水表的精度,需要对测得的时差数据进行滤波。目前使用较多的是中位值平均滤波方法,其功能是消除大幅度的脉冲干扰,算数平均滤波是将多个数据取平均值,可以使数据波动变缓,从而使数据稳定可靠。但是,中位值滤波方法会产生较大的误差。因此就有人提出了卡尔曼滤波方法,卡尔曼滤波后的数据波动要比中值均值滤波要小得多,而且卡尔曼滤波的快速性和快速响应性远大于中值均值滤波。
但是如果时差信号快速变化,则卡尔曼滤波并不能获得良好的滤波效果,因此又有人提出了卡尔曼滤波算法与算术平均算法结合的数据滤波算法,但是算术平均与卡尔曼滤波之间的切换条件不好确定(因为涉及到时差数据的采样率fs、求最大和最小值时用到的采样数量、切换门限值δ等多个阴虚);此外,算术平均滤波对于快速变化的时差值,滤波效果也不太理想;而且,卡尔曼滤波器对于快速变化的时差值,会跟不上时差的变化而导致较大的误差,导致流量的累积计算可能会存在较大的误差。
技术实现要素:
本发明要解决的技术问题是提供一种基于改进卡尔曼滤波器的时差超声波流量测量方法,通过更新卡尔曼滤波器中的过程噪声协方差矩阵和测量噪声协方差矩阵,极大地改善了超声波流量计中时差信号的滤波效果,特别是时差信号快速变化的情况下的滤波效果的改善更为明显,从而有效地提高了时差法超声波流量计的测量精度。
本发明通过以下技术方案解决上述技术问题,
一种基于改进卡尔曼滤波器的时差超声波流量测量方法,其步骤包括,
步骤(1)、时差信号测量:
沿水流方向前后设置第一超声波换能器p1和第二超声波换能器p2;规定换能器与反射片的距离为s,超声波在水中的速度为c,反射片与水平面夹角为45°,两反射片的中心距离为l,管道直径为d,水的正向流速即线速度vl为v;
第一超声波换能器p1发出超声波脉冲,在第二超声波换能器p2上接收超声波脉冲,并计算接收到超声波时刻和发送超声波时刻的时间差t12,则有:
通过第二超声波换能器p2发出超声波脉冲,在第一超声波换能器p1上接收超声波脉冲,并计算接收到超声波时刻和发送超声波时刻的时间差t21,则有:
最后,获得时间差δt=t21-t12,根据式(1)和式(2),可求得顺逆流时间差δt:
步骤(2)、时差信号的滤波:
滤波处理是为了去掉原始数据中的随机误差,在超声波流量测量装置中,由于测量过程会引入外部噪声,使得测量结果与实际流速值产生一定偏差值,偏差值的大小与流体中是否有气泡或颗粒物、超声波信号质量、电路板pcb布局、温度补偿超声波声速值误差、外部电磁干扰等有关,为了减少外部噪声对超声波水表的干扰,提高水表的精度,需要对测得的时差数据进行滤波;用xk表示时刻k时时差δt(kt]的状态值,其中t为采样周期,具体如下:
xk=δt(kt];
在卡尔曼滤波器中,系统状态方程如下:
xk=φk-1xk-1 wk-1,(4);
式中,xk为k时刻的系统状态,xk-1为k-1时刻的系统状态,φk-1为k-1时刻的状态转移矩阵,wk-1为k-1时刻的系统噪声,qk为k时刻的系统噪声;
用zk表示时刻k时时差δt(kt]的测量值,则时差δt的测量方程如下:
zk=hkxk vk,(6);
式中,hk表示k时刻的测量系统的参数,vk为k时刻的测量噪声,rk为k时刻的测量噪声的协方差矩阵;
在系统中定义φk-1=1、hk=1,那么,时差数据的改进卡尔曼滤波方法如下:
(2.1)、初始条件计算:
式中,e[···]表示数学期望运算,
(2.2)、利用k-1时刻的误差协方差pk-1( )、k-1时刻的状态转移矩阵φk-1和k-1时刻的系统噪声qk-1,计算k时刻的状态预测
(2.3)、利用k时刻的误差协方差预测pk(-)、k时刻的测量系统的参数hk和k时刻的测量噪声的协方差矩阵rk,计算k时刻的卡尔曼增益
(2.4)、利用式(10)和式(11)计算获得的k时刻的
(2.5)、利用k时刻的卡尔曼增益
(2.6)、k时刻的测量噪声协方差rk和k-1时刻的过程噪声协方差qk-1更新如下:
ratio=r1/q0(18);
rk=rk( )/ratio(19);
qk-1=qk-1( )/ratio(20);
(2.7)、将步骤(2.6)更新后的k时刻的测量噪声协方差rk和k-1时刻的过程噪声协方差qk-1代入步骤(2.2)-(2.6)中,递归计算k时刻的状态值
(2.8)、按步骤(2.1)-(2.7)对式(6)中测得的时差信号zk进行滤波,通过滤波,得到滤波后的时差数据:
步骤(3)、累计流量的计算:
在计算瞬时流速和流量时,用到的是线平均流速,由流体力学可知,面平均流速根据流体的不同状态,有着不同的修正系数;
设修正系数为k,计算流体的累计流量q为:
式中,vl为流体线速度,根据式(3)得到,vl值为:
为了获得更好的技术效果,步骤(3)前还有步骤(2.9)超声波声速的温度补偿:
由于超声波的声速随着温度的变化而变化,因此,为了准确计算式(23)中流体线速度vl值,需要对超声波的声速进行温度补偿;
(2.9.1)通过测量声速与温度的关系,得到基于曲线拟合得到声速与温度的关系曲线;
(2.9.2)制作超声波速度与温度的关系表格,并利用表格进行基于查表法的温度补偿,利用查表法得到的声速c,结合计算获得的滤波后的时差信号
在上述流量计算的方法中,其中步骤(2)中时差信号的滤波算法,利用了本发明提出的改进卡尔曼滤波方法,改善了时差信号的滤波效果,从而有效地提高了时差法超声波流量计的测量精度。
本发明提出一种改进的卡尔曼滤波器,并提出一种基于改进卡尔曼滤波的时差法超声波流量测量方案。在该方案中,针对,提出了测量噪声协方差和过程噪声协方差的更新方法,并由此提出了一种改进的卡尔曼滤波器。然后,针对时差法超声波流量计中时差信号的滤波,提出了基于改进卡尔曼滤波器的时差信号滤波方法,及给出了基于改进卡尔曼滤波器的时差法超声波流量测量方案。通过本发明提供的技术方案,明显地改善了时差法超声波流量计中时差信号的滤波效果,从而有效地提高了时差法超声波流量计的测量精度。
附图说明
图1为本发明实施例超声波流量测量结构示意图;
图2为本发明实施例水流体下0~40℃声速-温度拟合曲线;
图3为本发明实施例超声波流量测量流程图;
图4为本发明实施例和对比例的平稳时差数据时的滤波结果;
图5为本发明实施例和对比例的时差数据线性降低时的滤波结果;
图6为本发明实施例和对比例的时差数据存在快速变化时的滤波结果;
图7为本发明对比例超声波流量测量流程图;
图8为本发明对比例卡尔曼滤波算法与算术平均算法结合的数据滤波算法流程图。
具体实施方式
下面结合附图和实施例,进一步详细阐述本发明的内容。
实施例1
一种基于改进卡尔曼滤波器的时差超声波流量测量方法,其步骤包括,
步骤(1)、时差信号测量:
如图1所示,沿水流方向前后设置第一超声波换能器p1和第二超声波换能器p2;规定换能器与反射片的距离为s,超声波在水中的速度为c,反射片与水平面夹角为45°,两反射片的中心距离为l,管道直径为d,水的正向流速即线速度vl为v;
第一超声波换能器p1发出超声波脉冲,在第二超声波换能器p2上接收超声波脉冲,并计算接收到超声波时刻和发送超声波时刻的时间差t12,则有:
通过第二超声波换能器p2发出超声波脉冲,在第一超声波换能器p1上接收超声波脉冲,并计算接收到超声波时刻和发送超声波时刻的时间差t21,则有:
最后,获得时间差δt=t21-t12,根据式(1)和式(2),可求得顺逆流时间差δt:
步骤(2)、时差信号的滤波:
滤波处理是为了去掉原始数据中的随机误差,在超声波流量测量装置中,由于测量过程会引入外部噪声,使得测量结果与实际流速值产生一定偏差值,偏差值的大小与流体中是否有气泡或颗粒物、超声波信号质量、电路板pcb布局、温度补偿超声波声速值误差、外部电磁干扰等有关,为了减少外部噪声对超声波水表的干扰,提高水表的精度,需要对测得的时差数据进行滤波;
用xk表示k时刻的时差δt(kt]的状态值,其中t为采样周期,具体表示如下:
xk=δt(kt];
在卡尔曼滤波器中,系统状态方程如下:
xk=φk-1xk-1 wk-1(4);
式中,xk为k时刻系统的状态,xk-1为k-1时刻的系统状态,φk-1为k-1时刻的状态转移矩阵,wk-1为k-1时刻的系统噪声,qk为k时刻的系统噪声;
用zk表示时刻k时时差δt(kt]的测量值,则时差δt的测量方程如下:
zk=hkxk vk(6);
式中,hk表示k时刻的测量系统的参数,vk为k时刻的测量噪声,rk为k时刻的测量噪声的协方差矩阵;
在系统中定义φk-1=1、hk=1,那么,时差数据的改进卡尔曼滤波方法如下:
(2.1)、初始条件计算:
式中,e[···]表示数学期望运算,
(2.2)、利用k-1时刻的误差协方差pk-1( )、k-1时刻的状态转移矩阵φk-1和k-1时刻的系统噪声qk-1,计算k时刻的状态预测
(2.3)、利用k时刻的误差协方差预测pk(-)、k时刻的测量系统的参数hk和k时刻的测量噪声的协方差矩阵rk,计算k时刻的卡尔曼增益
(2.4)、利用k时刻的卡尔曼增益
(2.5)、利用k时刻的卡尔曼增益
(2.6)、k时刻的测量噪声协方差rk和k-1时刻的过程噪声协方差qk-1更新如下:
ratio=r1/q0(18);
rk=rk( )/ratio(19);
qk-1=qk-1( )/ratio(20);
(2.7)、将步骤(2.6)更新后的k时刻的测量噪声协方差rk和k-1时刻的过程噪声协方差qk-1代入步骤(2.2)-(2.6)中,递归计算k时刻的状态值
(2.8)、按步骤(2.2)-(2.7)对式(6)中测得的时差信号zk进行滤波,通过滤波,得到滤波后的时差数据:
(2.9)、超声波声速的温度补偿:
由于超声波的声速随着温度的变化而变化,因此,为了准确计算步骤(4)中式(23)中线速度vl值,需要对超声波的声速进行温度补偿;
(2.9.1)通过测量声速与温度的关系,得到基于曲线拟合得到声速与温度的关系曲线;
在容器中,保持一定间隔设置两个超声波换能器,其中一个发送超声波,另一个接收超声波,获得发送与接收时间差,通过间隔距离与时间差获得超声波的声速,之后改变容器中流体的温度,获得超声波的声速与温度的关系曲线,并制作超声波速度与温度的关系表格;
(2.9.2)利用超声波速度与温度的关系表格进行基于查表法的温度补偿;
利用查表法得到的声速c,结合计算获得的滤波后的时差信号
步骤(3)、累计流量的计算:
在计算瞬时流速和流量时,用到的是线平均流速,由流体力学可知,面平均流速根据流体的不同状态,有着不同的修正系数;
假设修正系数为k,计算流体的累计流量q为:
式中,vl为流体线速度,根据式(3)得到,vl值为:
结合步骤(2.9.2)获得的该温度下流体线速度校正值vl',
流体的累计流量q修正为:
在上述流量计算的方法中,其中步骤(2)中时差信号的滤波算法,利用了本发明提出的改进卡尔曼滤波方法,改善了时差信号的滤波效果,从而有效地提高了时差法超声波流量计的测量精度,流程图见3。
(一)、用仿真来验证基于改进卡尔曼滤波器的时差信号滤波效果
图4给出了基于改进卡尔曼滤波器的平稳时差数据(真实时差=2ns)时的滤波结果;图5给出了时差数据线性降低(其中包含一段抖动的数据)时的滤波结果,其中时差从2ns降至0ns;图6给出了时差数据存在快速变化时的滤波结果。
相比现有方案中,本发明在时差信号平稳时,基于改进卡尔曼滤波器的时差数据滤波效果稍差于基于传统卡尔曼滤波器的时差信号滤波方法;但是,对于快速变化的时差信号,本发明滤波效果有了显著的提高,从而能有效提升时差法超声波流量计的测量精度。
对比例
时差法超声波测量的原理是:超声波信号在流体顺流与逆流传播时的传播速度不同,进而产生传播时间差值。由于时间差值的大小与流速大小有关,因此,通过测量时间差值的大小,就可以测量流体的流速,流程图如图7所示;超声波流量测量结构示意图如图1所示。
图1中,沿水流方向前后设置第一超声波换能器p1和第二超声波换能器p2;规定换能器与反射片的距离为s,超声波在水中的速度为c,反射片与水平面夹角为45°,两反射片的中心距离为l,管道直径为d,水的正向流速即线速度vl为v;
第一超声波换能器p1发出超声波脉冲,在第二超声波换能器p2上接收超声波脉冲,并计算接收到超声波时刻和发送超声波时刻的时间差t12,则有:
通过第二超声波换能器p2发出超声波脉冲,在第一超声波换能器p1上接收超声波脉冲,并计算接收到超声波时刻和发送超声波时刻的时间差t21,则有:
最后,获得时间差δt=t21-t12,根据式(1)和式(2),可求得顺逆流时间差δt:
由此,可以得到线速度vl:
在计算瞬时流速和流量时,用到的是线平均流速。由流体力学可知,面平均流速根据流体的不同状态,有着不同的修正系数。假设修正系数为k,则流体的累计流量q为:
由式(23)可知,当顺逆流时间差δt越大时,水流线速度越大,于是一定时间内的累计流量越大;根据式(22)可以发现,在修正系数k、管道直径d、反射片距离l确定的情况下,一定时间内的累计流量q只与时间差值δt和超声波传播速度c有关,因此,时间差值δt和超声波传播速度c的测量成为超声波流量计的关键。
数据滤波处理是为了去掉原始数据中的随机误差,以提高数据质量的一种方法。在超声波水表系统中,由于测量过程会引入噪声,使得测量结果与实际流速值产生一定偏差。偏差值的大小与流体中是否有气泡或颗粒物、超声波信号质量、电路板pcb布局、温度补偿超声波声速值误差、外部电磁干扰等有关。为了减少外部噪声对超声波水表的干扰,提高水表的精度,需要对测得的时差数据进行滤波。
现有技术中有的采用了中位值平均滤波方法。中位值平均滤波是中位值滤波和算数平均滤波结合起来的滤波方法。中位值滤波最重要的功能是消除大幅度的脉冲干扰,算数平均滤波是将多个数据取平均值,可以使数据波动变缓,从而使数据稳定可靠。但是,中位值滤波方法会产生较大的误差。
现有技术中还有的提出了卡尔曼滤波方法。而且,结果表明,中位值滤波和卡尔曼滤波这两种滤波方法都能有效防止脉冲干扰,使得数据更加平滑,但是卡尔曼滤波后的数据波动要比中值均值滤波要小得多,而且卡尔曼滤波的快速性和快速响应性远大于中值均值滤波。然而,如果时差信号快速变化,则卡尔曼滤波并不能获得良好的滤波效果。目前已有人提出了卡尔曼滤波算法与算术平均算法结合的数据滤波算法并投入了使用,对测得的时差信号δt={[δt(it],i=0,1,2,…}进行滤波,如图8所示。
一种基于卡尔曼滤波算法与算术平均算法结合的时差超声波流量测量方法,其步骤包括,
步骤(1)、时差信号测量:
当管道中有水流时,首先激发超声波换能器,使得超声波信号在管道内沿着水流方向顺流和逆流传播,超声波在流体中传播时,超声波传播的速度是超声波在流体中的波速与流体流速的叠加。时差法超声波测量的原理是:超声波信号在流体顺流与逆流传播时的传播速度不同,进而产生传播时间差值。由于时间差值的大小与流速大小有关,因此,通过测量时间差值的大小,就可以测量流体的流速,如图1所示;
图1中,假设向右为正向,换能器p1为顺流换能器,p2为逆流换能器;换能器发射出的超声波与流体流向垂直;换能器与反射片的距离为s,超声波在水中的速度为c,反射片与水平面夹角为45°,两反射片的中心距离为l,管道直径为d,水的正向流速即线速度vl为v,那么,由p1发射、p2接收超声波的顺流时间为:
由p2发射、p1接收超声波的逆流时间为:
根据式(1)和式(2),可求得顺逆流时间差δt:
在该步骤中,利用tdc-gp22高精度计时芯片,测量超声波换能器的时差信号δt={[δt(it],i=0,1,2,…};
步骤(2)、时差信号的滤波:
该滤波方法具体如下:
(2.1)快速测量八组流量数据并储存;
(2.2)判断其最大值与最小值的差值;
当超声波水表检测到有流速增加大于或等于一定阈值δ时,此时认为水的流量处于快速变化阶段,提高超声波水表采样频率fs,同时进入算术平均滤波算法阶段;
当检测到流速增加值小于一定阈值范围δ内,此时认为水流量处于稳定状态,则减小采样频率fs,并进入卡尔曼滤波算法阶段;
(2.2.1)初始条件计算:
(2.2.2)利用k-1时刻的误差协方差pk-1( )、k-1时刻的状态转移矩阵φk-1和k-1时刻的系统噪声qk-1,计算k时刻的状态预测
(2.2.3)利用k时刻的误差协方差预测pk(-)、k时刻的测量系统的参数hk和k时刻的测量噪声的协方差矩阵rk,计算k时刻的卡尔曼增益
(2.2.4)利用k时刻的卡尔曼增益
(2.2.5)利用k时刻的卡尔曼增益
(2.3)按步骤(2.2.1)-(2.2.5)对式(6)中测得的时差信号zk进行滤波,得到滤波后的时差数据:
步骤(3)、累计流量的计算:
在计算瞬时流速和流量时,用到的是线平均流速,由流体力学可知,面平均流速根据流体的不同状态,有着不同的修正系数;
假设修正系数为k,计算流体的累计流量q为:
在对比例中,步骤(2)中时差信号的滤波算法存在一些不足之处,首先,算术平均与卡尔曼滤波之间的切换条件不好确定(因为涉及到时差数据的采样率fs、求最大和最小值时用到的采样数量、切换门限值δ等多个阴虚);其次,算术平均滤波对于快速变化的时差值,滤波效果也不太理想,而且,卡尔曼滤波器对于快速变化的时差值,会跟不上时差的变化而导致较大的误差。因此,流量的累积计算可能会存在较大的误差。
为了说明现有超声波流量计中常规卡尔曼滤波器的不足之处,使用卡尔曼滤波器对变化的时差数据进行滤波。图4为平稳时差数据(真实时差=2ns)时的滤波结果。图5给出了时差数据线性降低(其中包含一段抖动的数据)时的滤波结果,其中时差从4ns降至1ns。图6给出了时差数据存在快速变化时的滤波结果。由图5和图6可知,在时差存在变化时,常规卡尔曼滤波器跟不上时差的变化,滤波效果很差。
与对比例相比,本发明提出一种改进的卡尔曼滤波方法,并基于此给出超声波水表的流量计算方案。该滤波方法通过更新测量噪声和过程噪声的协方差矩阵,有效的解决了常规卡尔曼滤波方法,从而能快速跟上时差的变化,具有很好的滤波效果。而且,克服了现有卡尔曼滤波算法与算术平均算法结合的数据滤波算法中需要在两种滤波方法中切换的不足之处。这样,在超声波水流量计中使用该该改进的滤波方法,能有效地提高超声波流量计的精度。
1.一种基于改进卡尔曼滤波器的时差超声波流量测量方法,其步骤包括,
步骤(1)、时差信号测量:
沿水流方向前后设置第一超声波换能器p1和第二超声波换能器p2;规定换能器与反射片的距离为s,超声波在水中的速度为c,反射片与水平面夹角为45°,两反射片的中心距离为l,管道直径为d,水的正向流速即线速度vl为v;
第一超声波换能器p1发出超声波脉冲,在第二超声波换能器p2上接收超声波脉冲,并计算接收到超声波时刻和发送超声波时刻的时间差t12,则有:
通过第二超声波换能器p2发出超声波脉冲,在第一超声波换能器p1上接收超声波脉冲,并计算接收到超声波时刻和发送超声波时刻的时间差t21,则有:
最后,获得时间差δt=t21-t12,根据式(1)和式(2),可求得顺逆流时间差δt:
步骤(2)、时差信号的滤波:
滤波处理是为了去掉原始数据中的随机误差,在超声波流量测量装置中,由于测量过程会引入外部噪声,使得测量结果与实际流速值产生一定偏差值,偏差值的大小与流体中是否有气泡或颗粒物、超声波信号质量、电路板pcb布局、温度补偿超声波声速值误差、外部电磁干扰等有关,为了减少外部噪声对超声波水表的干扰,提高水表的精度,需要对测得的时差数据进行滤波;
用xk表示k时刻的时差δt(kt]的状态值,其中t为采样周期,具体如下:
xk=δt(kt];
在卡尔曼滤波器中,系统状态方程如下:
xk=φk-1xk-1 wk-1,(4);
式中,xk为k时刻的系统状态,xk-1为k-1时刻的系统状态,φk-1为k-1时刻的状态转移矩阵,wk-1为k-1时刻的系统噪声,qk为k时刻的系统噪声;
用zk表示时刻k时时差δt(kt]的测量值,则时差δt的测量方程如下:
zk=hkxk vk,(6);
式中,hk表示k时刻的测量系统的参数,vk为k时刻的测量噪声,rk为k时刻的测量噪声的协方差矩阵;
在系统中定义φk-1=1、hk=1,那么,时差数据的改进卡尔曼滤波方法如下;
(2.1)、初始条件计算:
式中,e[···]表示数学期望运算,
(2.2)、利用k-1时刻的误差协方差pk-1( )、k-1时刻的状态转移矩阵φk-1和k-1时刻的系统噪声qk-1,计算k时刻的状态预测
(2.3)、利用k时刻的误差协方差预测pk(-)、k时刻的测量系统的参数hk和k时刻的测量噪声的协方差矩阵rk,计算k时刻的卡尔曼增益
(2.4)、利用k时刻的卡尔曼增益
(2.5)、利用k时刻的卡尔曼增益
(2.6)、k时刻的测量噪声协方差rk和k-1时刻的过程噪声协方差qk-1更新如下:
ratio=r1/q0(18);
rk=rk( )/ratio(19);
qk-1=qk-1( )/ratio(20);
(2.7)、将步骤(2.6)更新后的k时刻的测量噪声协方差rk和k-1时刻的过程噪声协方差qk-1代入步骤(2.2)-(2.6)中,递归计算k时刻的状态值
(2.8)、按步骤(2.2)-(2.7)对式(6)中测得的时差信号zk进行滤波,通过滤波,得到滤波后的时差数据:
步骤(3)、累计流量的计算:
在计算瞬时流速和流量时,用到的是线平均流速,由流体力学可知,面平均流速根据流体的不同状态,有着不同的修正系数;
设修正系数为k,计算流体的累计流量q为:
式中,vl为流体线速度,根据式(3)得到,vl值为:
2.如权利要求1所述测量方法,其特征在于,步骤(3)前还有步骤(2.9)超声波声速的温度补偿:
(2.9.1)通过测量声速与温度的关系,得到基于曲线拟合得到声速与温度的关系曲线;
(2.9.2)制作超声波速度与温度的关系表格,并利用表格进行基于查表法的温度补偿,利用查表法得到的声速c,结合计算获得的滤波后的时差信号