CN108645396A - 一种大量程角速度传感器的角速度测量方法 - Google Patents
一种大量程角速度传感器的角速度测量方法 Download PDFInfo
- Publication number
- CN108645396A CN108645396A CN201810442731.XA CN201810442731A CN108645396A CN 108645396 A CN108645396 A CN 108645396A CN 201810442731 A CN201810442731 A CN 201810442731A CN 108645396 A CN108645396 A CN 108645396A
- Authority
- CN
- China
- Prior art keywords
- angular
- rate sensor
- accelerometers
- axis
- angular velocity
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 17
- 230000001133 acceleration Effects 0.000 claims abstract description 31
- 238000009434 installation Methods 0.000 claims abstract description 13
- 238000004364 calculation method Methods 0.000 claims abstract description 12
- 230000005484 gravity Effects 0.000 claims description 5
- 238000005259 measurement Methods 0.000 abstract description 11
- 238000010276 construction Methods 0.000 description 5
- 238000000691 measurement method Methods 0.000 description 4
- 230000001419 dependent effect Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
Classifications
-
- G01P9/02—
Landscapes
- Gyroscopes (AREA)
Abstract
本发明公开了一种大量程角速度传感器的角速度测量方法,包括以下步骤:首先在角速度传感器平面内,以120°等间隔扇形分布三个单轴加速度计,三个加速度计的敏感轴均指向角速度传感器的几何中心,其次在已知三个加速度计到角速度传感器几何中心距离的前提下,构建角速度传感器的线加速度、绕过角速度传感器几何中心且垂直于角速度传感器的旋转敏感轴的角速度与角速度传感器中三个加速度计输出之间的数学关系,并以此为基础进行角速度解算,然后考虑到安装时,角速度传感器的旋转敏感轴和被测载体的旋转轴之间可能存在安装误差,建立安装误差下的角速度解算方法。本发明解决了自由载体在高速旋转时的角速度测量问题。
Description
技术领域
本发明属于测控技术领域,特别涉及一种大量程角速度传感器的角速度测量方法。
背景技术
旋转载体的角速度测量对于载体的动态估计、姿态解算等均具有重要意义。目前常用的角速度测量方法分为两种,分别是基于编码器测量和基于惯性器件测量。其中,基于编码器的测量方法根据测量原理不同又可分为光电式、霍尔式等,其优点在于测量精度高,稳定性好。但由于此种测量方法需要分别将编码器的旋转端和非旋转端进行固定和安装,依赖于一定的机械结构,因此该方法的使用受到诸多限制,无法在自由旋转载体上进行应用。相比较于基于编码器的角速度测量方法,基于惯性器件的测量方法无需任何机械支撑结构,因此使用更加灵活,特别是在MEMS技术日趋成熟以后,MEMS惯性器件以其体积小、重量轻等优点,逐渐成为自由载体角速度测量的主要选择。但是,受限于陀螺仪的量程(通常小于±2000°/s),该方法对于高速旋转的载体,如高速行驶的汽车车轮等并不适用。
发明内容
发明目的:针对现有技术的问题,提供一种通过合理设计加速度计的分布方式和角速度解算方法,克服了现有基于惯性器件的角速度测量方法中陀螺仪量程过低问题的大量程角速度传感器的角速度测量方法。
技术方案:为解决上述技术问题,本发明提供一种大量程角速度传感器的角速度测量方法,其特征在于,包括如下步骤:
(1)在角速度传感器平面内,以120°等间隔扇形分布三个单轴加速度计,三个加速度计的敏感轴均指向角速度传感器的几何中心;
(2)构建角速度传感器的线加速度、绕过角速度传感器的旋转敏感轴的角速度与角速度传感器中三个加速度计输出之间的数学关系;
(3)解算角速度;
(4)建立安装误差下的角速度解算方法。
进一步的,所述步骤(2)中构建角速度传感器的线加速度、绕过角速度传感器的旋转敏感轴的角速度与角速度传感器中三个加速度计输出之间的数学关系,其具体步骤如下:
其中α1、α2、α3为角速度传感器中三个加速度计的输出加速度,α1为一号加速度计的输出加速度,α2为二号加速度计的输出加速度,α3为三号加速度计的输出加速度;ω为角速度传感器的旋转角速度;r为加速度计到角速度传感器的旋转敏感轴的距离;a为角速度传感器的线加速度包括重力加速度在内,在角速度传感器平面内的投影;θ为a与一号加速度计敏感轴的夹角;
在任意时刻,角速度传感器绕其旋转敏感轴的旋转角速度ω满足如下数学关系:
进一步的,所述步骤(4)中建立安装误差下的角速度解算方法的步骤为:
(4.1)当角速度传感器的旋转敏感轴与被测载体的旋转轴不重合时,计算角速度传感器中的三个加速度计到载体旋转轴的实际距离;
(4.2)构建角速度传感器的三个加速度计的输出与三个加速度计到被测载体旋转轴的距离的数学关系,并根据该数学关系计算载体的旋转角速度。
进一步的,所述步骤(4.1)中计算角速度传感器中的三个加速度计到载体旋转轴的实际距离的具体步骤如下:
其中d1、d2、d3为三个加速度计到被测载体旋转轴的距离,d1为一号加速度计到被测载体旋转轴的距离,d2为二号加速度计到被测载体旋转轴的距离,d3为三号加速度计到被测载体旋转轴的距离;r为加速度计到角速度传感器的旋转敏感轴的距离;Δx和Δy为载体旋转轴到角速度传感器的旋转敏感轴的距离在两个正交方向上的投影。
进一步的,所述步骤(4.2)中构建角速度传感器的三个加速度计的输出与
三个加速度计到被测载体旋转轴的距离的数学关系的具体步骤如下:
其中,θ1、θ2、θ3分别为所述d1、d2、d3与三个加速度计旋转敏感轴之间的夹角;
在任意时刻,角速度传感器绕其旋转敏感轴的旋转角速度ω满足如下数学关系:
与现有技术相比,本发明的优点在于:
通过三个单轴加速度计的合理分布,设计出一种大量程的角速度传感器,该角速度传感器通过加速度计的输出解算得到被测载体的旋转角速度。从角速度解算方法中可以看出,本发明设计的角速度传感器量程只与所选用单轴加速度计的量程以及加速度计到角速度传感器几何中心的距离有关。解决陀螺仪量程小、编码器受机械结构限制等问题,实现载体在单轴方向上高速旋转的角速度测量。该角度传感器能够应用于任何在单轴旋转的载体,具有很强的实用性。
附图说明
图1为本发明的方法流程图;
图2为本发明的角速度传感器结构示意图;
图3为实施例中安装误差下的角速度传感器的结构示意图。
具体实施方式
下面结合附图和具体实施方式,进一步阐明本发明。本发明描述的实施例仅仅是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动的前提下所得到的其他实施例,都属于本发明所保护的范围。
为了解决高速旋转载体的角速度测量问题,考虑采用拥有较大量程范围和较高精度的MEMS加速度计替代现有的陀螺仪测量测量方案,设计出一种适合高速旋转载体的角速度传感器。在使用加速度计进行角速度测量时,加速度计的分布方式和解算方法直接影响到角速度传感器的测量精度和存在安装误差时的测量结果可信度,也是本发明亟待解决的问题。
本发明包括以下步骤:
步骤一:在角速度传感器平面内,以120°等间隔扇形分布三个单轴加速度计,三个加速度计的敏感轴均指向角速度传感器的几何中心,如图1所示,图中:Or为角速度传感器的结构几何中心;A1、A2、A3为角速度传感器中三个加速度计的分布位置;α1、α2、α3为角速度传感器中三个加速度计的输出加速度;ω为角速度传感器的旋转角速度;r为单个加速度计到角速度传感器结构几何中心的距离;a为角速度传感器的线加速度(包括重力加速度在内)在角速度传感器平面内的投影;θ为a与一号加速度计敏感轴的夹角。
步骤二:在已知三个加速度计到角速度传感器几何中心距离的前提下,构建角速度传感器的线加速度、绕过角速度传感器几何中心且垂直于角速度传感器平面的旋转轴(角速度传感器的旋转敏感轴)的角速度与角速度传感器中三个加速度计输出之间的数学关系,并以此为基础进行角速度解算;
所述步骤二中在已知三个加速度计距离角速度传感器几何中心距离的前提下,构建角速度传感器的线加速度、绕过角速度传感器的旋转敏感轴的角速度与角速度传感器中三个加速度计输出之间的数学关系,具体如下:
式(1)中:α1、α2、α3为角速度传感器中三个加速度计的输出加速度;ω为角速度传感器的旋转角速度;r为单个加速度计到角速度传感器结构几何中心的距离;a为角速度传感器的线加速度(包括重力加速度在内)在角速度传感器平面内的投影;θ为a与一号加速度计敏感轴的夹角。
由式(1)可得,在角速度传感器绕其旋转敏感轴旋转时满足以下数学关系:
由式(2)可知,在任意时刻,角速度传感器绕其旋转敏感轴的旋转角速度ω满足如下数学关系:
因此,当角速度传感器的旋转敏感轴与被测载体的旋转轴重合时,载体的角速度可以通过公式(3)得到。
步骤三:考虑到安装时,角速度传感器的旋转敏感轴和被测载体的旋转轴之间可能存在安装误差,建立安装误差下的角速度解算方法。为了清楚阐述安装误差,定义高速旋转载体直角坐标系{OrXY},如图2所示,图中:Or角速度传感器的结构几何中心,Y-一号加速度计敏感轴直线方向;Or’为实际高速旋转载体的旋转轴;A1、A2、A3为角速度传感器中三个加速度计的分布位置;α1、α2、α3为角速度传感器中三个加速度计的输出加速度;ω为角速度传感器的旋转角速度;r为单个加速度计到角速度传感器结构几何中心的距离;a为角速度传感器的线加速度(包括重力加速度在内)在角速度传感器平面内的投影;θ为a与一号加速度计敏感轴的夹角;d1、d2、d3为三个加速度计到被测载体旋转轴的距离;r为加速度计到角速度传感器的旋转敏感轴的距离;Δx和Δy为载体旋转轴到角速度传感器的旋转敏感轴的距离在两个正交方向上(X轴和Y轴)的投影;θ1、θ2、θ3分别为d1、d2、d3与三个加速度计敏感轴之间的夹角。
当角速度传感器的旋转敏感轴与被测载体的旋转轴不重合时,角速度传感器中的三个加速度计到载体旋转轴的实际距离满足以下数学关系:
式(4)中:d1、d2、d3为三个加速度计到被测载体旋转轴的距离;r为加速度计到角速度传感器的旋转敏感轴的距离;Δx和Δy为载体旋转轴到角速度传感器的旋转敏感轴的距离在两个正交方向上(X轴和Y轴)的投影。
角速度传感器的三个加速度计的输出α1、α2、α3与所述三个加速度计到被测载体旋转轴的距离d1、d2、d3的数学关系表达式满足:
其中,θ1、θ2、θ3分别为所述d1、d2、d3与三个加速度计敏感轴之间的夹角。
由余弦定理可知,三个加速度计的输出α1、α2、α3与所述d1、d2、d3满足下列数学表达式:
将式(4)代入式(6)可以得到如下数学表达式:
高速旋转载体的旋转角速度ω可由式(7)求得,ω与三个加速度计的输出加速度的数学表达式如下:
可见,即使角速度传感器的旋转敏感轴与被测载体的旋转轴不重合,被测载体的角速度依然可以由角速度传感器的三个加速度计的输出解算得到。假设所述角速度传感器使用市面上常见的量程为±16g的单轴加速度计,旋转敏感轴为0.01m,可以测得最大转速±20r/s(约±7000°/s),远高于普通MEMS陀螺仪的量程(约±2000°/s)。
本发明揭示了一种大量程角速度传感器的设计方法。通过三个单轴加速度计的合理分布,设计出一种大量程的角速度传感器,该角速度传感器通过加速度计的输出解算得到被测载体的旋转角速度。从角速度解算方法中可以看出,本发明设计的角速度传感器量程只与所选用单轴加速度计的量程以及加速度计到角速度传感器几何中心的距离有关。解决陀螺仪量程小、编码器受机械结构限制等问题,实现载体在单轴方向上高速旋转的角速度测量。该角度传感器能够应用于任何在单轴旋转的载体,具有很强的实用性。
Claims (5)
1.一种大量程角速度传感器的角速度测量方法,其特征在于,包括如下步骤:
(1)在角速度传感器平面内,以120°等间隔扇形分布三个单轴加速度计,三个加速度计的敏感轴均指向角速度传感器的几何中心;
(2)构建角速度传感器的线加速度、绕过角速度传感器的旋转敏感轴的角速度与角速度传感器中三个加速度计输出之间的数学关系;
(3)解算角速度;
(4)建立安装误差下的角速度解算方法。
2.根据权利要求1所述的一种大量程角速度传感器的角速度测量方法,其特征在于,所述步骤(2)中构建角速度传感器的线加速度、绕过角速度传感器的旋转敏感轴的角速度与角速度传感器中三个加速度计输出之间的数学关系,其具体步骤如下:
其中α1、α2、α3为角速度传感器中三个加速度计的输出加速度,α1为一号加速度计的输出加速度,α2为二号加速度计的输出加速度,α3为三号加速度计的输出加速度;ω为角速度传感器的旋转角速度;r为加速度计到角速度传感器的旋转敏感轴的距离;a为角速度传感器的线加速度包括重力加速度在内,在角速度传感器平面内的投影;θ为a与一号加速度计敏感轴的夹角;
在任意时刻,角速度传感器绕其旋转敏感轴的旋转角速度ω满足如下数学关系:
3.根据权利要求1所述的一种大量程角速度传感器的角速度测量方法,其特征在于,所述步骤(4)中建立安装误差下的角速度解算方法的步骤为:
(4.1)当角速度传感器的旋转敏感轴与被测载体的旋转轴不重合时,计算角速度传感器中的三个加速度计到载体旋转轴的实际距离;
(4.2)构建角速度传感器的三个加速度计的输出与三个加速度计到被测载体旋转轴的距离的数学关系,并根据该数学关系计算载体的旋转角速度。
4.根据权利要求3所述的一种大量程角速度传感器的角速度测量方法,其特征在于,所述步骤(4.1)中计算角速度传感器中的三个加速度计到载体旋转轴的实际距离的具体步骤如下:
其中d1、d2、d3为三个加速度计到被测载体旋转轴的距离,d1为一号加速度计到被测载体旋转轴的距离,d2为二号加速度计到被测载体旋转轴的距离,d3为三号加速度计到被测载体旋转轴的距离;r为加速度计到角速度传感器的旋转敏感轴的距离;Δx和Δy为载体旋转轴到角速度传感器的旋转敏感轴的距离在两个正交方向上的投影。
5.根据权利要求4所述的一种大量程角速度传感器的角速度测量方法,其特征在于,所述步骤(4.2)中构建角速度传感器的三个加速度计的输出与三个加速度计到被测载体旋转轴的距离的数学关系的具体步骤如下:
其中,θ1、θ2、θ3分别为所述d1、d2、d3与三个加速度计旋转敏感轴之间的夹角;
在任意时刻,角速度传感器绕其旋转敏感轴的旋转角速度ω满足如下数学关系:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810442731.XA CN108645396B (zh) | 2018-05-10 | 2018-05-10 | 一种大量程角速度传感器的角速度测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810442731.XA CN108645396B (zh) | 2018-05-10 | 2018-05-10 | 一种大量程角速度传感器的角速度测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108645396A true CN108645396A (zh) | 2018-10-12 |
CN108645396B CN108645396B (zh) | 2021-04-27 |
Family
ID=63754325
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810442731.XA Active CN108645396B (zh) | 2018-05-10 | 2018-05-10 | 一种大量程角速度传感器的角速度测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108645396B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH1151958A (ja) * | 1997-08-06 | 1999-02-26 | Techno Rinku:Kk | 6軸運動計測方法およびその装置 |
US20060185432A1 (en) * | 2005-01-13 | 2006-08-24 | Harvey Weinberg | Five degree of freedom intertial measurement device |
CN1851473A (zh) * | 2006-05-23 | 2006-10-25 | 山西科泰微技术有限公司 | 角速度测量方法及测量装置 |
CN102353802A (zh) * | 2011-07-01 | 2012-02-15 | 哈尔滨工程大学 | 一种基于全加速度计的运动载体角速度测量方法 |
CN102435181A (zh) * | 2011-11-01 | 2012-05-02 | 深圳市中兴移动通信有限公司 | 一种基于加速度传感器的陀螺仪及定位方法 |
CN104061922A (zh) * | 2014-06-23 | 2014-09-24 | Tcl通讯(宁波)有限公司 | 一种移动终端陀螺仪量程设置方法、系统及移动终端 |
CN206113955U (zh) * | 2016-08-03 | 2017-04-19 | 北京华航航宇科技有限公司 | 一种基于六加速度计无陀螺惯性测量单元结构 |
-
2018
- 2018-05-10 CN CN201810442731.XA patent/CN108645396B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH1151958A (ja) * | 1997-08-06 | 1999-02-26 | Techno Rinku:Kk | 6軸運動計測方法およびその装置 |
US20060185432A1 (en) * | 2005-01-13 | 2006-08-24 | Harvey Weinberg | Five degree of freedom intertial measurement device |
CN1851473A (zh) * | 2006-05-23 | 2006-10-25 | 山西科泰微技术有限公司 | 角速度测量方法及测量装置 |
CN102353802A (zh) * | 2011-07-01 | 2012-02-15 | 哈尔滨工程大学 | 一种基于全加速度计的运动载体角速度测量方法 |
CN102435181A (zh) * | 2011-11-01 | 2012-05-02 | 深圳市中兴移动通信有限公司 | 一种基于加速度传感器的陀螺仪及定位方法 |
CN104061922A (zh) * | 2014-06-23 | 2014-09-24 | Tcl通讯(宁波)有限公司 | 一种移动终端陀螺仪量程设置方法、系统及移动终端 |
CN206113955U (zh) * | 2016-08-03 | 2017-04-19 | 北京华航航宇科技有限公司 | 一种基于六加速度计无陀螺惯性测量单元结构 |
Non-Patent Citations (2)
Title |
---|
丁明理等: "无陀螺惯性测量组合研究现状概述", 《中国惯性技术学报》 * |
肖伟光等: "九加速度计NGMIMU实用设计方案", 《宇航学报》 * |
Also Published As
Publication number | Publication date |
---|---|
CN108645396B (zh) | 2021-04-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102066875B (zh) | 测斜仪测量系统和提供用于运动诱导加速度误差的校正的方法 | |
US6738721B1 (en) | Method for improving the measurement values of an inertial measurement system | |
JP4586172B2 (ja) | 慣性航法システム | |
CN201561759U (zh) | 惯性姿态方位测量装置 | |
CN104792323B (zh) | 动态水平仪及姿态角计算方法 | |
CN103712622B (zh) | 基于惯性测量单元旋转的陀螺漂移估计补偿方法及装置 | |
CN103727939B (zh) | 一种双轴旋转的姿态测量系统及其测量方法 | |
CN110887505A (zh) | 一种冗余式惯性测量单元实验室标定方法 | |
CN104848818B (zh) | Stewart平台姿态测量装置及测量方法 | |
JP2003502681A (ja) | 角度センサのオフセット補償方法 | |
TWI407102B (zh) | 三維空間運動感測方法 | |
CN107202578A (zh) | 一种基于mems技术的捷联式垂直陀螺仪解算方法 | |
CN112567097A (zh) | 用于确定机器的作业设备的角度的方法 | |
JP2007263689A (ja) | 外部情報を得られない環境における装置の方位計測方法 | |
CN105444722A (zh) | 检测平台姿态变化的方法 | |
CN107063181A (zh) | 复杂环境下多功能调试台的水平倾角的测量方法及装置 | |
WO2010030565A1 (en) | Magnetic sensing device for navigation and detecting inclination | |
JP2001174283A (ja) | 回転飛翔体の姿勢測定装置 | |
CN103411625B (zh) | 动力调谐陀螺测斜仪的标定补偿方法及标定补偿模型 | |
CN108645396A (zh) | 一种大量程角速度传感器的角速度测量方法 | |
CN111457920B (zh) | 一种基于加速度计的旋转角度测量方法 | |
WO2012046508A1 (ja) | 移動軌跡検知装置 | |
US20220018484A1 (en) | Systems and methods for travel distance measurement | |
CN110542430B (zh) | 一种惯性测量单元大动态性能测试装置及方法 | |
JPH11295335A (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 |