CN201107038Y - 姿态角度测量装置 - Google Patents
姿态角度测量装置 Download PDFInfo
- Publication number
- CN201107038Y CN201107038Y CNU2007200167880U CN200720016788U CN201107038Y CN 201107038 Y CN201107038 Y CN 201107038Y CN U2007200167880 U CNU2007200167880 U CN U2007200167880U CN 200720016788 U CN200720016788 U CN 200720016788U CN 201107038 Y CN201107038 Y CN 201107038Y
- Authority
- CN
- China
- Prior art keywords
- rate sensor
- angular rate
- attitude angle
- voltage signal
- analog voltage
- 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.)
- Expired - Fee Related
Links
- 238000006243 chemical reaction Methods 0.000 claims abstract description 15
- XUIMIQQOPSSXEZ-UHFFFAOYSA-N Silicon Chemical compound [Si] XUIMIQQOPSSXEZ-UHFFFAOYSA-N 0.000 claims abstract description 6
- 229910052710 silicon Inorganic materials 0.000 claims abstract description 6
- 239000010703 silicon Substances 0.000 claims abstract description 6
- 230000003068 static effect Effects 0.000 claims abstract description 6
- 238000005259 measurement Methods 0.000 claims description 13
- 238000001914 filtration Methods 0.000 abstract description 36
- 238000000034 method Methods 0.000 abstract description 12
- 238000012545 processing Methods 0.000 abstract description 5
- 238000000691 measurement method Methods 0.000 abstract description 3
- 230000035945 sensitivity Effects 0.000 abstract 1
- 108010076504 Protein Sorting Signals Proteins 0.000 description 8
- 230000010354 integration Effects 0.000 description 8
- 238000010586 diagram Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 238000011002 quantification Methods 0.000 description 3
- 238000009434 installation Methods 0.000 description 2
- 238000013139 quantization Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 238000012549 training Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000004020 conductor Substances 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 230000035939 shock Effects 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Landscapes
- Gyroscopes (AREA)
Abstract
本实用新型涉及姿态角测量技术，具体地说是一种姿态角度测量方法装置。包括：角速率传感器，自身的轴向在安装时与被测物体的被测轴平行；低通滤波器，接收处于静止/运动状态的角速率传感器输出的模拟电压信号，对模拟电压信号除噪处理后的输出信号接至A/D采集转换模块；A/D采集转换模块，进行数据采集、模/数转换经运行于计算机的数据处理程序模块。所述角速率传感器采用高灵敏度的硅性MEMS陀螺。与传统方法相比，本实用新型可以在低频范围内获得很高的角度分辨率，并且可以通过改变数字滤波的参数在分辨率和实时性间进行调整。
Description
技术领域
本实用新型涉及姿态角测量技术，具体地说是一种高分辨率姿态角度测量装置，能被应用在需要测量如导航、机器人、模拟训练设备等领域。
背景技术
姿态角测量技术广泛应用于航空航天、制导、模拟训练设备、机器人技术等诸多领域中。姿态角的测量通常采用光电编码器、角速率传感器或电子罗盘等作为测角组件。其中，光电编码器需要与被测物同轴且体积较大，影响被测系统的设计，且不便于安装；地磁传感器受磁场干扰且分辨率较低。而角速率传感器具有灵敏度高、体积小、功耗小、便于安装等特点，用角速率传感器作为测角组件进行高分辨率的姿态角度测量被越来越广泛地应用。
采用角速率传感器的系统一般是将传感器输出的模拟电压信号直接进行采样量化，将其与角速率传感器标称的零点电压的差值数值积分得到角度；或者采用带有数字量输出的角速率传感器，这种角速率传感器只是将采样和量化集成在其内部，并没有加进的滤波功能，并且一般为串口输出，输出的速率较低，不能进行较复杂的后续数字滤波。由于角速率传感器的噪声和信号导线引入的噪声较大，这两种方法都不能很好地去除噪声，影响测量角度的分辨率。
实用新型内容
为了克服现有技术中噪声大、分辨率低的不足，本实用新型的目的在于提供一种噪声小、能提高角度测量分辨率的姿态角度测量装置。
本实用新型解决其技术问题所采用的技术方案包括：
角速率传感器，自身的轴向在安装时与被测物体的被测轴平行；
低通滤波器，接收处于静止/运动状态的角速率传感器输出的模拟电压信号，对模拟电压信号除噪处理后的输出信号接至A/D采集转换模块；
A/D采集转换模块，进行数据采集、模/数转换经运行于计算机的数据处理程序模块。
其中所述角速率传感器采用高灵敏度的硅性MEMS陀螺。
本实用新型的有益效果是：
1.噪声小、角度测量的分辨率高。本实用新型通过软硬件滤波相结合的方法，可以很好地消除高频噪声，如：用高速的A/D采集转换模块完成采样量化，保证了采样速度和量化精度；通过RC低通滤波能较好地去除传感器的噪声；而LMS数字滤波能进一步消除传感器的噪声和导线引入的噪声；能够得到较准确的传感器实际零点电压。这些都保证了这种方法可以获得更高的角度分辨率。与传统方法相比，可以在低频范围内获得很高的角度分辨率(本实施例采用分辨率为0.05度/秒的型号为Gyro1050的陀螺，模拟电压信号输出范围是0-5伏，经过上述处理后，其角度分辨率可以达到0.00025度)，并且可以通过改变滤波器的参数在分辨率和实时性间进行调整。
2.由于采用硅性MEMS陀螺，使本实用新型具有体积小、重量轻、灵敏度高、线形度好的特点，并且安装简便，不影响被测量物体的机械结构。
附图说明
图1a为本实用新型数字滤波算法原理图(实际零点电压的获取)。
图1b为本实用新型数字滤波算法原理图(姿态角度的计算)。
图2为本实用新型结构原理图。
图3为本实用新型信号处理流程图。
图4为图2中低通滤波器原理图。
图5为数据处理程序模块流程图。
具体实施方式
下面通过结合附图对本实用新型作进一步详细说明。
高分辨率姿态角度测量方法：取处于静止状态的角速率传感器输出的模拟电压信号，对模拟电压信号进行低通滤波去除高频部分，然后进行信号采集和模/数转换，将其转换为电压信号序列V[n]。数据处理程序模块按照最小均方差(LMS)算法对电压信号进行数字滤波，再经均值滤波，获得实际零点电压；再用实际零点电压与后续处于运动情况，依次经RC低通滤波、采集和模/数转换、最小均方差数字滤波及均值滤波的电压信号序列进行比较，对所得的差值积分得到姿态角度值。与传统方法相比，本实用新型可以在低频范围内获得很高的角度分辨率，并且可以通过改变数字滤波的参数在分辨率和实时性间进行调整。
所述最小均方差(LMS)数字滤波算法是通过如式(1)的迭代运算，根据数据不断修正自身的滤波系数wi，以使滤波后的电压序列V’收敛于经过滤波的电压值V’和经采样转换后的电压序列V的均方差最小的值。通过调整系数更新幅度η和滤波器的长度M，可以调整收敛速度，从而在精度的实时性(收敛速度)间进行调整。本实施例幅度η＝0.01，滤波系数的长度M＝10。
公式为：
其中：wi＝wi+η(V′j-Vj-M)Vj-M，j＝M，M+1，...，n+M(M＜N)
V是经采样转换后的电压序列；w是滤波系数；V’是经过滤波的电压值；η是系数更新幅度。
参见图1a，实际零点电压的计算过程：电压信号序列V[n]的前n个电压数据V[0，1，2，...，n-1]经过LMS数字滤波和均值滤波，得到实际零点电压Vc，代表角速率为零(静止时)的角速率传感器的输出的电压值，作为比较基准，后续处于运动情况且依次经RC低通滤波、采集和模/数转换、最小均方差数字滤波及均值滤波的电压信号序列与实际零点电压Vc偏差代表角速率传感器转动的角速率。公式如下：
ω＝(V’-Vc)/f (2)
其中：ω为角速率，单位是度/秒；V’是经过滤波的电压值；f是电压与角速率的转换关系，由角速率传感器说明书标明。
参见图1b，姿态角度的计算过程：后续经过采集和模/数转换的模拟电压信号数据V[n，n+1，n+2，...]先经过RC低通滤波、LMS滤波和均值滤波得到经过滤波的电压值V’，然后与实际零点电压Vc比较，对所得的差值进行数值积分(求和)即可得到高分辨率的姿态角度。公式如下：
α＝∑ω·Δt (3)
其中：α是角度值，单位为度；ω在式(2)中定义；Δt是采样周期，单位为秒。
参见图2，本实用新型高分辨率姿态角度测量装置：包括角速率传感器、低通滤波器、A/D采集转换模块和运行于计算机的数据处理程序模块。其中，角速率传感器安装时应使自身的轴向与被测物体的被测轴平行，处于静止/运动状态的角速率传感器的输出电压为0-X(伏)的模拟电压信号(本实施例X为5伏)，送至低通滤波器输入端，经过低通滤波器的低通滤波后送至A/D采集转换模块，经采集、量化后通过数据处理程序模块进行数字滤波和数值积分，得到具有高分辨率的姿态角度。
参见图3，本实用新型装置的信号处理过程如下：
角速率传感器输出的是零点电压为0-X(V)的模拟电压信号，经过低通滤波(RC电路)后，被去除高频部分，并被A/D采集转换模块进行数据采集和模/数转换得到成一个量化的电压信号序列V[n]，并按照最小均方差数字滤波算法对其进行数字滤波，结果再被均值滤波后，得到实际零点电压Vc。再将后续运动的传感器输出的模拟电压信号，即：依次经低通滤波(RC)、采集和模/数转换、最小均方差数字滤波及均值滤波的电压信号序列与Vc比较，对所得的差值序列进行比例变换和数值积分得到姿态角度值。
本实施例采用高灵敏度的硅性MEMS陀螺作为角速率传感器，用RC低通滤波器加最小均方差数字滤波算法在低频范围内对其输出信号进行模拟和数字滤波，数值积分后获得高分辨率的角度信号。本实施例采用分辨率为0.05度/秒的型号为Gyro1050的陀螺，模拟电压信号输出范围是0-5伏，经过上述处理后，其角度分辨率可以达到0.00025度。
所述硅性MEMS(微型机电)陀螺具有灵敏度高、线形度好、动态范围大、抗震性强等优点。其输出是一个标称零点电压为V0(伏)的模拟电压量。角速率传感器的模拟电压信号与说明书中标明的额定零点电压的偏差表征角速率，两者为正比关系。这样，测得输出电压，并与零点电压比较后，偏差电压即可按所述正比关系转换为角速率，对其数值积分即可得到角度。
图4为低通滤波器原理图。本实施例采用由电阻和电容构成的RC低通滤波器，两者的值决定滤波器的截止频率，通常有-6dB截止频率＝1/(2*3.14*R*C)(Hz)，本实施例采用10Hz截止频率。
RC低通滤波器用于滤除高频变化的传感器模拟信号(一般被视为噪声)。可以通过调整电阻和电容的值来设定其截至频率。模拟信号经过RC低通滤波器后，绝大部分的高频噪声被滤掉，但仍需进一步的数字滤波才能获得更高的精度。
所述A/D采集转换模块配有高速高精度的PCI接口，带有硬件先进先出缓存(FIFO)，可以保证不会丢失数据。A/D采集转换模块对经过RC低通滤波后的模拟电压信号进行不间断地采集量化，然后存放到缓冲区中，供数据处理程序模块进行滤波。
参见图5，所述数据处理程序模块是一个多线程程序，具有两个线程。主线程首先设置A/D采集转换模块参数，开始不间断的采样转换，再将采样转换填充至先进先出缓存FIFO；然后启动辅助线程。辅助线程检查A/D采集转换模块的先进先出缓存(FIFO)的状态，当其达到或超过半满或时，将数据放置到电压信号序列V[n]中，再对电压信号序列V[n]进行最小均方差数字滤波、均值滤波和数值积分，得出姿态角度值。两个线程之间是异步关系，同时执行，在数字滤波的同时不间断采样，提高了效率。
Claims (2)
1.一种姿态角度测量装置，其特征在于包括：
角速率传感器，自身的轴向在安装时与被测物体的被测轴平行；
低通滤波器，接收处于静止/运动状态的角速率传感器输出的模拟电压信号，对模拟电压信号除噪处理后的输出信号接至A/D采集转换模块；
A/D采集转换模块，进行数据采集、模/数转换经运行于计算机的数据处理程序模块。
2.根据权利要求1所述姿态角度测量装置，其特征在于：所述角速率传感器采用高灵敏度的硅性MEMS陀螺。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CNU2007200167880U CN201107038Y (zh) | 2007-12-12 | 2007-12-12 | 姿态角度测量装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CNU2007200167880U CN201107038Y (zh) | 2007-12-12 | 2007-12-12 | 姿态角度测量装置 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN201107038Y true CN201107038Y (zh) | 2008-08-27 |
Family
ID=39958845
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CNU2007200167880U Expired - Fee Related CN201107038Y (zh) | 2007-12-12 | 2007-12-12 | 姿态角度测量装置 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN201107038Y (zh) |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101976048A (zh) * | 2010-08-25 | 2011-02-16 | 中国兵器工业第二〇五研究所 | 手柄控制器信号处理方法 |
| CN102636150A (zh) * | 2012-04-28 | 2012-08-15 | 北京航空航天大学 | 一种快速确定空间轴对称刚体目标姿态角的方法 |
| CN107402003A (zh) * | 2016-05-20 | 2017-11-28 | 北京自动化控制设备研究所 | 一种基于信息融合滤波的陀螺稳定座架角度确定方法 |
| CN111693019A (zh) * | 2020-05-20 | 2020-09-22 | 西安交通大学 | 一种姿态传感装置及数据融合、姿态解算方法 |
-
2007
- 2007-12-12 CN CNU2007200167880U patent/CN201107038Y/zh not_active Expired - Fee Related
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101976048A (zh) * | 2010-08-25 | 2011-02-16 | 中国兵器工业第二〇五研究所 | 手柄控制器信号处理方法 |
| CN101976048B (zh) * | 2010-08-25 | 2012-07-04 | 中国兵器工业第二〇五研究所 | 手柄控制器信号处理方法 |
| CN102636150A (zh) * | 2012-04-28 | 2012-08-15 | 北京航空航天大学 | 一种快速确定空间轴对称刚体目标姿态角的方法 |
| CN107402003A (zh) * | 2016-05-20 | 2017-11-28 | 北京自动化控制设备研究所 | 一种基于信息融合滤波的陀螺稳定座架角度确定方法 |
| CN107402003B (zh) * | 2016-05-20 | 2021-06-08 | 北京自动化控制设备研究所 | 一种基于信息融合滤波的陀螺稳定座架角度确定方法 |
| CN111693019A (zh) * | 2020-05-20 | 2020-09-22 | 西安交通大学 | 一种姿态传感装置及数据融合、姿态解算方法 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN201107038Y (zh) | 姿态角度测量装置 | |
| CN111537789A (zh) | 一种基于信号分离和精准积分的直流电能计量装置及方法 | |
| CN209656731U (zh) | 一种石英挠性加速度计数字输出伺服电路 | |
| CN110108299A (zh) | 一种硅微机械陀螺仪标度因数在线自校准系统 | |
| CN101458096A (zh) | 一种高分辨率姿态角度测量方法及装置 | |
| CN103344825A (zh) | 基于交流采样的电能计量系统 | |
| CN107687875B (zh) | 一种测量含气导电液体流量的电磁式涡街流量计 | |
| CN103207010A (zh) | 一种高精度加速度信号检测及分析装置 | |
| CN104749077A (zh) | 一种基于超声波的悬浮液粒子浓度检测系统 | |
| CN108333420A (zh) | 一种低频正弦信号峰值检测装置和峰值检测方法 | |
| CN103616064A (zh) | 长台面动态轨道衡称重系统 | |
| CN100458864C (zh) | 提高微弱信号采集精度的方法与电路 | |
| CN103123361B (zh) | Mems角速度和加速度传感器自动标定方法及其系统 | |
| CN105674956B (zh) | 一种风电机组塔体倾斜度测量系统 | |
| CN202886471U (zh) | 多通道泄露电流相位差检测设备 | |
| CN115790736B (zh) | 一种用于检测旋进漩涡频率信号的传感器 | |
| CN202002724U (zh) | 自校准三轴振动监测及环境监测采集装置 | |
| CN102852128A (zh) | 一种静力触探仪的测探方法 | |
| CN219870208U (zh) | 基于变电容式加速度计的大型斜拉式桥梁挠度监测装置 | |
| CN205015079U (zh) | 一种输电线路微风振动监测装置 | |
| CN2569144Y (zh) | γ射线河流泥沙含量及流速智能测量仪 | |
| CN206479651U (zh) | 一种具有姿态记录功能的地空tem接收系统 | |
| CN101509928A (zh) | 通过排气压力检测发动机转速的装置 | |
| CN206489214U (zh) | 一种航空电磁法地面异常环感应电流采集装置 | |
| CN213481234U (zh) | 一种基于纳米电容传感器的无线测量系统 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| C17 | Cessation of patent right | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20080827 Termination date: 20111212 |