CN105807095B - 一种三轴加速度传感器安装误差修正方法 - Google Patents
一种三轴加速度传感器安装误差修正方法 Download PDFInfo
- Publication number
- CN105807095B CN105807095B CN201610135743.9A CN201610135743A CN105807095B CN 105807095 B CN105807095 B CN 105807095B CN 201610135743 A CN201610135743 A CN 201610135743A CN 105807095 B CN105807095 B CN 105807095B
- Authority
- CN
- China
- Prior art keywords
- acceleration
- vehicle
- acceleration sensor
- formula
- axis
- 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
Classifications
-
- 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
Abstract
本发明涉及一种三轴加速度传感器安装误差修正方法,用于校正加速度传感器坐标系与车辆坐标系之间的角度误差,得到加速度传感器的理论值,其特征在于,该方法通过将加速度传感器安装在车辆上,读取车辆在水平地面上静止时加速度传感器的测量值以及车辆在水平地面上加速运动时加速度传感器的测量值令误差修正系数矩阵得到车辆坐标系下加速度传感器的理论值计算式:式中为一般情况下加速度传感器的测量值。与现有技术相比,本发明考虑了车辆俯仰角度影响,测量条件要求低,计算方法简单,有效消除传感器坐标轴误差。
Description
技术领域
本发明涉及一种传感器安装误差修正方法,尤其是涉及一种三轴加速度传感器安装误差修正方法。
背景技术
近年来汽车智能化技术的研究发展迅速,加速度传感器在智能汽车领域的应用日益广泛。在实际应用中,通常需要以车辆坐标系为基准测量加速度数据。这就需要加速度传感器的各感应轴方向与车辆坐标系一致。但是在实际的传感器安装过程中,由于无法避免的安装误差,导致传感器感应轴的实际方向与理想方向存在偏差。这一安装误差对于数据的测量有很大的影响,有必要对其进行修正。针对这一误差的修正,一般采用误差修正矩阵与三轴加速度传感器的实测值相乘的方法得到理想值。现有的求解误差修正矩阵的方法如欧拉法、四元数法在实际应用中标定困难,误差修正的精度受试验条件影响较大。
发明内容
本发明的目的是克服上述现有技术存在的缺陷而提供一种过程简单、结果精确的三轴加速度传感器安装误差修正方法。
本发明的目的可以通过以下技术方案来实现:
一种三轴加速度传感器安装误差修正方法,用于校正加速度传感器坐标系与车辆坐标系之间的角度误差,得到加速度传感器的理论值,所述的加速度传感器安装在车辆上,其特征在于,该方法包括以下步骤:
S1,读取车辆在水平地面上静止时加速度传感器的测量值以及车辆在水平地面上直线加速运动时加速度传感器的测量值
S2,计算误差修正系数矩阵K:
式中
S3,根据误差修正系数矩阵K进行误差修正,得到一般情况下的车辆坐标系下加速度传感器的理论值计算式:
式中,为一般情况下的加速度传感器的测量值。
所述的车辆在水平地面上加速运动时加速度传感器的测量值获取方法为:设定加速度,令车辆在水平地面上直线加速行驶,行驶过程中加速度传感器测得多个不同加速度,按向量模值排序,取前1~3项求平均值。
所述的车辆在水平地面上加速运动时加速度传感器测量值为以相同设定的加速度多次行驶测量取平均值。
该方法还可得到一般情况下车辆加速度实际值计算式:
式中,为车辆在水平地面上静止时加速度传感器的测量值,g为通过查表获得的测量地点重力加速度。
所述的加速度传感器安装在车内任意位置,不影响标定精度。
所述的车辆在水平地面上直线加速运动时,传感器测得的加速度值大于或等于9.794m/s2,优选为10.00~10.25m/s2。
与现有技术相比,本发明通过获取车辆在水平地面上静止和加速运动时的加速度传感器测量值,进行两次叉乘可得到误差修正矩阵,考虑了车辆俯仰角度影响,测量条件要求低,计算方法简单,有效消除传感器坐标轴误差;由于车辆在水平地面上加速运动时,加速度很难保持恒定,通过对加速度传感器多次测量的结果取平均值可减小随机误差。
附图说明
图1为本发明三轴加速度传感器坐标系相对于车辆坐标系的安装误差关系示意图;
图2为本发明误差修正矩阵推导过程相关向量示意图。
具体实施方式
下面结合附图和具体实施例对本发明进行详细说明。本实施例以本发明技术方案为前提进行实施,给出了详细的实施方式和具体的操作过程,但本发明的保护范围不限于下述的实施例。
实施例
图1所示为三轴加速度传感器坐标系(以下简称A系)相对于车辆坐标系(以下简称B系)的安装误差关系。理想情况下,车辆处于水平路面上,坐标系X轴为汽车匀速直线行驶时的前进方向,Y轴为与前进方向垂直的水平侧向,Z轴为重力加速度方向,即与地面垂直的竖直方向。由于安装误差的存在,设车辆坐标系下三轴加速度传感器测量参数理论值为而三轴加速度传感器于本身测量坐标系下的实测值为则有实测值与理论值的关系式
其中,K为安装误差修正系数矩阵,由如下方法得到:
如图1所示,在B系三个坐标轴上的投影,即为的三个分量因此只要求得B系三个坐标轴方向的单位向量在A系下的表达式即可得 即
由式(0.1)和式(0.2)得修正系数矩阵K的表达式。
1.静态试验校准
将车辆停于水平路面上,此时加速度传感器受到的加速度即为重力加速度,传感器输出向量为实际重力加速度为二者满足关系k为实际加速度模量相对于传感器输出向量模量的比例系数,即
式中g的值由重力加速度表查得,由此可得重力加速度传感器输出数据相对于实际值的比例系数
同时还可求得B系的Z轴(与同轴)方向的单位向量在A系下的表达式
即
2.动态试验校准
驾驶车辆在水平直道上直线加速行驶,取行驶过程中传感器输出的较大的几个加速度值求平均,得对应的理论加速度为侧向加速度很小,可忽略不计,用表示方向的单位向量,则
即
3.第一次叉乘
包含两个分量:水平静止时测得的加速度和加速行驶时前进方向加速度由于车辆加速行驶过程中车身俯仰的影响,直接由得到的与B系X轴不平行。但由于在B系中仍平行于车辆纵向对称面(B系的XOZ平面),因此可先用和叉乘得到B系的Y坐标轴方向的单位向量在A系中的表达式,即
将式(0.7),式(0.8),式(0.9),式(0.11),式(0.12),式(0.13)代入式(0.14)得
即
4.第二次叉乘
现已求得B系Y轴和Z轴方向的单位向量和在A系中的表达式,二者叉乘即可得到B系X轴方向单位向量在A系中的表达式,即
将式(0.7),式(0.8),式(0.9),式(0.16),式(0.17),式(0.18)代入式(0.19)得
即
综上可得修正系数矩阵K的表达式
式中各元素表达式见式(0.7),式(0.8),式(0.9),式(0.16),式(0.17),式(0.18),式(0.21),式(0.22),式(0.23)。
故传感器理论值和实测值满足如下关系式
实际加速度用表示,则
式中,k为式(0.5)所示的比例系数。
本发明提出的两次叉乘法在实际应用中试验简单,容易保证精度。
Claims (5)
1.一种三轴加速度传感器安装误差修正方法,用于校正加速度传感器坐标系与车辆坐标系之间的角度误差,得到加速度传感器的理论值,所述的加速度传感器安装在车辆上,其特征在于,该方法包括以下步骤:
S1,读取车辆在水平地面上静止时加速度传感器的测量值以及车辆在水平地面上直线加速运动时加速度传感器的测量值
S2,计算误差修正系数矩阵K:
式中
S3,根据误差修正系数矩阵K进行误差修正,得到一般情况下的车辆坐标系下加速度传感器的理论值计算式:
式中,为一般情况下的加速度传感器的测量值。
2.根据权利要求1所述的一种三轴加速度传感器安装误差修正方法,其特征在于,所述的车辆在水平地面上加速运动时加速度传感器的测量值获取方法为:设定加速度,令车辆在水平地面上直线加速行驶,行驶过程中加速度传感器测得多个不同加速度,按向量模值排序,取前1~3项求平均值。
3.根据权利要求2所述的一种三轴加速度传感器安装误差修正方法,其特征在于,所述的车辆在水平地面上加速运动时加速度传感器测量值为以相同设定的加速度多次行驶测量取平均值。
4.根据权利要求1所述的一种三轴加速度传感器安装误差修正方法,其特征在于,该方法还可得到一般情况下车辆加速度实际值计算式:
式中,为车辆在水平地面上静止时加速度传感器的测量值,g为通过查表获得的测量地点重力加速度数值。
5.根据权利要求1所述的一种三轴加速度传感器安装误差修正方法,其特征在于,所述的加速度传感器安装在车内任意位置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610135743.9A CN105807095B (zh) | 2016-03-10 | 2016-03-10 | 一种三轴加速度传感器安装误差修正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610135743.9A CN105807095B (zh) | 2016-03-10 | 2016-03-10 | 一种三轴加速度传感器安装误差修正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105807095A CN105807095A (zh) | 2016-07-27 |
CN105807095B true CN105807095B (zh) | 2019-01-11 |
Family
ID=56467989
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610135743.9A Active CN105807095B (zh) | 2016-03-10 | 2016-03-10 | 一种三轴加速度传感器安装误差修正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105807095B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106382946B (zh) * | 2016-09-14 | 2019-07-09 | 邹红斌 | 参数校准方法及装置 |
DE102016222501A1 (de) * | 2016-11-16 | 2018-05-17 | Robert Bosch Gmbh | Verfahren und Vorrichtung zum Bewerten einer Beschleunigung |
CN109254172B (zh) * | 2017-07-12 | 2022-02-18 | 罗伯特·博世有限公司 | 车用加速度传感器的位置校准方法及装置、车辆控制设备 |
CN108051839B (zh) * | 2017-10-27 | 2021-11-05 | 成都天合世纪科技有限责任公司 | 一种车载三维定位装置及三维定位的方法 |
CN108492398A (zh) * | 2018-02-08 | 2018-09-04 | 同济大学 | 基于加速度计的自适应驾驶行为主动采集的预警方法 |
CN108399789A (zh) * | 2018-03-28 | 2018-08-14 | 成都天合世纪科技有限责任公司 | 一种智能停车管理系统及方法 |
CN109470209A (zh) * | 2018-11-20 | 2019-03-15 | 北京源清慧虹信息科技有限公司 | 一种基于三轴加速度计的倾角测量方法 |
CN109764868A (zh) * | 2019-02-28 | 2019-05-17 | 深圳市伟文无线通讯技术有限公司 | 一种基于六轴传感器设备安装姿态校准方法 |
CN110988829B (zh) * | 2019-12-27 | 2023-03-21 | 福建汉特云智能科技有限公司 | 一种基于uwb定位的车辆传感器标定方法及系统 |
CN113311191A (zh) * | 2020-02-26 | 2021-08-27 | 株洲中车时代电气股份有限公司 | 一种车载加速度计的在线校准方法及其装置 |
CN111475770B (zh) * | 2020-04-08 | 2023-04-14 | 成都路行通信息技术有限公司 | 一种三轴加速度坐标系分量修正方法和系统 |
CN112304552B (zh) * | 2020-10-23 | 2022-10-11 | 重庆长安汽车股份有限公司 | 用于确定头型冲击模块加速度传感器测量点的定位方法 |
CN114280332B (zh) * | 2021-12-31 | 2024-04-23 | 成都路行通信息技术有限公司 | 一种三轴加速度传感器校正方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101887068A (zh) * | 2010-06-01 | 2010-11-17 | 中北大学 | 三轴矢量传感器及两轴矢量传感器的标定补偿方法 |
JP2010271086A (ja) * | 2009-05-19 | 2010-12-02 | Furuno Electric Co Ltd | 移動状態検出装置 |
CN102168991A (zh) * | 2011-01-29 | 2011-08-31 | 中北大学 | 三轴矢量传感器与安装载体间安装误差的标定补偿方法 |
CN105092892A (zh) * | 2015-08-11 | 2015-11-25 | 东软集团股份有限公司 | 一种车辆加速度数据的获取方法和装置 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006176084A (ja) * | 2004-12-24 | 2006-07-06 | Advics:Kk | 車両挙動センサの検出値補正方法 |
-
2016
- 2016-03-10 CN CN201610135743.9A patent/CN105807095B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010271086A (ja) * | 2009-05-19 | 2010-12-02 | Furuno Electric Co Ltd | 移動状態検出装置 |
CN101887068A (zh) * | 2010-06-01 | 2010-11-17 | 中北大学 | 三轴矢量传感器及两轴矢量传感器的标定补偿方法 |
CN102168991A (zh) * | 2011-01-29 | 2011-08-31 | 中北大学 | 三轴矢量传感器与安装载体间安装误差的标定补偿方法 |
CN105092892A (zh) * | 2015-08-11 | 2015-11-25 | 东软集团股份有限公司 | 一种车辆加速度数据的获取方法和装置 |
Also Published As
Publication number | Publication date |
---|---|
CN105807095A (zh) | 2016-07-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105807095B (zh) | 一种三轴加速度传感器安装误差修正方法 | |
CN106569150B (zh) | 一种用于三轴磁传感器简易校正的两步校正方法 | |
CN101140161B (zh) | 表面形状测定装置 | |
CN105865461B (zh) | 一种基于多传感器融合算法的汽车定位系统及方法 | |
KR20090018659A (ko) | 자세각 검출 장치와 자세각 검출 방법 | |
CN1470879A (zh) | 具有校准功能的加速度测量设备 | |
CN105737852B (zh) | 激光测距仪位置测量与校正系统及方法 | |
CN113008227B (zh) | 一种基于三轴加速度计测姿的地磁二分量测量方法 | |
CN106645799B (zh) | 参数校准方法及装置 | |
CN103471619A (zh) | 一种激光捷联惯导系统棱镜棱线方位安装误差标定方法 | |
CN110672017A (zh) | 一种激光位移传感器振动补偿平台 | |
CN105946866A (zh) | 一种汽车行驶状态预警方法 | |
CN109490855A (zh) | 一种车载雷达标定方法、装置及车辆 | |
CN108871673A (zh) | 商用车驾驶室质心与转动惯量测量修正方法 | |
CN105758353A (zh) | 一种碰撞试验中假人膝部位移的测量方法 | |
KR20080086711A (ko) | 관성항법시스템의 초기정렬 방법 | |
CN106864461A (zh) | 一种基于加速度传感器判断车辆运动行为的方法 | |
JP2015205570A (ja) | ピッチング角算出装置及び光軸調整装置 | |
CN105444722A (zh) | 检测平台姿态变化的方法 | |
CN104792487A (zh) | 一种获取碰撞试验中假人骨盆运动轨迹的方法及装置 | |
CN108646054A (zh) | 一种车载加速传感器三轴自校准方法 | |
CN106199758A (zh) | 测量数据校准方法和电子设备 | |
CN105403187A (zh) | 一种高速动车组车体三维尺寸检测方法 | |
CN107036576B (zh) | 基于差商法磁测旋转飞行器滚转角的实时解算方法 | |
CN108802428A (zh) | 一种车载加速传感器三轴自校准系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |