CN103591936B - 一种倾斜角的测量方法 - Google Patents

一种倾斜角的测量方法 Download PDF

Info

Publication number
CN103591936B
CN103591936B CN201310578085.7A CN201310578085A CN103591936B CN 103591936 B CN103591936 B CN 103591936B CN 201310578085 A CN201310578085 A CN 201310578085A CN 103591936 B CN103591936 B CN 103591936B
Authority
CN
China
Prior art keywords
axis
accelerometer
accelerometers
plane
coordinate system
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
Application number
CN201310578085.7A
Other languages
English (en)
Other versions
CN103591936A (zh
Inventor
章谦
周一览
杨建华
刘承
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhejiang University ZJU
Original Assignee
Zhejiang University ZJU
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Zhejiang University ZJU filed Critical Zhejiang University ZJU
Priority to CN201310578085.7A priority Critical patent/CN103591936B/zh
Publication of CN103591936A publication Critical patent/CN103591936A/zh
Application granted granted Critical
Publication of CN103591936B publication Critical patent/CN103591936B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C9/00Measuring inclination, e.g. by clinometers, by levels

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)

Abstract

本发明公开了一种倾斜角的测量方法,该方法基于倾斜传感器来实现,该方法首先将倾斜传感器的四面体的底面紧贴于被测斜面,得到倾斜传感器的三个加速度计的输出值为B1、B2、B3;然后定义被测斜面的坐标系OXYZ,其中OZ垂直于被测斜面,OX、OY平行于被测斜面且互相垂直;输出值B1,B2,B3获得重力加速度g在OX、OY、OZ方向上的分量gx、gy、gz;最后得到倾斜的方位角β与摆幅α,从而实现倾斜角的测量;本发明实现了全方位、全摆幅的倾斜测量。

Description

