CN111457920B - 一种基于加速度计的旋转角度测量方法 - Google Patents
一种基于加速度计的旋转角度测量方法 Download PDFInfo
- Publication number
- CN111457920B CN111457920B CN202010299905.9A CN202010299905A CN111457920B CN 111457920 B CN111457920 B CN 111457920B CN 202010299905 A CN202010299905 A CN 202010299905A CN 111457920 B CN111457920 B CN 111457920B
- Authority
- CN
- China
- Prior art keywords
- accelerometer
- axis
- rotation
- accelerometers
- rotation angle
- 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
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Abstract
本发明公开了一种基于加速度计的旋转角度测量方法,包括以下步骤:首先在旋转角度传感器测量平面内,以旋转中心O,夹角为扇形分布两个双轴加速度计,分别为1号和2号,然后将旋转角度传感器绕旋转中心高速转动,通过测量1号和2号加速度计x轴的最大加速度和z轴的最大加速度,求得两个加速度计需要旋转一定角度,使其z轴指向旋转中心。接着在静止状态下测量出两个加速度计x轴的加速度,并通过数学推导求得两个加速度计安装位置所成夹角,最后,通过两个加速度计测量旋转角度传感器的旋转角度。本发明能够消除安装位置误差对于旋转角度解算的影响。
Description
技术领域
本发明属于测控技术领域,特别涉及一种基于加速度计的旋转角度测量方法。
背景技术
旋转载体的角度测量对于载体的动态估计、姿态解算等均具有重要意义。目前常用的旋转角度测量方法分为两种,分别是基于编码器测量和基于惯性器件测量。其中,基于编码器的测量方法根据测量原理不同又可分为光电式、霍尔式等,其优点在于测量精度高,稳定性好。但由于此种测量方法需要分别将编码器的旋转端和非旋转端进行固定和安装,依赖于一定的机械结构,因此该方法的使用受到诸多限制,无法在自由旋转载体上进行应用。相比较于基于编码器的角度测量方法,基于惯性器件的测量方法无需任何机械支撑结构,因此使用更加灵活,特别是在MEMS技术日趋成熟以后,MEMS惯性器件以其体积小、重量轻等优点,逐渐成为自由载体角速度测量的主要选择。但是,由于陀螺仪的量程(通常小于±2000°/s),所以不具备测量的通用性。
发明内容
发明目的:针对上述缺陷,本发明提供一种基于加速度计的旋转角度测量方法,通过合理设计加速度计的分布方式和旋转角度解算方法,克服了由于安装位置对旋转角度解算带来的影响,同时为代替编码器进行角度测量提供一种可行方案。
技术方案:本发明提出一种基于加速度计的旋转角度测量方法,包括如下步骤:
步骤一:在旋转角度传感器测量平面内,以旋转中心O,夹角为Δθ扇形分布两个双轴加速度计,分别为1号和2号,首先将旋转角度传感器绕旋转中心高速转动,然后通过测量1号加速度计x轴的最大加速度和z轴的最大加速度,求得1号加速度计需要旋转一定角度,使其z轴指向旋转中心。同理,将2号加速度计的z轴指向旋转中心;
步骤二:根据步骤一中的旋转角度传感器,在静止状态下测量出两个加速度计x轴的加速度,并通过数学推导求得两个加速度计安装位置所成夹角;
步骤三:经过步骤一和步骤二标定后,即使重力加速度出现偏差时,也能通过两个加速度计测量旋转角度传感器的旋转角度。
进一步的,所述的步骤一中,在旋转角度传感器测量平面内,以旋转中心O,夹角为Δθ,半径为r扇形分布两个双轴加速度计,分别为1号和2号,首先将旋转角度传感器以角速度ω绕旋转中心高速转动,然后通过测量1号加速度计x轴的最大加速度ax1max和z轴的最大加速度az1max,求得1号加速度计需要旋转α1°,使其z轴指向旋转中心。具体数学关系如下:
同理,通过测量2号加速度计x轴的最大加速度ax2max和z轴的最大加速度az2max,求得2号加速度计需要旋转α2°,使其z轴指向旋转中心。
进一步的,所述步骤二中通过数学推导求得两个加速度计安装位置所成夹角具体为:当无法确定1号加速计和2号加速度计安装位置所成夹角时,通过在静止状态下测量出两个加速度计x轴的加速度ax1和ax2,并通过数学推导求得两个加速度计安装位置所成夹角Δθ。具体数学关系如下:
其中β为1号加速度计z轴与重力加速度之间的夹角。
Δθ取正值,且Δθ<2π,其中g为重力加速度。
进一步的,所述步骤三中实现旋转角度测量具体为:当经过所述步骤一和所述步骤二进行标定后,当由于振动等因素造成g出现偏差时,此时为仍然可以通过测量1号和2号加速度计x轴的加速度ax1和ax2求得1号加速度计的z轴与重力加速度之间的夹角从而实现旋转角度的测量。
可见,即使无法精确知道两个加速度计分布所成夹角以及由于振动等造成的重力加速度也能通过上述步骤进行旋转角度的解算。
本发明解决了旋转载体的旋转角度测量问题,考虑采用较高精度的MEMS加速度计替代现有的编码器测量方案,设计出一种基于加速度计的旋转角度传感器。在使用加速度计进行旋转角度测量时,加速度计的安装位置的偏差和解算方法很大程度上影响了旋转角度的准确性,因此本发明设计了一种通用的加速度计分布方式,能够消除安装位置误差对于旋转角度解算的影响。
本发明采用上述技术方案,具有以下有益效果:
本发明通过两个双轴加速度计的合理分布,设计出一种基于加速度计的旋转角度传感器,该旋转角度传感器通过两个加速度计的输出得到被测载体的旋转角度。从旋转角度解算方法中可以看出,本发明设计的旋转角度传感器不会因为两个加速度计分布所成夹角的误差以及由于振动等原因造成的输出重力加速度的偏差而导致角度解算的误差。解决陀螺仪量程小、编码器受机械结构限制等问题,实现载体在单轴方向上旋转角度测量。该旋转角度传感器能够应用于任何在单轴旋转的载体,具有很强的实用性。
附图说明
图1为本发明的流程图;
图2为具体实施例中基于加速度计的旋转角度传感器的结构示意图。
具体实施方式
下面结合具体实施例,进一步阐明本发明,应理解这些实施例仅用于说明本发明而不用于限制本发明的范围,在阅读了本发明之后,本领域技术人员对本发明的各种等价形式的修改均落于本申请所附权利要求所限定的范围。
下面结合附图对本发明实施方法做更详细的描述。
如图1所示,本发明所述的一种基于加速度计的旋转角度测量方法,包括如下步骤:
步骤一:在旋转角度传感器测量平面内,以旋转中心O,夹角为Δθ扇形分布两个双轴加速度计,分别为1号和2号,首先将旋转角度传感器绕旋转中心高速转动,然后通过测量1号加速度计x轴的最大加速度和z轴的最大加速度,求得1号加速度计需要旋转一定角度,使其z轴指向旋转中心。同理,将2号加速度计的z轴指向旋转中心。
进一步的,所述的步骤一中,在旋转角度传感器测量平面内,以旋转中心O,夹角为Δθ,半径为r扇形分布两个双轴加速度计,分别为1号和2号,首先将旋转角度传感器以角速度ω绕旋转中心高速转动,然后通过测量1号加速度计x轴的最大加速度ax1max和z轴的最大加速度az1max,求得1号加速度计需要旋转α1°,使其z轴指向旋转中心。具体数学关系如下:
同理,通过测量2号加速度计x轴的最大加速度ax2max和z轴的最大加速度az2max,求得2号加速度计需要旋转α2°,使其z轴指向旋转中心。
步骤二:根据步骤一中的旋转角度传感器,在静止状态下测量出两个加速度计x轴的加速度,并通过数学推导求得两个加速度计安装位置所成夹角。
进一步的,所述步骤二中通过数学推导求得两个加速度计安装位置所成夹角具体为:当无法确定1号加速计和2号加速度计安装位置所成夹角时,通过在静止状态下测量出两个加速度计x轴的加速度ax1和ax2,并通过数学推导求得两个加速度计安装位置所成夹角Δθ。具体数学关系如下:
其中β为1号加速度计z轴与重力加速度之间的夹角。
Δθ取正值,且Δθ<2π,其中g为重力加速度。
步骤三:经过步骤一和步骤二标定后,即使重力加速度出现偏差时,也能通过两个加速度计测量旋转角度传感器的旋转角度。
进一步的,所述步骤三中实现旋转角度测量具体为:当经过所述步骤一和所述步骤二进行标定后,当由于振动等因素造成g出现偏差时,此时为仍然可以通过测量1号和2号加速度计x轴的加速度ax1和ax2求得1号加速度计的z轴与重力加速度之间的夹角从而实现旋转角度的测量。
可见,即使无法精确知道两个加速度计分布所成夹角以及由于振动等造成的重力加速度也能通过上述步骤进行旋转角度的解算。
本发明揭示了一种基于加速度计的旋转角度传感器的设计方法。通过两个双轴加速度计的合理分布,设计出一种基于加速度计的旋转角度传感器,该旋转角度传感器通过两个加速度计的输出得到被测载体的旋转角度。从旋转角度解算方法中可以看出,本发明设计的旋转角度传感器不会因为两个加速度计分布所成夹角的误差以及由于振动等原因造成的输出重力加速度的偏差而导致角度解算的误差。解决陀螺仪量程小、编码器受机械结构限制等问题,实现载体在单轴方向上旋转角度测量。该旋转角度传感器能够应用于任何在单轴旋转的载体,具有很强的实用性。
Claims (4)
1.一种基于加速度计的旋转角度测量方法,其特征在于,包括如下步骤:
(1)在旋转角度传感器测量平面内,以旋转中心O,夹角为Δθ扇形分布两个双轴加速度计,分别为1号和2号,首先将旋转角度传感器绕旋转中心高速转动,然后通过测量1号加速度计x轴的最大加速度和z轴的最大加速度,求得1号加速度计需要旋转α°角度,使其z轴指向旋转中心;同理,将2号加速度计的z轴指向旋转中心;
(2)根据步骤(1)中的旋转角度传感器,在静止状态下测量出两个加速度计x轴的加速度,并通过数学推导求得两个加速度计安装位置所成夹角;
(3)经过步骤(1)和步骤(2)标定后,通过两个加速度计测量旋转角度传感器的旋转角度,当由于振动等因素造成g出现偏差时,此时为通过测量1号和2号加速度计x轴的加速度ax1和ax2求得1号加速度计的z轴与重力加速度之间的夹角从而实现旋转角度的测量;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010299905.9A CN111457920B (zh) | 2020-04-16 | 2020-04-16 | 一种基于加速度计的旋转角度测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010299905.9A CN111457920B (zh) | 2020-04-16 | 2020-04-16 | 一种基于加速度计的旋转角度测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111457920A CN111457920A (zh) | 2020-07-28 |
CN111457920B true CN111457920B (zh) | 2022-09-23 |
Family
ID=71684658
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010299905.9A Active CN111457920B (zh) | 2020-04-16 | 2020-04-16 | 一种基于加速度计的旋转角度测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111457920B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114942338B (zh) * | 2022-05-09 | 2023-10-20 | 重庆大学 | 基于嵌入式重力加速度感知的转子或旋转件的转动参数预估方法及*** |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102506858B (zh) * | 2011-10-21 | 2014-07-02 | 北京北方联星科技有限公司 | 卫星导航***辅助的惯性传感器轴向快速识别方法 |
CN103776468A (zh) * | 2014-02-21 | 2014-05-07 | 深圳乐行天下科技有限公司 | 一种陀螺仪和加速度计批量校准装置和方法 |
DE102016225140B3 (de) * | 2016-12-15 | 2017-12-07 | Audi Ag | Verfahren zum Bestimmen einer relativen Position eines Kraftfahrzeugs, Positionsbestimmungssystem für ein Kraftfahrzeug und Kraftfahrzeug |
CN108426584B (zh) * | 2017-02-14 | 2022-02-01 | 厦门雅迅网络股份有限公司 | 汽车多传感器的校准方法 |
-
2020
- 2020-04-16 CN CN202010299905.9A patent/CN111457920B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN111457920A (zh) | 2020-07-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109459585B (zh) | 一种加速度计零位偏置修正方法 | |
CN104792323B (zh) | 动态水平仪及姿态角计算方法 | |
CN111895967A (zh) | 一种旋转角度传感器 | |
CN110926447B (zh) | 一种具有自主导航功能的单轴光纤陀螺寻北方法及航姿导航方法 | |
CN111366144B (zh) | 一种陀螺寻北仪多位置寻北方法 | |
CN111664868A (zh) | 一种单轴陀螺安装误差标定与补偿的方法 | |
CN108534799B (zh) | 一种利用mems修正三轴光纤陀螺跨条纹输出的方法及装置 | |
CN114415261B (zh) | 一种便携式相对重力仪的快速标定方法 | |
CN109631940A (zh) | 一种四环惯性稳定平台框架零位标校方法 | |
CN108710001B (zh) | 一种两轴一体陀螺加速度计及伺服控制方法 | |
CN108507572B (zh) | 一种基于mems惯性测量单元的姿态定位误差修正方法 | |
CN111551164B (zh) | 速率偏频激光陀螺寻北仪航向效应误差的补偿方法 | |
CN111457920B (zh) | 一种基于加速度计的旋转角度测量方法 | |
CN110849294B (zh) | 一种基于光纤陀螺的转台非正交度测试方法 | |
Liu et al. | Analysis and improvement of attitude output accuracy in tri-axis rotational inertial navigation system | |
CN107063181B (zh) | 复杂环境下多功能调试台的水平倾角的测量方法及装置 | |
CN111829503A (zh) | 一种光纤陀螺阈值测试方法及装置 | |
CN102455183A (zh) | 三轴姿态传感器 | |
US6502055B1 (en) | Method and apparatus for determining the geographic heading of a body | |
CN110133325B (zh) | 一种加速度计的重力场动态校准方法 | |
CN108036756B (zh) | 一种利用加速度计进行双轴旋转惯性测量装置相邻轴线垂直度检查的方法 | |
CN115979311A (zh) | Piga交叉二次项系数标定方法、***、设备及介质 | |
CN113899324B (zh) | 基于单轴激光陀螺测角仪的多轴转台垂直度误差检测方法 | |
CN214951273U (zh) | 方位指示*** | |
CN108645396B (zh) | 一种大量程角速度传感器的角速度测量方法 |
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 |