摘要
本发明涉及一种车辆位置估计方法,用于解决由于自动驾驶车辆运行环境复杂多变引起的导航定位传感器的精度波动而引起定位不准确的问题,提高车辆定位的精度与鲁棒性。本发明的技术方案如下:确定在车辆定位中使用的传感器集合,对传感器集合中的每个传感器,确定要估计的状态集合;对状态集合中每个状态,计算每个状态估计产生的损失,并对损失进行修正;利用每个状态修正后的损失进行定位准确率计算,进而建立全局定位准确率函数,获取使全局定位准确率函数取得最大值的系统状态作为最优估计值,将最优估计值作为车辆最优位置信息。