一种倾斜角的测量方法
技术领域
本发明涉及测量技术领域,尤其涉及一种倾斜角的测量方法。
背景技术
在很多场合下,需要清楚知道装备相对于水平面的倾斜程度,与水平面呈多大角度。比如列车运行时需要随时获取倾斜信息来补偿离心力,从而避免事故发生。在升降机和起重机上也必须要有倾斜监控。
倾斜可以用倾斜的方位和摆幅来表征,如图1所示,假设OXYZ为被测件的坐标系,当被测件倾斜时,其坐标系与重力方向存在一个相对关系,参照图1,重力方向为OG,重力方向在OXY平面内的投影为OG’,定义α为倾斜的摆幅,范围为0-180°;定义β为倾斜的方位,范围为0-360°。
目前,现有技术中测量倾角的装置非常多,例如利用光电作用的光电测量角度测量仪,采用密封液体为测量介质的角度测量仪等。而利用加速度计测量倾斜角的途径也很多,其基本原理是利用重力矢量在加速度计敏感轴上的投影来确定倾斜角度。但是,这些方法存在着以下不足:
1、对于单轴加速度计的倾角传感器,只能在特定的方位上进行倾斜角测量,无法得出倾斜的方位;
2、单轴或者双轴加速度计在原理上受到限制,例如,双轴加速度计测量倾角时,利用反正弦函数实现加速度到角度的转换,θ=arcsin(f(B1,B2)),其中B1,B2为加速度计两个轴的输出值,f(B1,B2)为将加速度计输出值转换成三角函数值的某种函数关系,该函数关系可以由理论推导得出,由其导函数的性质可以得出,当倾斜角接近90°时,该方法的灵敏度接近于0,从而检测范围受到限制,即无法实现全摆幅的测量。
根据以上现有技术的不足,本发明公开了一种高灵敏度、全方位、全摆幅的倾斜角测量方法。
发明内容
本发明的目的在于根据现有技术的不足,提供一种倾斜角的测量方法,该方法能够实现高灵敏度,全方位,全摆幅的倾角测量。
本发明的目的是通过以下技术方案来实现的:一种倾斜角的测量方法,该方法基于倾斜传感器来实现,倾斜传感器由四面体以及固定在四面体上的三个加速度计组成,四面体的三条斜边PA、PB、PC两两垂直,底面ABC为一个正三角形,在正四面体的三个斜面的中心安装三个加速度计A1、A2、A3,三个加速度计的敏感轴分别垂直于其所在斜面;该方法包括以下步骤:
(1)将倾斜传感器的四面体的底面紧贴于被测斜面,得到倾斜传感器的三个加速度计的输出值为B1,B2,B3。
(2)定义被测斜面的坐标系OXYZ,其中OZ垂直于被测斜面,OX、OY平行于被测斜面且互相垂直;由步骤1得到的输出值为B1,B2,B3获得重力加速度g在OX、OY、OZ方向上的分量gx、gy、gz。
加速度计的误差模型为:
B1=K1(D01+DX1gx+DY1gy+DZ1gz)
B2=K2(D02+DX2gx+DY2gy+DZ2gz)
B3=K3(D03+DX3gx+DY3gy+DZ3gz)
其中,D01、D02、D03分别为加速度计A1、A2、A3的零位误差,K1、K2、K3分别为加速度计A1、A2、A3的标度因素,DX1、DY1、DZ1依次分别为加速度计A1对于坐标系OXYZ中的X轴、Y轴、Z轴的安装误差,DX2、DY2、DZ1依次分别为加速度计A2对于坐标系OXYZ中的X轴、Y轴、Z轴的安装误差,DX3、DY3、DZ3依次分别为加速度计A3对于坐标系OXYZ中的X轴、Y轴、Z轴的安装误差。其矩阵形式为:
B 1 K 1 - D 01 B 2 K 2 - D 02 B 3 K 3 - D 03 = D X 1 D Y 1 D Z 1 D X 2 D Y 2 D Z 2 D X 3 D Y 3 D Z 3 gx gy gz
通过标定的方法得出三个加速度计的零位误差、标度因素以及安装误差。然后求取上式中的矩阵的逆矩阵,可以得出重力加速度g在OX、OY、OZ方向上的分量gx、gy、gz。其矩阵形式为:
gx gy gz = D X 1 D Y 1 D Z 1 D X 2 D Y 2 D Z 2 D X 3 D Y 3 D Z 3 - 1 B 1 K 1 - D 01 B 2 K 2 - D 02 B 3 K 3 - D 03
(3)由步骤2的g在OX、OY、OZ方向上的分量gx、gy、gz得到倾斜的方位角β与摆幅α,从而实现倾斜角的测量。
其中,方位角β由下式得到:
β=arctan(gx/gy);
当|gz|>sin45°g时,g为重力加速度,为常数9.8m/s2,摆幅α通过下式得到:
α=arccos(gz/g);
当|gz|<sin45°g时,摆幅α通过下式得到:
&alpha; = arcsin ( &PlusMinus; ( gx / g ) 2 + ( gy / g ) 2 ) .
本发明具有的有益效果是:
1、实现了全方位、全摆幅的倾斜测量。
2、重力在被测件坐标系三个分量gx,gy,gz均包含三个加速度计的数据,起到了均化误差的作用。
3、采用分档的解算方法,提高了全方位、全摆幅下的倾角测量的灵敏度。
附图说明
图1是重力方向与被测件坐标系之间的空间关系示意图;
图2是基于本发明的倾斜传感器的加速度计的安装示意图。
具体实施方式
本发明倾斜角的测量方法基于倾斜传感器来实现,如图2所示,倾斜传感器由四面体以及固定在四面体上的3个加速度计组成,四面体的三条斜边PA、PB、PC两两垂直,底面ABC为一个正三角形,在正四面体的三个斜面的中心安装3个加速度计A1、A2、A3,3个加速度计的敏感轴分别垂直于其所在斜面。该方法包括以下步骤:
1、将倾斜传感器的四面体的底面紧贴于被测斜面,得到倾斜传感器的三个加速度计的输出值为B1,B2,B3。
2、定义被测斜面的坐标系OXYZ,其中OZ垂直于被测斜面,OX、OY平行于被测斜面且互相垂直;由步骤1得到的输出值为B1,B2,B3获得重力加速度g在OX、OY、OZ方向上的分量gx、gy、gz。
加速度计的误差模型为:
B1=K1(D01+DX1gx+DY1gy+DZ1gz)
B2=K2(D02+DX2gx+DY2gy+DZ2gz)(1)
B3=K3(D03+DX3gx+DY3gy+DZ3gz)
其中,D01、D02、D03分别为加速度计A1、A2、A3的零位误差,K1、K2、K3分别为加速度计A1、A2、A3的标度因素,DX1、DY1、DZ1依次分别为加速度计A1对于坐标系OXYZ中的X轴、Y轴、Z轴的安装误差,DX2、DY2、DZ1依次分别为加速度计A2对于坐标系OXYZ中的X轴、Y轴、Z轴的安装误差,DX3、DY3、DZ3依次分别为加速度计A3对于坐标系OXYZ中的X轴、Y轴、Z轴的安装误差。其矩阵形式为:
B 1 K 1 - D 01 B 2 K 2 - D 02 B 3 K 3 - D 03 = D X 1 D Y 1 D Z 1 D X 2 D Y 2 D Z 2 D X 3 D Y 3 D Z 3 gx gy gz - - - ( 2 )
通过标定的方法得出三个加速度计的零位误差、标度因素以及安装误差。然后求取公式(2)中的矩阵的逆矩阵,可以得出重力加速度g在OX、OY、OZ方向上的分量gx、gy、gz。其矩阵形式为:
gx gy gz = D X 1 D Y 1 D Z 1 D X 2 D Y 2 D Z 2 D X 3 D Y 3 D Z 3 - 1 B 1 K 1 - D 01 B 2 K 2 - D 02 B 3 K 3 - D 03 - - - ( 3 )
3、由步骤2的g在OX、OY、OZ方向上的分量gx、gy、gz得到倾斜的方位角β与摆幅α,从而实现倾斜角的测量。
其中,方位角β由下式得到:
β=arctan(gx/gy)  (4);
当|gz|>sin45°g时,g为重力加速度,为常数9.8m/s2,摆幅α通过下式得到:
α=arccos(gz/g)  (5);
当|gz|<sin45°g时,摆幅α通过下式得到:
&alpha; = arcsin ( &PlusMinus; ( gx / g ) 2 + ( gy / g ) 2 ) - - - ( 6 ) .
参考图1,重力在OXYZ三轴上的分量为:
gx=sinαsinβ·g
gy=sinαcosβ·g  (7)
gz=cosα
其中:α为倾斜的摆幅,β为倾斜的方位角,g为垂直于地面的重力加速度,为一常数9.8m/s2。由式子(7),可以推导出:
sin &alpha; = ( gx / g ) 2 + ( gy / g ) 2 - - - ( 8 )
cosα=gz/g
tan &beta; = gx gy - - - ( 9 )
这样做的好处在于,分别利用了反正弦和反余弦函数算法中灵敏度较高的区域,使得整个系统能够达到较高的灵敏度。
根据上述方法,就可以的出倾斜的方位β以及摆幅α。

