[发明专利]车轮安装惯性测量单元的安装参数现场标定方法

说明书

本发明公开了一种车轮安装惯性测量单元的安装参数现场标定方法，包括粗标定和精标定两个阶段；粗标定阶段：在水平路面，车辆开始处于静止状态，采集静止状态下的加速度计输出，之后令车辆在水平路面沿直线运动一小段距离，采集直线运动状态下的陀螺输出，由TRIAD算法确定轴对准误差矩阵粗值。精标定阶段：令车辆由静止开始，在水平路面自由行驶，通过车辆运动学约束和惯性测量单元的输出建立卡尔曼滤波器，采集IMU输出，代入扩展卡尔曼滤波器，通过所述卡尔曼滤波器计算惯性测量单元相对于车轮的偏心距和轴对准误差精确值，同时能估计车辆位姿。本发明有助于减少车轮IMU安装难度和使用成本，提高基于车轮安装IMU的车辆定位精度。

技术领域

本发明属于惯性导航技术领域，具体涉及一种车轮安装惯性测量单元的安装参数现场标定方法，用以提高基于车轮安装惯性测量单元的车辆定位精度和效果。

背景技术

自动驾驶技术发挥越来越重要的作用，车辆自主定位是自动驾驶车辆的一个核心功能。惯性导航具有输出信息不间断、不受外界干扰等独特优势，被广泛用于车辆自主定位。

惯性导航面临的主要问题是定位误差随时间发散严重，针对该问题，文献[1]([1]Collin J.MEMS IMU Carouseling for Ground Vehicles[J].IEEE Transactions onVehicular Technology,2015,64(6):2242-2251)中，Collin提出将微机电系统(Micro-Electro-Mechanical System，MEMS)惯性测量单元(Initial Measurement Unit，IMU)安装在车轮的车辆定位方案，通过三轴加速度计感知重力加速度获得车轮转动的圈数，实现“里程计”测量效果，利用车轮旋转调制作用抑制陀螺的零漂，并由陀螺感知车辆的姿态，最终达到定位的目的，在近1km的定位实验中最大误差不超过8m。

常规的里程计往往要在车辆出厂前安装好。常规的旋转调制捷联惯导系统需要复杂精密的机电控制系统，可有效抑制惯性器件的系统误差。一个IMU仅仅通过安装在车轮上便可等效于里程计和单轴旋转捷联惯导系统的组合，大大提升了惯性导航定位精度。

文献[1]中，利用特制夹具，将MEMS IMU安装于车轮轴心，但IMU外壳中心不等同于加速度计敏感中心，安装时难以保证加速度计敏感中心恰好在车轮转轴上，存在偏心距，由此会因车轮旋转产生向心加速度和切向加速度并作用于加速度计，影响对车轮转速的准确估计。IMU相对于车轮的轴对准误差在安装时也是难以避免的，它将等效为IMU的系统误差影响车辆方位估计精度。尤其在车辆运动速度较快时，安装误差将使得基于车轮安装IMU的车辆定位模型误差突显，进一步降低车辆定位精度。利用特制夹具可以一定程度减少安装误差，但增加了安装难度和使用成本。

发明内容

本发明的目的是针对现有技术存在的问题，提供一种车轮安装惯性测量单元的安装参数现场标定方法，抑制车轮IMU安装误差对车辆定位精度的影响，提高基于车轮安装IMU的车辆定位精度。

为实现上述目的，本发明采用的技术方案是：

一种车轮安装惯性测量单元的安装参数现场标定方法，包括以下步骤：

S1，粗标定阶段，车辆在水平路面开始处于静止状态，之后沿直线行驶一小段距离，通过三轴姿态确定(TRIaxial Attitude Determination，TRIAD)算法获得惯性测量单元相对于车轮的轴对准误差的粗略值；

S2，精标定阶段，车辆在水平路面开始处于静止状态，之后在水平路面自由行驶，通过车辆运动学约束和惯性测量单元的输出建立卡尔曼滤波器，并根据所述卡尔曼滤波器计算惯性测量单元相对于车轮的偏心距和轴对准误差精确值，同时估计出车辆位姿。

具体地，步骤S1包括：

S11，采集车辆停止状态下三轴加速度计(简称加速度计)的输出值，并对1秒内加速度计的输出值取平均值；