CN113405467B - 一种消除加速度计绝对测量漂移的方法 - Google Patents
一种消除加速度计绝对测量漂移的方法 Download PDFInfo
- Publication number
- CN113405467B CN113405467B CN202110686281.0A CN202110686281A CN113405467B CN 113405467 B CN113405467 B CN 113405467B CN 202110686281 A CN202110686281 A CN 202110686281A CN 113405467 B CN113405467 B CN 113405467B
- Authority
- CN
- China
- Prior art keywords
- frequency
- displacement
- sequence
- low
- new
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/02—Measuring arrangements characterised by the use of optical techniques for measuring length, width or thickness
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
- G01B21/02—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring length, width, or thickness
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P21/00—Testing or calibrating of apparatus or devices covered by the preceding groups
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Measurement Of Mechanical Vibrations Or Ultrasonic Waves (AREA)
Abstract
本发明公开了一种消除加速度计绝对测量漂移的方法,通过加速度数据滤除频率低于ft的成分,并在频域积分得到高频位移d。低频位移数据滤除频率高于ft的成分得到低频位移u。将高频位移和低频位移叠加得到准确的位移m。加速度计算高频位移时,滤波与积分同时进行,减少多次傅里叶变换带来的误差累加。将零频分量移到频谱中心并构造与之对应的频率数列,使代表各个谐波的复数对应正确的频率以进行后续计算。通过上述方式,融合了加速度数据计算出的高频位移和滤波后的低频位移,能够得出准确的位移,且本方法基于傅里叶变换,容易获取。同时本方法逻辑清晰,步骤简单,易于编程实现。
Description
技术领域
本发明涉及传感器技术领域,具体涉及一种消除加速度计绝对测量漂移的方法。
背景技术
目前测量一点位移可采用激光位移传感器或者超声波传感器直接测量,也可以先测量加速度数据再进行数值积分或者频域积分计算位移。数值积分法是对一段时间内的加速度数据插值求积得到该时间段内各个时刻的速度,再由速度插值求积得到该时间段内各个时刻的位移。频域积分方法利用了谐波的位移函数等于加速度函数除以负的谐波圆频率的平方这一关系,在频域对代表加速度各个频率分量的复数做数乘运算,将得到频域位移信号变换为时域位移信号.
加速度数据做数值积分求位移的方法存在很大的误差。第一,每一步积分都累计了前一步的误差,每一次积分也累计了前一次的误差,这包括了截断误差和插值带来的误差;对于频域积分而言,由于傅里叶变换可能引起信号的泄露,一段加速度信号做傅里叶变换可能产生一些低频误差,这些误差在频域积分时会被显著地放大。因而这种算法往往不能求出正确的位移。
发明内容
针对现有技术中的上述不足,本发明提供了一种消除加速度计绝对测量漂移的方法。
为了达到上述发明目的,本发明采用的技术方案为:
一种消除加速度计绝对测量漂移的方法,包括如下步骤:
S1、获取一个时段的加速度信号,并将其拼接成为加速度信号数列;
S2、对步骤S1得到的加速度信号数列进行傅立叶变换,得到加速度信号的频域信号;
S3、将步骤S2得到的频域信号的零频分量移动到频谱中心形成新的数列,并对所形成的新的数列构造频率数列;
S4、对步骤S3构造的频率数列进行滤波,并根据滤波之后的频率数列计算频域位移,得到新的频域位移的多维向量;
S5、对步骤S4得到的多维向量进行逆零频平移,并对逆零频平移之后的多维向量做离散傅里叶逆变换,得到高频位移数列;
S6、获取与步骤S1同一时段的加速度信号,计算该时段内的低频位移并拼接成低频位移数列;
S7、对比步骤S5得到的高频位移数列和步骤S6得到的低频位移数列的长度,对元素少的一组数据通过插值至与另一组数据等长;
S8、对步骤S7处理后的低频位移数列进行高频滤波得到新的低频位移数列,将得到的新的低频位移数列和高频位移数列融合得到真实位移数列。
进一步的,所述步骤S2中加速度信号的频域信号表示为:
其中,a(n)为加速度信号中的元素,A(k)为加速度信号的频域信号中的元素,k为元素索引,N为元素个数;
进一步的,所述步骤S3中频域信号的零频分量移动到频谱中心形成新的数列具体方式为:
其中,A0为新的数列,A0(n)为A0中的元素。
进一步的,所述步骤S3中对所形成的新的数列构造频率数列的方式为:
其中F表示频率数列,F(n)为F中的元素。
进一步的,所述步骤S4中滤波的方式为:
对F中的每个元素,若|F(n)|<ft,则令A0中的对应元素A0(n)=0;若|F(n)|≥ft,则保留对应的A0(n)的数值,其中ft为滤波阈值频率。
进一步的,所述步骤S4中频域位移的多维向量表示为:
其中,D0(n)为新的频域位移的多维向量中的元素,A0(n)为经过滤波之后的频率数列中的元素,且当F(n)=0时,D0(n)=0。
进一步的,所述步骤S5中多维向量进行逆零频平移的具体方式为:
进一步的,所述步骤S5中高频位移数列表示为:
其中,d(n)为高频位移数列中的元素,D(k)为新的频域位移的多维向量中的第k个元素。
进一步的,所述步骤S8中真实位移数列的表示方式为:
m(n)=d(n)+u(n);
其中,m(n)为真实位移数列中的元素,u(n)为新的低频位移数列中的元素,d(n)为高频位移数列中的元素
本发明具有以下有益效果:
1、融合了加速度数据计算出的高频位移和滤波后的低频位移,得出准确的位移。
2、本方法基于傅里叶变换,目前傅里叶变换相关的数值方法非常成熟,容易获取。同时本方法逻辑清晰,步骤简单,易于编程实现。
3、与传统数值积分方法不同,本方法由加速度直接计算出位移,没有引入中间量,避免了误差的传递。
附图说明
图1为发明消除加速度计绝对测量漂移的方法的流程示意图。
图2为本发明实施例实验一的结果示意图。
图3为本发明实施例实验二的结果示意图。
图4为本发明实施例实验三的结果示意图。
具体实施方式
下面对本发明的具体实施方式进行描述,以便于本技术领域的技术人员理解本发明,但应该清楚,本发明不限于具体实施方式的范围,对本技术领域的普通技术人员来讲,只要各种变化在所附的权利要求限定和确定的本发明的精神和范围内,这些变化是显而易见的,一切利用本发明构思的发明创造均在保护之列。
一种消除加速度计绝对测量漂移的方法,其特征在于,包括如下步骤:
S1、获取一个时段的加速度信号,并将其拼接成为加速度信号数列;
对于本实施例而言,通过加速度计直接测量一段时间内测点的加速度信号,得到一个长度为N数列,记为a,a中每个元素a(n)代表n时刻测点的加速度数值,n=0,1,...,N-1。
S2、对步骤S1得到的加速度信号数列进行傅立叶变换,得到加速度信号的频域信号;
对于本实施例而言,对a做离散傅里叶变换,得到加速度的频域信号,长度为N,记为A,A中的每个元素k=0,1,...,N-1。其中,A(k)和A(N-k)表示频率为的信号分量,fs为加速度信号的采样频率。
S3、将步骤S2得到的频域信号的零频分量移动到频谱中心形成新的数列,并对所形成的新的数列构造频率数列;
本实施例里,将加速度频域信号的零频分量移动到频谱中心,形成一个新的数列,长度为N,记为A0。
构造一个代表A0中各个元素对应的频率的等差数列,长度为N,记为F。
S4、对步骤S3构造的频率数列进行滤波,并根据滤波之后的频率数列计算频域位移,得到新的频域位移的多维向量;
在本实施例里,对加速度信号滤波。对于F中的每个元素,若|F(n)|<ft,则令步骤S3得到的A0中的对应元素A0(n)=0;若|F(n)|≥ft,不做处理,n=0,1,...,N-1,其中ft为滤波的阈值频率,可根据实际指定。
S5、对步骤S4得到的多维向量进行逆零频平移,并对逆零频平移之后的多维向量做离散傅里叶逆变换,得到高频位移数列;
在本实施例里,逆零频平移D0得到D,
S6、获取与步骤S1同一时段的加速度信号,计算该时段内的低频位移并拼接成低频位移数列;
本实施例中采用其他方法,如水准测量直接测量同一时间段的低频位移,得到一个长度为L数列,记为u0,u0中每个元素u0(n)代表n时刻测点的低频位移数值,n=0,1,...,L-1。
S7、对比步骤S5得到的高频位移数列和步骤S6得到的低频位移数列的长度,对元素少的一组数据通过插值至与另一组数据等长;
对比步骤S5计算出高频位移数列d,对数据点少的一组数据样条插值至与另一组数据等长。插值后两组数据的长度相同,仍记为u0和d,长度记为K,K=max(N,L)。
S8、对步骤S7处理后的低频位移数列进行高频滤波得到新的低频位移数列,将得到的新的低频位移数列和高频位移数列融合得到真实位移数列。
对于步骤7处理后的低频位移u0,采用与前述方法相同的办法,滤除其高频成分,滤波阈值为ft,此处ft与步骤5中的ft相同,得到新的低频位移信号记为u。叠加u与d得到融合后的位移,记为m,m中每个元素m(n)=d(n)+u(n),n=0,1,...,K-1。
实例1.模拟信号
步骤二:对叠加后的位移信号求导两次得到加速度信号。
步骤三:按照本方法用步骤1得出的加速度信号求解位移,滤波阈值ft取1hz,将计算结果与模拟信号对比,结果如附图2。
实例2.模拟信号
步骤一:改变实例1中的参数,模拟与实例一相反的情况,即低频位移信号振幅小而高频位移信号振幅大。高频位移信号的初项为0,振幅为2mm、频率为5hz,低频位移信号的初项为振幅为20mm、频率为0.7hz。信号长度10s,采样频率为20hz。
步骤二:对叠加后的位移信号求导两次得到加速度信号。
步骤三:按照本方法用步骤1得出的加速度信号求解位移,滤波阈值ft取0.8hz,将计算结果与模拟信号对比,结果如附图3。
实例3.实测信号
步骤一:采用激光位移计、加速度计和某种低频位移计实际测量一时段内某振动装置的位移。
步骤二:按照本方法融合加速度信号计算出的高频位移与低频位移计测出的位移,滤波阈值ft取0.3hz,将计算结果与激光位移计的实测数据对比,结果如附图4。
以上三个实例表明本方法可以融合低频位移信号和加速度信号计算出准确的位移。
本发明是参照根据本发明实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
本发明中应用了具体实施例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处,综上所述,本说明书内容不应理解为对本发明的限制。
本领域的普通技术人员将会意识到,这里所述的实施例是为了帮助读者理解本发明的原理,应被理解为本发明的保护范围并不局限于这样的特别陈述和实施例。本领域的普通技术人员可以根据本发明公开的这些技术启示做出各种不脱离本发明实质的其它各种具体变形和组合,这些变形和组合仍然在本发明的保护范围内。
Claims (9)
1.一种消除加速度计绝对测量漂移的方法,其特征在于,包括如下步骤:
S1、获取一个时段的加速度信号,并将其拼接成为加速度信号数列;
S2、对步骤S1得到的加速度信号数列进行傅立叶变换,得到加速度信号的频域信号;
S3、将步骤S2得到的频域信号的零频分量移动到频谱中心形成新的数列,并对所形成的新的数列构造频率数列;
S4、对步骤S3构造的频率数列进行滤波,并根据滤波之后的频率数列计算频域位移,得到新的频域位移的多维向量;
S5、对步骤S4得到的多维向量进行逆零频平移,并对逆零频平移之后的多维向量做离散傅里叶逆变换,得到高频位移数列;
S6、获取与步骤S1同一时段的加速度信号,计算该时段内的低频位移并拼接成低频位移数列;
S7、对比步骤S5得到的高频位移数列和步骤S6得到的低频位移数列的长度,对元素少的一组数据通过插值至与另一组数据等长;
S8、对步骤S7处理后的低频位移数列进行高频滤波得到新的低频位移数列,将得到的新的低频位移数列和高频位移数列融合得到真实位移数列。
5.根据权利要求4所述的一种消除加速度计绝对测量漂移的方法,其特征在于,所述步骤S4中滤波的方式为:
对F中的每个元素,若|F(n)|<ft,则令A0中的对应元素A0(n)=0;若|F(n)|≥ft,则保留对应的A0(n)的数值,其中ft为滤波阈值频率。
9.根据权利要求8所述的一种消除加速度计绝对测量漂移的方法,其特征在于,所述步骤S8中真实位移数列的表示方式为:
m(n)=d(n)+u(n);
其中,m(n)为真实位移数列中的元素,u(n)为新的低频位移数列中的元素,d(n)为高频位移数列中的元素。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110686281.0A CN113405467B (zh) | 2021-06-21 | 2021-06-21 | 一种消除加速度计绝对测量漂移的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110686281.0A CN113405467B (zh) | 2021-06-21 | 2021-06-21 | 一种消除加速度计绝对测量漂移的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113405467A CN113405467A (zh) | 2021-09-17 |
CN113405467B true CN113405467B (zh) | 2022-08-02 |
Family
ID=77682007
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110686281.0A Active CN113405467B (zh) | 2021-06-21 | 2021-06-21 | 一种消除加速度计绝对测量漂移的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113405467B (zh) |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB2029581A (en) * | 1978-08-17 | 1980-03-19 | Huntec Ltd | Accelerometer noise signal reduction |
GB2158243A (en) * | 1984-05-05 | 1985-11-06 | Ferranti Plc | Accelerometer system |
WO2013104224A1 (zh) * | 2012-01-09 | 2013-07-18 | 中联重科股份有限公司 | 泵车臂架振动位移测量方法、设备、系统及工程机械设备 |
WO2015173408A1 (en) * | 2014-05-15 | 2015-11-19 | Stabilo International Gmbh | Electronic pen implementing sensor drift compensation |
CN105973189A (zh) * | 2016-05-05 | 2016-09-28 | 广西科技大学 | 软路面路面不平度加载谱的获取方法 |
KR20170049078A (ko) * | 2015-10-28 | 2017-05-10 | 고려대학교 산학협력단 | 가속도정보와 회전정보를 이용한 구조물 변위이력 측정방법 |
WO2018035658A1 (en) * | 2016-08-22 | 2018-03-01 | SZ DJI Technology Co., Ltd. | System and method for locating a moving object |
CN110031652A (zh) * | 2019-04-23 | 2019-07-19 | 中国科学院光电技术研究所 | 一种加速度计漂移和噪声的抑制方法 |
CN111964583A (zh) * | 2020-07-08 | 2020-11-20 | 瑞声新能源发展(常州)有限公司科教城分公司 | 马达振动位移估测方法、装置及介质 |
CN112461190A (zh) * | 2020-11-13 | 2021-03-09 | 合肥工业大学 | 一种桥梁变形重构方法 |
-
2021
- 2021-06-21 CN CN202110686281.0A patent/CN113405467B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB2029581A (en) * | 1978-08-17 | 1980-03-19 | Huntec Ltd | Accelerometer noise signal reduction |
GB2158243A (en) * | 1984-05-05 | 1985-11-06 | Ferranti Plc | Accelerometer system |
WO2013104224A1 (zh) * | 2012-01-09 | 2013-07-18 | 中联重科股份有限公司 | 泵车臂架振动位移测量方法、设备、系统及工程机械设备 |
WO2015173408A1 (en) * | 2014-05-15 | 2015-11-19 | Stabilo International Gmbh | Electronic pen implementing sensor drift compensation |
KR20170049078A (ko) * | 2015-10-28 | 2017-05-10 | 고려대학교 산학협력단 | 가속도정보와 회전정보를 이용한 구조물 변위이력 측정방법 |
CN105973189A (zh) * | 2016-05-05 | 2016-09-28 | 广西科技大学 | 软路面路面不平度加载谱的获取方法 |
WO2018035658A1 (en) * | 2016-08-22 | 2018-03-01 | SZ DJI Technology Co., Ltd. | System and method for locating a moving object |
CN110031652A (zh) * | 2019-04-23 | 2019-07-19 | 中国科学院光电技术研究所 | 一种加速度计漂移和噪声的抑制方法 |
CN111964583A (zh) * | 2020-07-08 | 2020-11-20 | 瑞声新能源发展(常州)有限公司科教城分公司 | 马达振动位移估测方法、装置及介质 |
CN112461190A (zh) * | 2020-11-13 | 2021-03-09 | 合肥工业大学 | 一种桥梁变形重构方法 |
Non-Patent Citations (2)
Title |
---|
Broad-band acceleration time histories synthesis by coupling low-frequency ambient seismic field and high-frequency stochastic modeling;L.Viens 等;《Geophysical Journal International》;20141031;第199卷(第3期);第1784-1797页 * |
加速度基线偏移频域处理的对比研究;缪惠全 等;《振动与冲击》;20160722;第35卷(第13期);第66-71页 * |
Also Published As
Publication number | Publication date |
---|---|
CN113405467A (zh) | 2021-09-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110807492B (zh) | 一种磁共振多参数同时定量成像方法及系统 | |
CN104199993B (zh) | 一种针对间歇过程的二维动态卡尔曼滤波器设计方法 | |
CN111538079B (zh) | 基于全波形反演技术确定地质裂缝柔度参数的方法及装置 | |
CN103115625A (zh) | 一种浮体横纵荡及升沉运动的测量方法及系统 | |
CN113405467B (zh) | 一种消除加速度计绝对测量漂移的方法 | |
CN110400331A (zh) | 深度图处理方法和装置 | |
CN104280047A (zh) | 一种多传感器融合的陀螺漂移滤波系统及方法 | |
Gdeisat et al. | Fast fringe pattern phase demodulation using FIR Hilbert transformers | |
CN109510543B (zh) | 一种伺服电机负载惯量的测定方法 | |
CN102903370B (zh) | 多速率系统的高速频率响应识别法和装置 | |
CN104734824A (zh) | 强噪声背景下混沌同步检测微弱周期信号的方法 | |
JPH11232250A (ja) | 3次元流れの有限要素解析法、解析装置、成形品を製造する製造方法および解析法のプログラムを記録した媒体 | |
CN115659871A (zh) | 一种局部坐标系下的一维水动力模拟方法及装置 | |
CN115062269A (zh) | 一种基于信息快速转换的空间域电磁场重构方法 | |
CN108814580A (zh) | 一种无接触式心率测试的方法及相关设备 | |
CN110457863B (zh) | 基于椭球收缩滤波的风力发电机桨距子系统参数估计方法 | |
CN103473477A (zh) | 基于改进卡尔曼滤波的变参数迭代估计方法 | |
Zhao et al. | Multiple transient extraction algorithm and its application in bearing fault diagnosis | |
CN107102056A (zh) | 缺陷漏磁信号的单元伸缩构建方法 | |
Chang et al. | Analysis of the dynamic characteristics of pressure sensors using ARX system identification | |
CN114821415B (zh) | 基于机器学习的视频微振动放大校准和实时提取方法 | |
Cedro | Identification of an electrically driven manipulator using the differential filters–input error method | |
Cedro | Identification of an electrically driven manipulator using the differential filters | |
CN112859170B (zh) | 一种基于时域高阶有限差分法的高精度波场数值模拟方法 | |
JP2007033195A (ja) | 磁気特性測定方法及び測定器 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |