一种用于车辆坡道估计的加速度传感器静态补偿校正方法与流程

1.本发明涉及混合动力商用车车辆状态识别领域，具体为一种用于车辆坡道估计的加速度传感器静态补偿校正方法。


背景技术：

2.目前行业内对于车辆坡道载重的估计主要依靠加速度传感器，不同的是传感器的测量轴数目及灵敏度依各生产商有所不同，主要区分为两轴和三轴加速度传感器。而在实际运用中，由于加速度传感器安装方位、倾角的不同，需要对传感器的输出进行补偿校正，得到车辆实际的各方向加速度值。如果当前传感器安装方位角度水平竖直，则静态下加速度传感器纵向加速度及横向加速度输出值应约等于0，而竖向加速度输出值应为当前车辆所处位置的重力加速度，即约等于9.8m/s2。但由于安装方位的偏差，重力加速度会产生作用于加速度传感器纵向和横向的加速度分量，使输出出现误差。很多工程在尽量保证传感器水平竖直安装的前提下，对这部分进行了简单的处理来减少安装差异对输出的影响。这样做造成的问题是在没法保证生产一致性的情况下，需要对每个传感器进行单独的标定和校准补偿。为了进一步提高自动化程度和软件通用性，本项目提出了一种用于车辆坡道估计的加速度传感器静态补偿校正方法。


技术实现要素：