Claims (1)

1.一种倾斜角的测量方法,该方法基于倾斜传感器来实现,倾斜传感器由四面体以及固定在四面体上的三个加速度计组成,四面体的三条斜边PA、PB、PC两两垂直,底面ABC为一个正三角形,在四面体的三个斜面的中心安装三个加速度计A1、A2、A3,三个加速度计的敏感轴分别垂直于其所在斜面;其特征在于,该方法包括以下步骤:
(1)将倾斜传感器的四面体的底面紧贴于被测斜面,得到倾斜传感器的三个加速度计的输出值为B1,B2,B3;
(2)定义被测斜面的坐标系OXYZ,其中OZ垂直于被测斜面,OX、OY平行于被测斜面且互相垂直;由步骤(1)得到的输出值为B1,B2,B3获得重力加速度g在OX、OY、OZ方向上的分量gx、gy、gz;
加速度计的误差模型为:
B1=K1(D01+DX1gx+DY1gy+DZ1gz)
B2=K2(D02+DX2gx+DY2gy+DZ2gz)
B3=K3(D03+DX3gx+DY3gy+DZ3gz)
其中,D01、D02、D03分别为加速度计A1、A2、A3的零位误差,K1、K2、K3分别为加速度计A1、A2、A3的标度因素,DX1、DY1、DZ1依次分别为加速度计A1对于坐标系OXYZ中的X轴、Y轴、Z轴的安装误差,DX2、DY2、DZ2依次分别为加速度计A2对于坐标系OXYZ中的X轴、Y轴、Z轴的安装误差,DX3、DY3、DZ3依次分别为加速度计A3对于坐标系OXYZ中的X轴、Y轴、Z轴的安装误差;其矩阵形式为:
B 1 K 1 - D 01 B 2 K 2 - D 02 B 3 K 3 - D 03 = D X 1 D Y 1 D Z 1 D X 2 Y Y 2 D Z 2 D X 3 D Y 3 D Z 3 gx gy gz
通过标定的方法得出三个加速度计的零位误差、标度因素以及安装误差;然后求取上式中的矩阵的逆矩阵,可以得出重力加速度g在OX、OY、OZ方向上的分量gx、gy、gz;其矩阵形式为:
gx gy gz = D X 1 D Y 1 D Z 1 D X 2 D Y 2 D Z 2 D X 3 D Y 3 D Z 3 - 1 B 1 K 1 - D 01 B 2 K 2 - D 02 B 3 K 3 - D 03
(3)由步骤(2)的g在OX、OY、OZ方向上的分量gx、gy、gz得到倾斜的方位角β与摆幅α,从而实现倾斜角的测量;
其中,方位角β由下式得到:
β=arctan(gy/gx);
当|gz|>sin45°g时,g为重力加速度,为常数9.8m/s2,摆幅α通过下式得到:
α=arccos(gz/g);
当|gz|<sin45°g时,摆幅α通过下式得到:
&alpha; = arcsin ( &PlusMinus; ( gx / g ) 2 + ( gy / g ) 2 ) .
CN201310578085.7A 2013-11-18 2013-11-18 一种倾斜角的测量方法 Expired - Fee Related CN103591936B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310578085.7A CN103591936B (zh) 2013-11-18 2013-11-18 一种倾斜角的测量方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310578085.7A CN103591936B (zh) 2013-11-18 2013-11-18 一种倾斜角的测量方法

