1.IMU导航原理及误差
1.1.IMU定位原理
IMU 纯惯性元件位姿估计原理为首先将测量的角速度积分推算姿态,根据姿态信息将测量的加速度投影到导航坐标系,进而对投影后的加速度去除重力后进行积分推算位置。
图1 MEMS/IMU捷联式惯性导航系统(INS)的结构框图
1.2.IMU误差及处理技术
不同于航空航天领域所使用的激光陀螺、光纤陀螺等惯性元件,车用领域采用的低成本MEMS (Micro-electromechanical Systems)惯性传感器,其测量误差较大。如0.01m/s^2沿车辆侧向的加速度偏置误差,匀速直线行驶20秒即可产生2米偏差,而标准为3.75米车道,则定位结果已经偏离当前车道。同时在无姿态修正下0.01°/s的角速度偏差30秒即可产生10米的误差,如下图所示。
图2 无约束修正的纯积分误差影响
影响IMU惯性器件精度的误差主要可以分为确定性误差和随机误差,在误差影响中其中位置误差与角速度传感器积分时间三次方正相关、与加速度传感器积分时间平方成正相关,同时由于IMU所用航位推算算法为积分运算,需要位置、速度和姿态初值,这些初值直接影响到后面积分运算结果,所以需要考虑初始对准导致的误差。
A.确定性误差
确定性误差,又称为系统误差,是惯性器件主要的误差源,主要有零偏、刻度因数误差和交叉耦合项误差等,误差处理方法主要有两种:一类是在实际工艺中,主要靠改进惯性仪表设计工艺来提高惯性器件的精度;第二类通常为传感器标定技术的补偿修正,其中加速度计、陀螺组件测量误差会建模为:
B.随机误差
随机误差对惯性导航系统的精度有很大的影响,一般随机误差统计规律,通常采用滤波算法处理补偿或一阶马尔可夫过程对陀螺随机漂移误差和加速度计随机漂移误差进行建模,式中最后一项分别为陀螺仪和加速度计误差的高斯白噪声。
C.初始对准误差
1.3.IMU总结
2.GNSS定位及误差分析
2.1.GNSS定位原理
图3 相对定位原理及分类
2.2.GNSS姿态测量原理
2.3.GNSS误差及处理
表1 NovAtel SPAN-CPT在GNSS中断下的精度
2.4.GNSS概述
3 .轮速定位及误差
3.1.轮速定位原理
3.2.轮速定位误差
4.激光雷达定位
4.1.激光定位原理
图5 测距原理
通过测量点的扫描距离和垂直角及水平角,在激光雷达坐标系中可以得到其坐标:
通过车身坐标系与激光雷达坐标系的转换可以得到车身坐标系下得坐标:
4.2.激光雷达误差处理
5.视觉定位及误差处理
5.1.视觉定位原理
5.2.视觉定位误差来源
6.地图匹配算法
6.1.地图匹配原理
6.2.地图匹配算法
6.3.地图匹配概述
7.总结
表2 定位传感器特性对比