科研之友
微信
新浪微博
Facebook
分享链接
摘要
为实现自主代客泊车系统高精度定位功能，提出一种基于矢量地图的多传感器融合定位算法。采用视觉语义特征对自动驾驶车辆周围的环境进行表达，使定位效果能够实现长期的一致性，并将其与矢量化地图数据进行匹配，实现基于视觉输入的绝对位姿的解算。为实现上述功能，提出一种新的匹配策略以解决观测数据和矢量化地图数据表达不一致问题。同时，通过设计合理的误差函数将姿态估计问题建模为非线性优化问题，以获得高精度的解算结果。此外，为提升定位结果的鲁棒性，使用基于误差状态的卡尔曼滤波器将视觉匹配定位的结果与惯性测量单元（IMU）、轮速计的测量值进行融合，得到一种紧耦合的模块化定位方法。基于真实数据的验证结果表明，提出的算法可行，与主流方法相比可以获得更高的性能。
-
单位中国第一汽车股份有限公司