Publications (2)

Publication Number Publication Date
CN103591936A CN103591936A (zh) 2014-02-19
CN103591936B true CN103591936B (zh) 2015-06-17

Family

ID=50082168

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310578085.7A Expired - Fee Related CN103591936B (zh) 2013-11-18 2013-11-18 一种倾斜角的测量方法

Country Status (1)

Country Link
CN (1) CN103591936B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106019396A (zh) * 2016-06-24 2016-10-12 南京信息工程大学 重力加速度的非水平测量系统
CN109254172B (zh) * 2017-07-12 2022-02-18 罗伯特·博世有限公司 车用加速度传感器的位置校准方法及装置、车辆控制设备
CN109470209A (zh) * 2018-11-20 2019-03-15 北京源清慧虹信息科技有限公司 一种基于三轴加速度计的倾角测量方法
CN111397569B (zh) * 2020-03-26 2021-09-17 浙江鸿泉电子科技有限公司 水泥搅拌车罐体转动角度的检测方法及装置
TWI823367B (zh) * 2022-04-27 2023-11-21 盎鍶創意有限公司 雙軸傾角測量裝置

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2003122541A (ru) * 2003-07-18 2005-01-10 Открытое акционерное общество Арзамасское научно-производственное предпри тие "ТЕМП-АВИА" (ОАО АНПП "ТЕМП-АВИА") (RU) Способ определения углов ориентации скважины и инклинометр
CN1773216A (zh) * 2004-11-08 2006-05-17 沙厄-丹福丝股份有限公司 基于加速度计的倾斜传感器和使用该倾斜传感器的方法
CN103105160A (zh) * 2013-01-21 2013-05-15 苏州明皜传感科技有限公司 一种利用三轴加速度计检测倾角的处理方法
CN103391871A (zh) * 2011-02-23 2013-11-13 罗伯特·博世有限公司 用于确定车辆的倾斜位置的方法和装置

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20050217127A1 (en) * 2004-04-05 2005-10-06 Prueftechnik Dieter Busch Ag Measurement device and method for determining the three-dimensional orientation of a body relative to two horizontal reference directions

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2003122541A (ru) * 2003-07-18 2005-01-10 Открытое акционерное общество Арзамасское научно-производственное предпри тие "ТЕМП-АВИА" (ОАО АНПП "ТЕМП-АВИА") (RU) Способ определения углов ориентации скважины и инклинометр
CN1773216A (zh) * 2004-11-08 2006-05-17 沙厄-丹福丝股份有限公司 基于加速度计的倾斜传感器和使用该倾斜传感器的方法
CN103391871A (zh) * 2011-02-23 2013-11-13 罗伯特·博世有限公司 用于确定车辆的倾斜位置的方法和装置
CN103105160A (zh) * 2013-01-21 2013-05-15 苏州明皜传感科技有限公司 一种利用三轴加速度计检测倾角的处理方法

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
Design and implementation of a digital inclinometer;Liang Hua-wei etal;《Proceedings of the IEEE》;20051231;第489-492页 *
基于三轴加速度计的倾斜角传感器的研究与设计;郭敏 等;《现代电子技术》;20101231;第32-36页 *
基于迭代估计的三轴加速度计温度模型参数外场标定方法;杨杰 等;《中国惯性技术学报》;20130831;第540-548页 *
提高倾斜传感器精度方法的研究;刘华;《压电与声光》;20100430;第207-210页 *

