文件名称:完整算法流程-s5pv210 irom编程及启动介绍
文件大小:782KB
文件格式:PDF
更新时间:2024-06-27 12:47:35
gps 地图匹配
6.4 完整算法流程 Step1 :从车载 GPS 接收机获得最新的轨迹信息。 Step2 :用 6.2中设计的卡尔曼滤波器预测方程预测当前的位置、速度、位 置偏差量。 Step3 :将新的车辆位置、速度信息、位置偏差信息作为对应状态量的观测 值,用卡尔曼滤波器的更新方程更新 Step2中的预测值。 Step4 :将更新后的车辆位置按照最短距离原则确定匹配道路并垂直匹配到 路段上。更新位置偏差信息。 Step5 :判断匹配到当前路段上的匹配点数是否为 effC ,如果是,利用论文 6.4部分介绍的方法更新卡尔曼滤波器状态空间以及状态估计方差。并转到 Step1, 否则直接转到 Step1.