交通灯匹配过程中运动车辆定位滤波及预测方法
摘要:
本发明公开了一种交通灯匹配过程中运动车辆定位滤波及预测方法,包括以下步骤:确定车辆运行状态为驶向交通灯;实时采集车辆当前行驶位置定位信息和交通灯信息,并计算运动车辆与交通灯之间的距离;判断该距离是否逐渐变小:若距离逐渐变小,则没有定位误差,把距离值和定位信息缓存;若距离突然变大,且距离大于L,则连续累计次数CN加1,转入下一步;判断出现定位误差后进行滤波及预测,并修正距离值和定位数据。该方法在确定运动车辆驶向交通灯后,综合考虑运动车辆与交通灯之间的距离、运动车辆掉头时间等因素,使得定位设备出现定位误差时通过滤波及预测算法进行修正,实时性好,能够应用于嵌入式系统,容易应用于工程实践。
0/0