Also Published As

Publication number Publication date
CN103591936A (zh) 2014-02-19

Similar Documents

Publication Publication Date Title
CN103591936B (zh) 一种倾斜角的测量方法
CN102980577B (zh) 一种微型捷联航姿系统及其工作方法
CN106979780B (zh) 一种无人车实时姿态测量方法
CN103712622B (zh) 基于惯性测量单元旋转的陀螺漂移估计补偿方法及装置
CN102279002B (zh) 星敏感器测量坐标系与载体坐标系转换矩阵的标定方法
CN105841698B (zh) 一种无需调零的auv舵角精确实时测量系统
CN103134474B (zh) 一种工作平台的倾斜角测量方法及装置
CN104792323B (zh) 动态水平仪及姿态角计算方法
CN103917777A (zh) 用来确定塔楼斜度的方法
CN104215229A (zh) Rtk设备调节方法、系统及rtk测量方法
WO2018214226A1 (zh) 一种无人车实时姿态测量方法
CN105716595B (zh) 一种悬浮类陀螺仪的转子偏转调制误差补偿方法
CN101634600A (zh) 一种三线摆测量转动惯量的方法
CN106290968A (zh) 一种大空间稳态流场三维测量系统及测量方法
CN102455183A (zh) 三轴姿态传感器
CN103901496A (zh) 一种基于光纤陀螺sins与北斗的重力测量方法
CN102706310A (zh) 一种臂架夹角检测方法、装置及带此装置的泵车
CN105303201A (zh) 一种基于动作感应进行手写识别的方法和系统
CN104748734A (zh) 一种带倾角补偿的车载电子海拔罗盘仪
CN106932818A (zh) 一种用于检测旋转地震动的地震仪
CN109596295B (zh) 一种多轴向振动台线振动的激光绝对校准装置
CN104111063B (zh) 一种基于磁场的无线三维倾角传感器及其检测方法
CN108109394B (zh) 基于矢量模型的单地磁车辆交通参数检测系统及方法
CN204329960U (zh) 基于重锤的倾角动态测量装置
CN202483559U (zh) 多传感器测斜方位模块

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20150617

Termination date: 20181118