[发明专利]一种MEMS传感器的数据处理方法

说明书

本发明提供了一种MEMS传感器的数据处理方法，包括以下步骤：1）初始化时，将k次的六轴数据作为测量值存入存储区；2）计算第k次与第k‑1、k‑2...2、1次数据的差的平均值，以及卡尔曼系数的过程噪声协方差值和测量噪声协方差的值；3）假定第k次数据的预测值等于第k‑1次数据的估计值，将预测值代入卡尔曼滤波算法，得到第k次的数据估计值，以及卡尔曼状态矩阵和增益矩阵；4）用步骤3得到的数据估计值，通过卡尔曼算法计算第k次的角度估计值；5）传感器采集第k+1次的数据后，重复进行步骤2‑4。本发明动态调节卡尔曼滤波预测参数，数据准确、实时性高、波动小，避免了车轮在转向时左右轮产生拖滑现象，保障了汽车转向的稳定性，提升了用户的体验。

技术领域

本发明涉及新能源汽车领域,具体涉及一种MEMS传感器的数据处理方法。

背景技术

随着电动汽车的普及，多轮独立电驱动车辆由电动机直接驱动车轮或者采用轮毂电机形式将电动机和车轮集成为一体，省掉了离合器、变速器、传动桥以及差速器等传统传动环节。对于多轮独立电驱动的电动汽车来说，各个车轮由单独的驱动电机驱动，驱动转矩可以独立控制，需要通过计算电子差速的方法解决汽车转向时的差速问题，避免车轮在转向时左右轮产生拖滑现象，在一定程度上保障汽车转向的稳定性。

电子差速需要车辆方向盘转角、车辆的侧倾角、车辆的俯仰角、车辆的三轴加速度、车辆的Z轴角速度变量，其中车辆方向盘转角可以直接获得，其他参数是基于车辆运动条件下的参数，现有的技术中是利用MEMS传感器进行数据采集处理和角度估计。由于从数据采集到计算出电子差速的时间需要在汽车拖滑现象发生前的很短时间内完成，所以要求数据采集以及计算尽可能的快，MEMS传感器相对于其他传感器采集数据更快速、准确。

现有的MEMS传感器的数据处理普遍是采用先用平均值滤波对采样数据进行初步处理，再采用三轴加速度计与三轴陀螺仪的数据进行卡尔曼滤波方法融合计算X、Y、Z的角度值的方法。这种方法应用在车辆角度估计中时，在平均值滤波取滤波数据过多的情况下，会造成有效数据延迟；在平均值滤波取滤波数据较少的情况下，会造成有滤波数据波动大和角度数据波动大的问题；所以这种情况下都会造成有效数据延迟、数据波动大、峰值数据不准确。同样如果使用常规的卡尔曼滤波进行六轴数据的单轴滤波时，也会出现数据在某个范围内数据波动较大或者较小的问题。在高速运动的车辆中，有效数据的延迟、角度数据大幅波动以及峰值数据不准确都会造成车辆功能达不到预期。

发明内容

为解决上述问题，本发明提供了一种MEMS传感器的数据处理方法,该方案计算速度更快，数据更准确，其动态峰值性能更好。

本发明解决其技术问题所采用的技术方案是：一种MEMS传感器的数据处理方法，所述的数据为六轴数据，包括角速度数据和加速度数据，所述的角速度数据包括X、Y、Z三个方向的角速度，所述的加速度数据包括X、Y、Z三个方向的加速度，所述的数据处理方法包括以下步骤：

步骤1：初始化时，将MEMS传感器采集的k(k≥1)次的六轴数据作为测量值存入存储区；

步骤2：计算第k次数据与第k-1、k-2....2、1次数据的差的平均值，并计算卡尔曼系数的过程噪声协方差值(Q)和测量噪声协方差的值(R)；

步骤3：假定第k次数据的预测值等于第k-1次数据的估计值，将所述的预测值代入卡尔曼滤波算法，得到第k次的MEMS传感器的数据估计值，以及卡尔曼状态矩阵和增益矩阵；

步骤4：用步骤3得到的数据估计值，通过卡尔曼算法计算第k次角度的估计值；

步骤5：传感器采集第k+1次的数据后，重复进行步骤2-4；

所述步骤1至步骤5中的数据处理方法针对六轴数据的六个数据变量分别计算。

进一步地，步骤2通过以下公式分别计算第k次数据的Q(k)和R(k)：