3.针对现有技术中存在三轴加速度传感器的静态校正补偿的问题，本发明提供一种用于车辆坡道估计的加速度传感器静态补偿校正方法，通过自学习，对三轴加速度传感器各轴输出进行补偿校正，得到更加准确的数据。
4.本发明是通过以下技术方案来实现：
5.一种用于车辆坡道估计的加速度传感器静态补偿校正方法，包括如下步骤：
6.步骤1，建立车辆静止水平状态参数的加速度传感器自学习模型；
7.步骤2，采集车辆加速度传感器的三轴信号向量；
8.步骤3，三轴信号向量通过加速度传感器自学习模型进行计算得到车辆静止水平状态下的加速度传感器三轴信号的补偿值和加速度传感器三轴与车辆运动三轴方向的偏差角；
9.步骤4，通过加速度传感器三轴信号的原始值和补偿值以及加速度传感器三轴与车辆运动三轴方向的偏差角得到车辆运动三轴方向的实际加速度值。
10.优选的，加速度传感器自学习模型接收到三轴信号向量后的计算步骤如下：
11.对三轴向量进行求和得到三轴信号向量和，其中所述三轴信号向量和对应车辆当前所处位置的重力加速度；
12.求得加速度传感器的三轴与三轴信号向量和的夹角，并通过加速度传感器的三轴与三轴信号向量和的夹角求得加速度传感器三轴与车辆运动三轴方向的偏差角；
13.通过加速度传感器三轴与车辆运动三轴方向的偏差角及三轴信号向量和得到加
速度传感器三轴信号的补偿值；
14.在车辆运动过程中，通过所得加速度传感器三轴信号的偏差角及补偿值修正原始信号值得到车辆运动三轴方向的实际加速度值。
15.进一步的，在加速度传感器自学习模型中，通过向量法得到三轴信号向量和。
16.进一步的，其中三轴信号向量和的计算公式如下：
[0017][0018]
其中，accraw_x为加速度传感器x轴的原始信号值；accraw_y为加速度传感器y轴的原始信号值；accraw_z为加速度传感器z轴的原始信号值；accsumvct为通过平方和公式计算得到的三轴信号向量和。
[0019]
更进一步的，三轴信号向量和accsumvct对应车辆当前所处位置的重力加速度。
[0020]
进一步的，通过加速度传感器的三轴、三轴信号向量和及车辆运动三轴方向之间的三角函数关系得到加速度传感器三轴与车辆运动三轴方向的偏差角：
[0021]
agaccxorntn＝arcsin(accraw_x
÷
accsumvct)；
[0022]
agaccyorntn＝arcsin(accraw_y
÷
accsumvct)；
[0023]
agacczorntn＝arccos(accraw_z
÷
accsumvct)；
[0024]
其中，agaccxorntn为加速度传感器x轴与车辆运动x轴的偏差角；agaccyorntn为加速度传感器y轴与车辆运动y轴的偏差角；agacczorntn为加速度传感器z轴与车辆运动z轴的偏差角；accraw_x为加速度传感器x轴的原始信号值；accraw_y为加速度传感器y轴的原始信号值；accraw_z为加速度传感器z轴的原始信号值；accsumvct为通过平方和公式计算得到的三轴信号向量和。
[0025]
更进一步的，加速度传感器三轴信号的静态补偿值的计算公式如下：
[0026]
cmps_x＝-accraw_x*cos(agaccxorntn)，
[0027]
cmps_y＝-accraw_y*cos(agaccyorntn)，
[0028]
cmps_z＝-accraw_z*cos(agacczorntn)，
[0029]
其中，cmps_x为加速度传感器x轴信号的静态补偿值；cmps_y为加速度传感器y轴信号的静态补偿值；cmps_z为加速度传感器x轴信号的静态补偿值；agaccxorntn为加速度传感器x轴与车辆运动x轴的偏差角；agaccyorntn为加速度传感器y轴与车辆运动y轴的偏差角；agacczorntn为加速度传感器z轴与车辆运动z轴的偏差角；accraw_x为加速度传感器x轴的原始信号值；accraw_y为加速度传感器y轴的原始信号值；accraw_z为加速度传感器z轴的原始信号值。
[0030]
更进一步的，车辆运动三轴方向的实际加速度值的计算公式如下：
[0031]
accx_cltd＝accraw_x
÷
cos(agaccxorntn) cmps_x
[0032]
accy_cltd＝accraw_y
÷
cos(agaccyorntn) cmps_y
[0033]
accz_cltd＝accraw_z
÷
cos(agacczorntn) cmps_z
[0034]
其中，accx cltd为车辆运动x轴方向的实际加速度值；accy cltd为车辆运动y轴方向的实际加速度值；accz cltd为车辆运动z轴方向的实际加速度值；accraw_x为加速度传感器x轴的原始信号值；accraw_y为加速度传感器y轴的原始信号值；accraw_z为加速度传感器z轴的原始信号值；cmps_x为加速度传感器x轴信号的静态补偿值；cmps_y为加速度
传感器y轴信号的静态补偿值；cmps_z为加速度传感器x轴信号的静态补偿值；agaccxorntn为加速度传感器x轴与车辆运动x轴的偏差角；agaccyorntn为加速度传感器y轴与车辆运动y轴的偏差角；agacczorntn为加速度传感器z轴与车辆运动z轴的偏差角。
[0035]
与现有技术相比，本发明具有以下有益的技术效果：
[0036]
本发明提供了一种用于车辆坡道估计的加速度传感器静态补偿校正方法，通过加速度传感器自学习模型内计算对车辆加速度传感器进行静态的矫正补偿，得到更加准确的车辆纵向，横向，竖向加速度值，避免因生产差异及人工安装原因造成的加速度传感器方位偏差导致的输出信号误差，为后续车辆状态识别提供可靠的数据。本发明为混合动力商用车的坡道载重识别提供了更加可靠的数据，进而提高车辆坡道及载重识别的准确性。通过获得加速度传感器三轴向量和以及加速度传感器的三轴与三轴信号向量和的夹角得到加速度传感器三轴与车辆运动三轴方向的偏差角以及静态误差补偿值，对原始加速度信号进行校正，最终输出车辆运动三轴方向的准确加速度值。
附图说明
[0037]
图1为本发明中用于车辆坡道估计的加速度传感器静态补偿校正方法的流程图；
[0038]
图2为本发明中加速度传感器方位偏差示意图；
[0039]
图3为本发明中加速度传感器原始信号示意图；
[0040]
图4为本发明中加速度传感器三轴偏差角示意图；
[0041]
图5为本发明中加速度传感器三轴补偿值示意图；
[0042]
图6为本发明中加速度传感器输出校正值示意图。
具体实施方式
[0043]
为了使本技术领域的人员更好地理解本发明方案，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分的实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都应当属于本发明保护的范围。
[0044]
需要说明的是，本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象，而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换，以便这里描述的本发明的实施例能够以除了在这里图示或描述的那些以外的顺序实施。此外，术语“包括”和“具有”以及他们的任何变形，意图在于覆盖不排他的包含，例如，包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元，而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
[0045]
下面结合附图对本发明做进一步详细描述：
[0046]
本发明一个实施例中，提供了一种用于车辆坡道估计的加速度传感器静态补偿校正方法，通过自学习，对三轴加速度传感器各轴输出进行补偿，得到更加准确的数据。
[0047]
具体的，根据图1所示，该加速度传感器静态补偿校正方法，包括如下步骤：
[0048]
车辆处于静止水平状态，发动机停机，建立车辆静止水平状态参数的加速度传感
器自学习模型；
[0049]
加速度传感器采集车辆加速度传感器的三轴信号向量，其中三轴信号向量包括accraw_x、accraw_y以及accraw_z；
[0050]
三轴信号向量输入至加速度传感器自学习模型内进行计算得到车辆静止水平状态下的加速度传感器三轴信号的补偿值和加速度传感器三轴与车辆运动三轴方向的偏差角；
[0051]
通过加速度传感器三轴信号的原始值和补偿值以及加速度传感器三轴与车辆运动三轴方向的偏差角得到车辆运动三轴方向的实际加速度值。
[0052]
具体的，加速度传感器自学习模型接收到三轴信号向量后的计算步骤如下：
[0053]
对accraw_x、accraw_y以及accraw_z进行求和得到三轴信号向量和，其中所述三轴信号向量和对应车辆当前所处位置的重力加速度；
[0054]
求得加速度传感器的三轴与三轴信号向量和的夹角，并通过加速度传感器的三轴与三轴信号向量和的夹角求得加速度传感器三轴与车辆运动三轴方向的偏差角；
[0055]
通过加速度传感器三轴与车辆运动三轴方向的偏差角及三轴信号向量和得到加速度传感器三轴信号的补偿值；
[0056]
在车辆运动过程中，通过所得加速度传感器三轴信号的偏差角及补偿值修正原始信号值得到车辆运动三轴方向的实际加速度值。
[0057]
具体的，在加速度传感器自学习模型中，通过向量法得到accraw_x、accraw_y以及accraw_z的三轴信号向量和。
[0058]
其中，其中三轴信号向量和的计算公式如下：
[0059][0060]
其中，accraw_x为加速度传感器x轴的原始信号值；accraw_y为加速度传感器y轴的原始信号值；accraw_z为加速度传感器z轴的原始信号值；accsumvct为通过平方和公式计算得到的三轴信号向量和；其中所述三轴信号向量和accsumvct对应车辆当前所处位置的重力加速度。
[0061]
具体的，通过加速度传感器的三轴、三轴信号向量和及车辆运动三轴方向之间的三角函数关系得到加速度传感器三轴与车辆运动三轴方向的偏差角：
[0062]
agaccxorntn＝arcsin(accraw_x
÷
accsumvct):
[0063]
agaccyorntn＝arcsin(accraw_y
÷
accsumvct)；
[0064]
agacczorntn＝arccos(accraw_z
÷
accsumvct)；
[0065]
其中，agaccxorntn为加速度传感器x轴与车辆运动x轴的偏差角；agaccyorntn为加速度传感器y轴与车辆运动y轴的偏差角；agacczorntn为加速度传感器z轴与车辆运动z轴的偏差角；accraw_x为加速度传感器x轴的原始信号值；accraw_y为加速度传感器y轴的原始信号值；accraw_z为加速度传感器z轴的原始信号值；accsumvct为通过平方和公式计算得到的三轴信号向量和。
[0066]
具体的，加速度传感器三轴信号的补偿值的计算公式如下：
[0067]
cmps_x＝-accraw_x*cos(agaccxorntn)；
[0068]
cmps_y＝-accraw_y*cos(agaccyorntn)；
[0069]
cmps_z＝-accraw_z*cos(agacczorntn)；
[0070]
其中，cmps_x为加速度传感器x轴信号的静态补偿值；cmps_y为加速度传感器y轴信号的静态补偿值；cmps_z为加速度传感器x轴信号的静态补偿值；agaccxorntn为加速度传感器x轴与车辆运动x轴的偏差角；agaccyorntn为加速度传感器y轴与车辆运动y轴的偏差角；agacczorntn为加速度传感器z轴与车辆运动z轴的偏差角；accraw_x为加速度传感器x轴的原始信号值；accraw_y为加速度传感器y轴的原始信号值；accraw_z为加速度传感器z轴的原始信号值。
[0071]
具体的，车辆运动三轴方向的实际加速度值的计算公式如下：
[0072]
accx_cltd＝accraw_x
÷
cos(agaccxorntn) cmps_x；
[0073]
accy_cltd＝accraw_y
÷
cos(agaccyorntn) cmps_y；
[0074]
accz_cltd＝accraw_z
÷
cos(agacczorntn) cmps_z；
[0075]
其中，accx cltd为车辆运动x轴方向的实际加速度值；accy cltd为车辆运动y轴方向的实际加速度值；accz cltd为车辆运动z轴方向的实际加速度值；accraw_x为加速度传感器x轴的原始信号值；accraw_y为加速度传感器y轴的原始信号值；accraw_z为加速度传感器z轴的原始信号值；cmps_x为加速度传感器x轴信号的静态补偿值；cmps_y为加速度传感器y轴信号的静态补偿值；cmps_z为加速度传感器x轴信号的静态补偿值；agaccxorntn为加速度传感器x轴与车辆运动x轴的偏差角；agaccyorntn为加速度传感器y轴与车辆运动y轴的偏差角；agacczorntn为加速度传感器z轴与车辆运动z轴的偏差角。
[0076]
实施例
[0077]
本实施例采用用于车辆坡道估计的加速度传感器静态补偿校正方法对混合动力商用车进行加速度传感器静态补偿校正，具体步骤如下：
[0078]
步骤1，将混合动力商用车静止于水平路面，发动机停机，同时保证加速度传感器正常供电。
[0079]
步骤2，采集车辆加速度传感器三轴信号accraw_x、accraw_y以及accraw_z，本实例以采集的原始信号中accraw_x为例，accraw_x≈-0.65，如图3所示。
[0080]
步骤3，通过向量法求得加速度传感器原始三轴信号的向量和accsumvct，因车辆处于静止水平状态，因此该向量和应对应于车辆当前所处位置的重力加速度，如图2所示。
[0081]
步骤4，通过加速度传感器三轴信号的向量和accsumvct与各轴信号的三角函数关系，结合车辆运动方向三轴参考系，运用正弦关系可得到加速度传感器三轴轴与实际车辆各运动方向三轴的夹角agaccxorntn≈-0.069rad,agaccyorntn≈0.0033rad,agacczorntn≈0.069rad，如图4所示。
[0082]
步骤6，将已知的车辆加速度传感器三轴信号分别与上述夹角agaccxorntn、agaccyorntn以及agacczorntn的余弦值取积，得到重力加速度作用在车辆运动各方向的实际加速度补偿值cmps_x≈0.65,cmps_y≈0.031,cmps_z≈0.46，如图5所示。
[0083]
步骤7，在车辆运动过程中，对加速度传感器采集数值进行校正补偿。通过夹角agaccxorntn、agaccyorntn以及agacczorntn的余弦关系得到加速度传感器在车辆运动各方向的投影。
[0084]
该值只是原始加速度值经过方位偏差校正的值，并不是车辆运动各方向的实际加速度值。
[0085]
步骤8，将上述经过方位偏差校正的值叠加重力加速度作用到车辆运动各方向的实际加速度补偿值cmps_x,cmps_y,cmps_z，得到车辆运动各方向的实际加速度值cltd_x≈0.01,cltd_y≈-0.008,cltd_z≈9.79，如图6所示。
[0086]
综上所述，本发明提供了一种用于车辆坡道估计的加速度传感器静态补偿校正方法，通过加速度传感器自学习模型内计算对车辆加速度传感器进行静态的矫正补偿，得到更加准确的车辆纵向，横向，竖向加速度值，避免因生产差异及人工安装原因造成的加速度传感器方位偏差导致的输出信号误差，为后续车辆状态识别提供可靠的数据。
[0087]
最后应当说明的是：以上实施例仅用以说明本发明的技术方案而非对其限制，尽管参照上述实施例对本发明进行了详细的说明，所属领域的普通技术人员应当理解：依然可以对本发明的具体实施方式进行修改或者等同替换，而未脱离本发明精神和范围的任何修改或者等同替换，其均应涵盖在本发明的权利要求保护范围之内。