CN104090127A - 一种车载加速传感器的三轴自校准方法 - Google Patents
一种车载加速传感器的三轴自校准方法 Download PDFInfo
- Publication number
- CN104090127A CN104090127A CN201410332793.7A CN201410332793A CN104090127A CN 104090127 A CN104090127 A CN 104090127A CN 201410332793 A CN201410332793 A CN 201410332793A CN 104090127 A CN104090127 A CN 104090127A
- Authority
- CN
- China
- Prior art keywords
- axle
- vehicle
- znew
- xnew
- 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.)
- Granted
Links
Landscapes
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Force Measurement Appropriate To Specific Purposes (AREA)
Abstract
本发明揭示了一种车载加速传感器的三轴自校准方法,包括以下步骤:(1)定义加速度传感器受力模型;(2)确定坐标系O-XnewYnewZnew中的Znew轴;(3)确定坐标系O-XnewYnewZnew中的Xnew轴;(4)确保Znew轴和Xnew轴垂直;(5)确定坐标系O-XnewYnewZnew中的Ynew轴;以及(6)优化Xnew轴、Znew轴,本发明通过上述步骤,实现加速度传感器在车辆中任意放置,依旧可以建立以车辆前进方向为X轴正向、水平向左为Y轴正向、垂直地面为Z轴正向的新坐标系,作为车辆驾驶习惯,车辆碰撞现场还原的依据。
Description
技术领域
本发明涉及加速传感器校准领域,特别涉及一种车载加速传感器的三轴自校准方法。
背景技术
车载电子产品需要准确提供车辆实时三轴方向受力情况,作为驾驶习惯培养、车辆碰撞还原的依据。目前市面上的加速度传感器只能提供传感器方向固定的三轴受力的大小,同时车载电子产品放置在车辆上的位置、水平角具有很多不确定因素,最终导致加速度传感器无法提供实时三轴(前进方向、侧方向、垂直方向)的受力变化。通过本专利,可以实现车载电子产品任意放置情况下,依旧能提供实时车辆三轴方向的受力变化。
有鉴于此,本领域发明人针对上述问题,提供了一种车载加速传感器的三轴自校准方法。
发明内容
本发明提供了一种车载加速传感器的三轴自校准方法,克服了现有技术的困难,通过上述步骤,实现加速度传感器在车辆中任意放置,依旧可以建立以车辆前进方向为X轴正向、水平向左为Y轴正向、垂直地面为Z轴正向的新坐标系。作为车辆驾驶习惯,车辆碰撞现场还原的依据。
本发明提供了一种车载加速传感器的三轴自校准方法,包括以下步骤:
(1)建立基于加速度传感器的三维坐标系O-XYZ;
建立基于汽车行驶方向的三维坐标系O-XnewYnewZnew,其中,Xnew轴为汽车前进的加速度方向,Ynew轴为垂直于汽车前进方向的水平左方,Znew轴为重力的反方向,
建立三维坐标系O-XYZ与三维坐标系O-XnewYnewZnew的转换方程组为:
Xnew = a1 * X + b1 * Y + c1 * Z;
Ynew = a2 * X + b2 * Y + c2 * Z;
Znew = a3 * X + b3 * Y + c3 * Z;
(2)在车辆点火瞬间,加速度传感器只受重力G作用,重力G的反方向即是 O-XnewYnewZnew中的Znew轴,设三维坐标系O-XYZ三轴受力分别为gx, gy, gz,重力为G,计算出三轴XYZ和Znew轴的夹角,假设夹角分别是 到如下公式:
(3)在车辆启动后,刹车时,加速度传感器三轴分力变化的合力为摩擦力,摩擦力的反方向即是O-XnewYnewZnew中的Znew轴,设各轴上增加的加速度分量分别是,则合加速度,假设三轴XYZ和Xnew轴的夹角分别是得到如下公式:
(4)调整Znew轴与Xnew轴垂直,假设向量 = (a1, b1, c1), 向量 = (gx/g, gy/g, gz/g)。则正交化之后的Z轴向量应为:
上式中,
;
;
则得到:
;
;
;
将其单位化后的Z轴
上式中,。
(5)利用右手螺旋法则求出O-XnewYnewZnew中的Ynew轴,通过向量外积计算a2,b2,c2,假设向量=(a1,b1,c1),=(a2,b2,c2),=(a3,b3,c3),则
= 。
优选地,保存并统计点火瞬间20组Znew ,计算平均值最为新的Znew。
优选地,保存并统计刹车时的10组Xnew,计算平均值最为新的Xnew。
优选地,若保存的Xnew大于10组时,如果后续刹车的加速度大于当前保存的任一组数据,则进行替换,数组每次更新一次就重新计算一次a1, a2, a3, b1, b2, b3, c1, c2, c3。
由于采用了上述技术,本发明的一种车载加速传感器的三轴自校准方法与现有技术相比,本发明通过上述步骤,实现加速度传感器在车辆中任意放置,依旧可以建立以车辆前进方向为X轴正向、水平向左为Y轴正向、垂直地面为Z轴正向的新坐标系。作为车辆驾驶习惯,车辆碰撞现场还原的依据。
以下结合附图及实施例进一步说明本发明。
附图说明
图1为本发明中建立基于加速度传感器的三维坐标系O-XYZ的示意图;
图2为本发明中建立基于加速度传感器的三维坐标系O-XnewYnewZnew的示意图;以及
图3为本发明的车载加速传感器的三轴自校准方法的流程图。
具体实施方式
下面通过图1至3来介绍本发明的一种具体实施例。
实施例1
如图1至3所示,本发明的一种车载加速传感器的三轴自校准方法,包括以下步骤:
(1)定义加速度传感器受力模型
如图1所示,将加速度传感器10受力情况建立一个右手三维坐标系O-XYZ。
如图2所示,车辆在实际运动中加速度传感器10产生一个新的右手三维坐标系是O-XnewYnewZnew。Xnew是车辆前进方向,即加速度方向,Ynew是水平向左,Znew是垂直于车辆前进方向的朝上方向,即重力的反方向。
将三维坐标系O-XYZ转换为O-XnewYnewZnew。由线性代数关于空间坐标系的转换,得到如下方程组:
我们将a1, a2, a3, b1, b2, b3, c1, c2, c3理解成一个3 × 3的矩阵。则整个方程式可以转换成如下的等式。
(2)确定坐标系O-XnewYnewZnew中的Znew轴
在车辆点火瞬间传感器只受重力影响,我们定义该情况下传感器处于稳定状态。稳态时三维坐标系O-XYZ三轴受力gx, gy, gz的合力就是重力G的大小,重力G的反方向即Znew轴。由此可以计算出三轴XYZ和Znew轴的夹角。假设夹角分别是得到如下公式:
(3)确定坐标系O-XnewYnewZnew中的Xnew轴
车辆启动后,会有刹车这个动作,刹车时传感器受到Xnew反方向的摩擦力作用。摩擦力的大小就是传感器相对于稳态时三轴变化的合力。假设各轴上增加的加速度分量分别是, , ,则合加速度。假设三轴XYZ和Xnew轴的夹角分别是得到如下公式:
(4)确保Znew和Xnew垂直
由于采样稳态值是车辆可能在斜坡上或者由于采样本身导致的误差致Znew和Xnew不是垂直关系,我们需要调整Znew的方向,确保其和Xnew垂直。这个过程实际上就是施密特正交化过程。假设向量, 向量 。则正交化之后的Z轴向量应为:
上式中,
这样,我们可以得到:
接下来,我们再将其单位化。单位化之后的Z轴
上式中,。
(5)确定坐标系O-XnewYnewZnew中的Ynew轴
关于a2,b2,c2的结果可以通过向量外积计算得到。假设向量=(a1,b1,c1),=(a2,b2,c2),=(a3,b3,c3),则应该有下面的等式。
=
上面的等式按照Y方向符合Z到X的右手螺旋定则得到。
(6)优化Xnew、Znew轴
Znew 的确定和稳态选取有关,程序处理中可以在点火瞬间累加20组稳态传感器值,然后算出平均的稳态值。
Xnew的确定和刹车时刹车加速度大小有关,我们在程序中定义一个大小为10的数组,用于保存每次刹车时的加速度和传感器受力变化的积分,然后计算平均传感器受力变化作为Xnew计算依据。实验表明如果刹车加速度越大,传感器受力会越明显。因此,当程序中刹车数据保存大于10组时,如果后续刹车的加速度大于当前程序中保存的任一组数据,则进行替换,数组每次更新一次就重新计算一次a1, a2, a3, b1, b2, b3, c1, c2, c3。
综上可知,本发明的一种车载加速传感器的三轴自校准方法与现有技术相比,本发明通过上述步骤,实现加速度传感器在车辆中任意放置,依旧可以建立以车辆前进方向为X轴正向、水平向左为Y轴正向、垂直地面为Z轴正向的新坐标系。作为车辆驾驶习惯,车辆碰撞现场还原的依据。
以上所述的实施例仅用于说明本发明的技术思想及特点,其目的在于使本领域内的技术人员能够了解本发明的内容并据以实施,不能仅以本实施例来限定本发明的专利范围,即凡依本发明所揭示的精神所作的同等变化或修饰,仍落在本发明的专利范围内。
Claims (4)
1.一种车载加速传感器的三轴自校准方法,其特征在于,包括以下步骤:
(1)建立基于加速度传感器的三维坐标系O-XYZ;
建立基于汽车行驶方向的三维坐标系O-XnewYnewZnew,其中,Xnew轴为汽车前进的加速度方向,Ynew轴为垂直于汽车前进方向的水平左方,Znew轴为重力的反方向,
建立三维坐标系O-XYZ与三维坐标系O-XnewYnewZnew的转换方程组为:
Xnew = a1 * X + b1 * Y + c1 * Z;
Ynew = a2 * X + b2 * Y + c2 * Z;
Znew = a3 * X + b3 * Y + c3 * Z;
(2)在车辆点火瞬间,加速度传感器只受重力G作用,重力G的反方向即是 O-XnewYnewZnew中的Znew轴,设三维坐标系O-XYZ三轴受力分别为gx, gy, gz,重力为G,计算出三轴XYZ和Znew轴的夹角,假设夹角分别是
到如下公式:
(3)在车辆启动后,刹车时,加速度传感器三轴分力变化的合力为摩擦力,摩擦力的反方向即是 O-XnewYnewZnew中的Znew轴,设各轴上增加的加速度分量分别是,则合加速度,假设三轴XYZ和Xnew轴的夹角分别是得到如下公式:
(4)调整Znew轴与Xnew轴垂直,假设向量, 向量
,则正交化之后的Z轴向量应为:
上式中,
;
则得到:
;
;
;
将其单位化后的Z轴
上式中,;
(5)利用右手螺旋法则求出O-XnewYnewZnew中的Ynew轴,通过向量外积计算a2,b2,c2,假设向量=(a1,b1,c1),=(a2,b2,c2),=(a3,b3,c3),则
。
2.如权利要求1所述的车载加速传感器的三轴自校准方法,其特征在于:保存并统计点火瞬间20组Znew ,计算平均值最为新的Znew。
3.如权利要求1或2所述的车载加速传感器的三轴自校准方法,其特征在于:保存并统计刹车时的10组Xnew,计算平均值最为新的Xnew。
4.如权利要求3所述的车载加速传感器的三轴自校准方法,其特征在于:若保存的Xnew大于10组时,如果后续刹车的加速度大于当前保存的任一组数据,则进行替换,数组每次更新一次就重新计算一次a1, a2, a3, b1, b2, b3, c1, c2, c3。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410332793.7A CN104090127B (zh) | 2014-07-14 | 2014-07-14 | 一种车载加速传感器的三轴自校准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410332793.7A CN104090127B (zh) | 2014-07-14 | 2014-07-14 | 一种车载加速传感器的三轴自校准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104090127A true CN104090127A (zh) | 2014-10-08 |
CN104090127B CN104090127B (zh) | 2016-08-24 |
Family
ID=51637858
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410332793.7A Active CN104090127B (zh) | 2014-07-14 | 2014-07-14 | 一种车载加速传感器的三轴自校准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104090127B (zh) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105677310A (zh) * | 2014-11-21 | 2016-06-15 | 窦锡宇 | 一种标定车辆方向的方法及其软件算法 |
CN105759078A (zh) * | 2016-04-12 | 2016-07-13 | 北京荣之联科技股份有限公司 | 车载加速传感器的三轴自校准方法及装置 |
CN106382946A (zh) * | 2016-09-14 | 2017-02-08 | 邹红斌 | 参数校准方法及装置 |
CN107036630A (zh) * | 2017-04-27 | 2017-08-11 | 深圳市思拓通信系统有限公司 | 一种车辆驾驶预警装置安装角度的自动识别系统及方法 |
WO2018006521A1 (zh) * | 2016-07-06 | 2018-01-11 | 深圳市元征科技股份有限公司 | 加速度传感器校准方法及装置 |
CN108646054A (zh) * | 2018-07-05 | 2018-10-12 | 合肥移顺信息技术有限公司 | 一种车载加速传感器三轴自校准方法 |
CN108802428A (zh) * | 2018-07-05 | 2018-11-13 | 合肥移顺信息技术有限公司 | 一种车载加速传感器三轴自校准系统 |
CN109017795A (zh) * | 2018-07-05 | 2018-12-18 | 合肥移顺信息技术有限公司 | 一种驾驶习惯监测方法 |
CN109085381A (zh) * | 2018-09-14 | 2018-12-25 | 上海移为通信技术股份有限公司 | 车载加速度传感器方向校准方法 |
CN109813934A (zh) * | 2019-01-18 | 2019-05-28 | 深圳市航天无线通信技术有限公司 | 加速轴向的校准方法、装置及计算机可读存储介质 |
CN110967523A (zh) * | 2018-09-30 | 2020-04-07 | 北京奇虎科技有限公司 | 车辆加速度检测方法及装置 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN202002724U (zh) * | 2010-12-15 | 2011-10-05 | 常州赛杰电子信息有限公司 | 自校准三轴振动监测及环境监测采集装置 |
US20110307205A1 (en) * | 2009-03-03 | 2011-12-15 | Continental Automotive France | Method for self-calibrating an accelerometer mounted on a wheel of a vehicle while said vehicle is moving |
US8099994B2 (en) * | 2008-02-29 | 2012-01-24 | General Electric Company | Systems and methods for calibrating triaxial accelerometers |
CN202362319U (zh) * | 2011-11-25 | 2012-08-01 | 河南柴油机重工有限责任公司 | 三轴向加速度传感器的校准装置 |
CN103348253A (zh) * | 2011-02-08 | 2013-10-09 | 斯堪尼亚商用车有限公司 | 用于校准加速度传感器的装置和方法 |
CN103823084A (zh) * | 2014-03-21 | 2014-05-28 | 苏州纳芯微电子有限公司 | 一种三轴加速度传感器的校准方法 |
CN103889325A (zh) * | 2011-10-17 | 2014-06-25 | 皇家飞利浦有限公司 | 用于监测用户的设备和用于校准该设备的方法 |
-
2014
- 2014-07-14 CN CN201410332793.7A patent/CN104090127B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8099994B2 (en) * | 2008-02-29 | 2012-01-24 | General Electric Company | Systems and methods for calibrating triaxial accelerometers |
US20110307205A1 (en) * | 2009-03-03 | 2011-12-15 | Continental Automotive France | Method for self-calibrating an accelerometer mounted on a wheel of a vehicle while said vehicle is moving |
CN202002724U (zh) * | 2010-12-15 | 2011-10-05 | 常州赛杰电子信息有限公司 | 自校准三轴振动监测及环境监测采集装置 |
CN103348253A (zh) * | 2011-02-08 | 2013-10-09 | 斯堪尼亚商用车有限公司 | 用于校准加速度传感器的装置和方法 |
CN103889325A (zh) * | 2011-10-17 | 2014-06-25 | 皇家飞利浦有限公司 | 用于监测用户的设备和用于校准该设备的方法 |
CN202362319U (zh) * | 2011-11-25 | 2012-08-01 | 河南柴油机重工有限责任公司 | 三轴向加速度传感器的校准装置 |
CN103823084A (zh) * | 2014-03-21 | 2014-05-28 | 苏州纳芯微电子有限公司 | 一种三轴加速度传感器的校准方法 |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105677310A (zh) * | 2014-11-21 | 2016-06-15 | 窦锡宇 | 一种标定车辆方向的方法及其软件算法 |
CN105677310B (zh) * | 2014-11-21 | 2019-03-08 | 窦锡宇 | 一种标定车辆方向的方法 |
CN105759078B (zh) * | 2016-04-12 | 2019-01-04 | 北京荣之联科技股份有限公司 | 车载加速传感器的三轴自校准方法及装置 |
CN105759078A (zh) * | 2016-04-12 | 2016-07-13 | 北京荣之联科技股份有限公司 | 车载加速传感器的三轴自校准方法及装置 |
WO2018006521A1 (zh) * | 2016-07-06 | 2018-01-11 | 深圳市元征科技股份有限公司 | 加速度传感器校准方法及装置 |
CN106382946A (zh) * | 2016-09-14 | 2017-02-08 | 邹红斌 | 参数校准方法及装置 |
CN106382946B (zh) * | 2016-09-14 | 2019-07-09 | 邹红斌 | 参数校准方法及装置 |
CN107036630A (zh) * | 2017-04-27 | 2017-08-11 | 深圳市思拓通信系统有限公司 | 一种车辆驾驶预警装置安装角度的自动识别系统及方法 |
CN109017795A (zh) * | 2018-07-05 | 2018-12-18 | 合肥移顺信息技术有限公司 | 一种驾驶习惯监测方法 |
CN108802428A (zh) * | 2018-07-05 | 2018-11-13 | 合肥移顺信息技术有限公司 | 一种车载加速传感器三轴自校准系统 |
CN108646054A (zh) * | 2018-07-05 | 2018-10-12 | 合肥移顺信息技术有限公司 | 一种车载加速传感器三轴自校准方法 |
CN109085381A (zh) * | 2018-09-14 | 2018-12-25 | 上海移为通信技术股份有限公司 | 车载加速度传感器方向校准方法 |
CN110967523A (zh) * | 2018-09-30 | 2020-04-07 | 北京奇虎科技有限公司 | 车辆加速度检测方法及装置 |
CN109813934A (zh) * | 2019-01-18 | 2019-05-28 | 深圳市航天无线通信技术有限公司 | 加速轴向的校准方法、装置及计算机可读存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN104090127B (zh) | 2016-08-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104090127A (zh) | 一种车载加速传感器的三轴自校准方法 | |
CN105867377B (zh) | 一种农业机械自动导航控制方法 | |
CN105122166B (zh) | 稳定的方向控制系统和方法 | |
US9616900B2 (en) | Integrated bank and roll estimation using a three-axis inertial-measuring device | |
CN103940425B (zh) | 一种磁‑惯性组合捷联测量方法 | |
WO2017131838A3 (en) | Sonar sensor fusion and model based virtual and augmented reality systems and methods | |
JP2007182209A (ja) | 車両物理量推定装置及びプロブラム | |
WO2009008372A1 (ja) | 入力装置、制御装置、制御システム、制御方法及びハンドヘルド装置 | |
JP2009511968A5 (zh) | ||
JP2011185669A5 (zh) | ||
US20160068165A1 (en) | Integrated grade and pitch estimation using a three-axis inertial-measuring device | |
WO2013178899A3 (fr) | Dispositif de controle de trajectoire d'un vehicule | |
Diba et al. | Handling and safety enhancement of race cars using active aerodynamic systems | |
CN105652880B (zh) | 用于飞行器大空域飞行的非线性抗饱和高度指令生成方法 | |
CN104536448B (zh) | 一种基于Backstepping法的无人机姿态系统控制方法 | |
CN109164819B (zh) | 刚体航天器的反步自适应滑模大角度姿态机动控制方法 | |
Arana et al. | Series active variable geometry suspension application to chassis attitude control | |
KR101626163B1 (ko) | 차량 자세 제어 방법 | |
JP2015205570A5 (zh) | ||
CN105509703B (zh) | 用于旋转弹的横滚角的计算方法 | |
JP2019189121A (ja) | 車両状態推定装置 | |
CN109492237A (zh) | 一种气动系数获得方法 | |
CN112947522B (zh) | 一种基于有限时间观测器的硬式空中加油姿态控制方法 | |
CN105590013A (zh) | 一种确定输电杆塔横担背风面荷载降低系数的方法 | |
CN104516353A (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 | ||
CB02 | Change of applicant information |
Address after: 200233 room 801A, E building, No. 1618, Minhang District, Shanghai, Yishan Road Applicant after: Shanghai is moved as communication technology Company Limited by Shares Address before: 200233 room 801A, E building, No. 1618, Minhang District, Shanghai, Yishan Road Applicant before: Shanghai Yiwei Communication Technology Co., Ltd. |
|
COR | Change of bibliographic data | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |