基于MEMS传感器的道面坡度提取方法技术

一种基于MEMS传感器的道面坡度提取方法。其包括数据采集、零加速状态检测、旋转四元数估计以及位置解算与坡度提取等步骤。在不增加额外传感器的基础上，本发明专利技术采用MEMS传感器实现对道面坡度提取的方法。该方法仅利用智能手机的MEMS传感器，通过零加速状态检测的方法实现对累积误差的修正，并利用重力加速度方向不变性，通过载体坐标系中的重力加速度矢量方向的变化间接地实现了道面坡度信息提取。实验结果表明，本发明专利技术算法可以准确地提取道面坡度信息并实现对道面坡度信息的定位。

Extraction Method of Road Slope Based on MEMS Sensor

A method of road slope extraction based on MEMS sensor is presented. It includes data acquisition, zero acceleration state detection, rotation quaternion estimation, position calculation and slope extraction. On the basis of not adding additional sensors, the invention adopts a method of extracting the gradient of pavement by using a MEMS sensor. In this method, the cumulative error is corrected by using the MEMS sensor of smartphone only, and the gradient information of road surface is extracted indirectly by using the invariance of gravity acceleration direction and the change of gravity acceleration vector direction in the carrier coordinate system. The experimental results show that the algorithm of the invention can accurately extract the information of the gradient of the road surface and realize the location of the information of the gradient of the road surface.

【技术实现步骤摘要】
基于MEMS传感器的道面坡度提取方法
本专利技术属于坡度提取
，特别是涉及一种基于MEMS传感器的道面坡度提取方法。
技术介绍
由惯性测量单元(inertialmeasurementunit,IMU)组成的惯性导航系统(inertialnavigationsystem,INS)可以精确地定位车辆的水平位置，但对高度和坡度的测量需额外的辅助传感器提供辅助参数。在车辆行驶过程中若遇到上下坡以及不同坡度的高架桥路面时，导航系统便有可能产生较大的估计偏差。如何较为精确地实现对高度位置和道面坡度的解算，引起业界学者的广泛关注。国内外道路坡度识别的方法可从实现原理上分为三类：基于全球定位系统(globalpositioningsystem,GPS)数据的方法、基于车辆动力学模型的方法和基于加速度估计的方法。基于GPS数据的方法，其测量精度取决于GPS的有效使用范围，且易受遮挡物的影响。基于车辆动力学模型的方法是建立车辆与道路坡度之间的动力学关系模型，其对传感设备精度要求较高。基于加速度估计的方法是利用加速度传感器估计车辆的俯仰角，并提取道路坡度信息。基于加速度估计的方法采用的加速度传感器大多是便携式微电子机械系统(micro-electromechanicalsystem,MEMS)传感器。该类传感器采集的数据精度较低，噪声干扰相对较大，且在解算过程中需要对加速度进行积分处理，引入了累积误差的问题，因此，此类方法通常需额外的辅助传感器提供辅助参数。J.Jang等利用轮速传感器采集的车辆速度数据，并据此解算出轨迹信息，Y.Son等采用气压计传感器来获得道路的绝对高度信息，张海等采用里程仪通过建模得到坡度，A.Norrdine等利用置于足底的传感器检测行人行走过程中脚触地时短暂的零速状态来实现对累积误差的修正。
技术实现思路
为了解决上述问题，本专利技术的目的在于提供一种基于MEMS传感器的道面坡度提取方法。为了达到上述目的，本专利技术提供的基于MEMS传感器的道面坡度提取方法包括按顺序进行的下列步骤：(1)利用智能手机内置的三轴加速度计、三轴陀螺仪和三轴磁力计在内的传感器采集小车运动数据，得到载体坐标系下三轴加速度、三轴角速度和三轴磁分量的S1阶段；(2)对步骤(1)得到的载体坐标系下三轴加速度和三轴角速度进行零加速检测，以判定小车是否处于零加速状态的S2阶段；(3)根据步骤(2)得到小车是否处于零加速状态的判定结果，得到零加速状态或非零加速状态下旋转四元数估计值的S3阶段；(4)利用步骤(3)得到的旋转四元数估计值实现三轴加速度和三轴角速度在载体坐标系与惯性坐标系之间的转换，并对地理坐标系的速度向量和位置向量进行更新，得到小车位置，同时进行坡度提取的S4阶段。在步骤(2)中，所述的对步骤(1)得到的载体坐标系下三轴加速度和三轴角速度进行零加速检测，以判定小车是否处于零加速状态的方法是：在零加速状态时，三轴加速度计的输出应为重力加速度的值，而三轴陀螺仪的输出应为零，分别计算三轴加速度和三轴角速度范数，设置阈值来判别当前时刻范数是否满足上述零加速状态下的条件。在步骤(3)中，所述的根据步骤(2)得到的小车是否处于零加速状态的判定结果，得到零加速状态或非零加速状态下旋转四元数估计值的方法是：若小车处于零加速状态，则根据零加速状态的特点对旋转四元数初始化；若小车处于非零加速状态，则根据前一时刻的旋转四元数进行旋转四元数更新。在步骤(4)中，所述的利用步骤(3)得到的旋转四元数估计值实现三轴加速度和三轴角速度在载体坐标系与惯性坐标系之间的转换关系，并对地理坐标系的速度向量和位置向量进行更新，同时进行坡度提取，得到小车位置的方法是：小车处于零加速状态条件时，将三轴加速度置为零，当前时刻的速度向量应该等于前一时刻的速度向量；小车处于非零加速状态条件时，利用旋转四元数估计值将三轴加速度由载体坐标系转换到惯性坐标系，将惯性坐标系下三轴加速度乘以采样时间加上前一时刻的速度向量来更新当前时刻的速度向量，然后将速度向量乘以采样时间加上前一时刻位置得到当前时刻的位置向量，重复上述过程即可得到小车位置。提取坡度的方法是：在坡度测量的过程中，地理坐标系是不动的，导航坐标系只是相对于地理坐标系平移，因此在两个坐标系中的重力加速度向量gn是不变化的。对于载体坐标系，在坡度测量的过程中是存在相对姿态的变化，即载体坐标系相对导航坐标系发生旋转，而且这个角度的变化是与平台所接触面的坡度有关，因此，在载体坐标系中重力加速度向量gb(t)的方向变化量均反映着平台所接触面的坡度变化情况。本文利用智能手机内置的MEMS传感器实现道面坡度提取，是在不外接惯性传感器件的情况下，直接利用智能手机的惯性传感器数据进行零加速状态检测，并在零加速状态时对定位系统进行状态估计与修正，实现高度解算，同时利用重力场的不变性，通过其在坡度测量中相对姿态的变化，实现了对道面坡度的提取。附图说明图1为本专利技术提供的基于MEMS传感器的道面坡度提取方法流程图。图2为相关坐标系间关系。图3为坡度提取原理图。图4为实验场景模型。图5为实验结果。具体实施方式下面结合附图和具体实施例对本专利技术提供的基于MEMS传感器的道面坡度提取方法进行详细说明。如图1所示，本专利技术提供的基于MEMS传感器的道面坡度提取方法包括按顺序进行的下列步骤：(1)利用智能手机内置的三轴加速度计、三轴陀螺仪和三轴磁力计在内的传感器采集小车运动数据，得到载体坐标系下三轴加速度、三轴角速度和三轴磁分量的S1阶段：智能手机内置三轴加速度计、三轴陀螺仪和三轴磁力计等传感器，在智能手机置于小车上并随小车一起运动时，利用手机端Matlab通过IP与电脑端Matlab互联，可以实时将三轴加速度、三轴角速度和三轴磁分量采集到电脑中。各传感器采集的数据将以载体坐标系数据的形式输出。(2)对步骤(1)得到的载体坐标系下三轴加速度和三轴角速度进行零加速检测，以判定小车是否处于零加速状态的S2阶段：零加速状态就是小车的平动加速度和转动加速度均为零的状态，即小车处于受力平衡态。虽然此时的速度可能不为零，但此时载体坐标系与导航坐标系间的位置关系相对固定，可以进行旋转四元数初始化，从而实现对惯性器件累积误差的修正。在零加速状态时，理论上三轴加速度计的输出为重力加速度的值，三轴陀螺仪的输出为零，但由于噪声的存在，在进行零加速检测时，需要对三轴加速度计采集的载体坐标系的加速度向量ab(t)＝[axtaytazt]T和三轴陀螺仪采集的角速度向量ωb(t)＝[ωxtωytωzt]T进行范数阈值判定。利用加速度向量ab(t)进行加速度检测：其中||·||表示向量的范数，thamin与thamax为加速度向量ab(t)的范数的上、下阈值。利用角速度向量ωb(t)进行角速度检测：其中，thωmax为角速度向量ωb(t)的范数的阈值。如上所述，同时满足以上两种条件时判定为零加速状态，即：T(t)＝T1(t)×T2(t)(3)(3)根据步骤(2)获得的小车是否处于零加速状态的判定结果，得到零加速状态或非零加速状态下旋转四元数估计值的S3阶段：当步骤(2)判定小车处于零加速状态时，利用零加速姿态估计方法得到此时的旋转四元数估计；当步骤(2)判定小车处于零加速状态，则根据本文档来自技高网...

【技术保护点】
1.一种基于MEMS传感器的道面坡度提取方法，其特征在于，所述的基于MEMS传感器的道面坡度提取方法包括按顺序进行的下列步骤：(1)利用智能手机内置的三轴加速度计、三轴陀螺仪和三轴磁力计在内的传感器采集小车运动数据，得到载体坐标系下三轴加速度、三轴角速度和三轴磁分量的S1阶段；(2)对步骤(1)得到的载体坐标系下三轴加速度和三轴角速度进行零加速检测，以判定小车是否处于零加速状态的S2阶段；(3)根据步骤(2)得到小车是否处于零加速状态的判定结果，得到零加速状态或非零加速状态下旋转四元数估计值的S3阶段；(4)利用步骤(3)得到的旋转四元数估计值实现三轴加速度和三轴角速度在载体坐标系与惯性坐标系之间的转换，并对地理坐标系的速度向量和位置向量进行更新，得到小车位置，同时进行坡度提取的S4阶段。

【技术特征摘要】
1.一种基于MEMS传感器的道面坡度提取方法，其特征在于，所述的基于MEMS传感器的道面坡度提取方法包括按顺序进行的下列步骤：(1)利用智能手机内置的三轴加速度计、三轴陀螺仪和三轴磁力计在内的传感器采集小车运动数据，得到载体坐标系下三轴加速度、三轴角速度和三轴磁分量的S1阶段；(2)对步骤(1)得到的载体坐标系下三轴加速度和三轴角速度进行零加速检测，以判定小车是否处于零加速状态的S2阶段；(3)根据步骤(2)得到小车是否处于零加速状态的判定结果，得到零加速状态或非零加速状态下旋转四元数估计值的S3阶段；(4)利用步骤(3)得到的旋转四元数估计值实现三轴加速度和三轴角速度在载体坐标系与惯性坐标系之间的转换，并对地理坐标系的速度向量和位置向量进行更新，得到小车位置，同时进行坡度提取的S4阶段。2.根据权利要求1所述的基于MEMS传感器的道面坡度提取方法，其特征在于，在步骤(2)中，所述的对步骤(1)得到的载体坐标系下三轴加速度和三轴角速度进行零加速检测，以判定小车是否处于零加速状态的方法是：在零加速状态时，三轴加速度计的输出应为重力加速度的值，而三轴陀螺仪的输出应为零，分别计算三轴加速度和三轴角速度范数，设置阈值来判别当前时刻范数是否满足上述零加速状态下的条件。3.根据权利要求1所述的基于MEMS传感器的道面坡度提取方法，其特征在于，在步骤(3)中，所述的根据步骤(2)得到的小车是否处于零加速状态的判...

【专利技术属性】
技术研发人员：郝敬堂，吴柳莉，苏志刚，马龙，韩冰，张亚娟，
申请(专利权)人：中国民航大学，
类型：发明
国别省市：天津,12