一种浮动车地图匹配数据预处理方法及系统

1.一种浮动车地图匹配数据预处理方法，包括以下步骤：
步骤一、对系统参数进行初始化设置，包括设置数据缓存区BL_Cache，用于存放历史的经、纬度，设定缓存长度Len_Cache＝1；
步骤二、接收GPS定位数据，陀螺仪和加速度计数据，并提取GPS速度V_GPS，陀螺仪测量的航向角的角速率值G_Ang，计算加速度计测量值与重力加速度g的差值Acc；
步骤三、判断是否是首次定位，如果是首次定位，则更新定位数据，将当前定位数据赋值给BL_Cache(Len_Cache)，结束预处理，否则继续后续步骤处理；
步骤四、判断车辆是否静止，若是，则维持定位数据不变，否则返回步骤二；
步骤五、判断车辆是否正在慢速行驶，若是，则取出缓存中的第一条记录BL_Cache(1)和最后一条记录BL_Cache(Len_Cache)，并利用BL_Cache(1)和BL_Cache(Len_Cache)存储的经纬度来重新计算航向角，否则，更新定位数据，将当前定位数据赋值给BL_Cache(Len_Cache)，结束预处理；
其中，所述步骤一中，对系统参数进行初始化设置还包括：
1)设置陀螺仪零值门限G_Static；
2)设置加速度零值门限Acc_Static；
3)设定速度静止门限值V_Static；
4)设定速度低速门限值V_Low；
5)设置距离门限值S_Lmt，用于车辆低速行驶时重新计算航向角；
所述步骤五中，判断车辆是否正在慢速行驶的方法是：
(1)取出缓存中的第一条定位数据，设该位置与当前定位位置的距离为S1，如果S1<距离门限值S_Lmt，则跳转步骤(4)；
(2)取出缓存中的第二条定位数据，设该位置与当前定位位置的距离为S2，如果S2<距离门限值S_Lmt，则跳转步骤(4)；
(3)执行如下循环语句：
For i＝1 to Len_Cache-1
BL_Cache(i)＝BL_Cache(i+1)
End
(4)缓冲区的长度加1，即令Len_Cache＝Len_Cache+1；
(5)判断V_GPS2.如权利要求1所述的一种浮动车地图匹配数据预处理方法，其特征是，步骤四中，判断车辆是否静止的方法是：当陀螺仪输出的航向角的角速率低于零值门限G_Static值，且加速度计输出的数值与重力加速度g的差值低于加速度零值门限Acc_Static值时，且GPS接收机输出的速度值低于速度静止门限值V_Static时，则判断车辆处于静止状态。
3.如权利要求2所述的一种浮动车地图匹配数据预处理方法，其特征是，
1)所述陀螺仪零值门限G_Static为0.03-0.07度/秒；
2)所述加速度零值门限Acc_Static为0.2-0.9m/s2；
3)所述速度静止门限值V_Static为0-1.8km/h；
4)所述速度低速门限值V_Low为20-40km/h；
5)所述距离门限值S_Lmt为25-35m。
4.如权利要求3所述的一种浮动车地图匹配数据预处理方法，其特征是，
1)所述陀螺仪零值门限G_Static为0.05度/秒；
2)所述加速度零值门限Acc_Static为0.6m/s2；
3)所述速度静止门限值V_Static为1km/h；
4)所述速度低速门限值V_Low为30km/h；
5)所述距离门限值S_Lmt为30m。
5.一种浮动车地图匹配数据预处理系统，包括预处理模块，与预处理模块连接的GPS定模块、速度计、地图数据模块和陀螺仪，其特征在于，所述的预处理模块包括以下装置：
初始化装置，用于对系统参数进行初始化设置，包括设置数据缓存区BL_Cache，用于存放历史的经、纬度，设定缓存长度Len_Cache＝1；
数据接收及提取装置，用于接收GPS定位数据，陀螺仪和加速度计数据，并提取GPS速度V_GPS，陀螺仪测量的航向角的角速率值G_Ang，计算加速度计测量值与重力加速度g的差值Acc；
判断装置一，用于判断是否是首次定位，如果是首次定位，则更新定位数据，将当前定位数据赋值给BL_Cache(Len_Cache)，结束预处理，否则继续后续步骤处理；
判断装置二，用于判断车辆是否静止，若是，则维持定位数据不变，否则返回数据接收及提取装置继续接收及提取相关数据；
判断装置三，用于判断车辆是否正在慢速行驶，若是，则取出缓存中的第一条记录BL_Cache(1)和最后一条记录BL_Cache(Len_Cache)，并利用BL_Cache(1)和BL_Cache(Len_Cache)存储的经纬度来重新计算航向角，否则，更新定位数据，将当前定位数据赋值给BL_Cache(Len_Cache)，结束预处理；
其中，所述初始化装置对系统参数进行初始化设置还包括：
1)设置陀螺仪零值门限G_Static；
2)设置加速度零值门限Acc_Static；
3)设定速度静止门限值V_Static；
4)设定速度低速门限值V_Low；
5)设置距离门限值S_Lmt，用于车辆低速行驶时重新计算航向角；
所述判断装置三判断车辆是否正在慢速行驶的方法是：
(1)取出缓存中的第一条定位数据，设该位置与当前定位位置的距离为S1，如果S1<距离门限值S_Lmt，则跳转步骤(4)；
(2)取出缓存中的第二条定位数据，设该位置与当前定位位置的距离为S2，如果S2<距离门限值S_Lmt，则跳转步骤(4)；
(3)执行如下循环语句：
For i＝1 to Len_Cache-1
BL_Cache(i)＝BL_Cache(i+1)
End
(4)缓冲区的长度加1，即令Len_Cache＝Len_Cache+1；
(5)判断V_GPS6.如权利要求5所述的一种浮动车地图匹配数据预处理系统，其特征在于，判断装置二判断车辆是否静止的方法是：当陀螺仪输出的航向角的角速率低于零值门限G_Static值，且加速度计输出的数值与重力加速度g的差值低于加速度零值门限Acc_Static值时，且GPS接收机输出的速度值低于速度静止门限值V_Static时，则判断车辆处于静止状态。

一种浮动车地图匹配数据预处理方法及系统\n技术领域\n[0001] 本发明属于智能交通车载定位技术领域，特别涉及一种用于城市道路拥堵分析的浮动车地图匹配数据预处理方法及系统。\n背景技术\n[0002] 基于GPS浮动车的城市道路交通拥堵分析技术被认为是实现先进的交通诱导的重要途径,基于GPS浮动车交通参数检测技术作为一种新的检测方式，如何提高其检测性能是目前的核心问题。城市道路拥堵分析主要包括浮动车GPS定位数据获取、地图匹配、路段交通状态及路网拥堵计算、交通决策等内容。\n[0003] 全球定位系统(Global Positioning System，简称GPS)提供实时、全天候和全球性的导航服务，可以提供车辆定位、行驶路线监控等功能。由于GPS技术所具有的全天候、高精度和自动测量的特点，已经融入了国民经济建设、国防建设和社会发展的各个应用领域。\n随着城市车辆保有量的急剧增加，城市道路拥挤不堪，交通事故频频发生，把GPS用于城市道路拥堵收费，将显著提高城市道路运营的效率和增加行车的安全性。\n[0004] 地图匹配技术是指通过浮动车装载的GPS接收机获取车辆的实时位置信息，通过一定的算法将其匹配到当时车辆所在的路段或者交通区域内。目前常用的地图匹配算法有:几何投影匹配算法、证据理论算法、概率匹配算法、模糊推理算法等。\n[0005] 但是，现有的GPS卫星定位技术用于车辆定位时存在以下两类显著的误差，一则车辆低速行驶时其航向角存在较大的误差，二则在静止时也存在较大的漂移。现有地图匹配技术尚未充分考虑并处理上述GPS的定位问题，这样将导致地图匹配精度变差，性能变坏，甚至产生错误的结果。\n[0006] 因此，当浮动车处于静止状态或低速行驶状态时，其车载GPS接收机产生的定位数据中航向角的误差较大，如果不进行预处理，则在地图匹配计算时将使得匹配精度或性能降低，甚至产生错误的匹配结果，从而在进行道路拥堵分析中产生错误的结果。为此，需要提出一种数据预处理方法，能够修正定位数据，提高定位精度，从而在地图匹配时提高匹配精度和匹配性能，正确进行道路拥堵计算。\n发明内容\n[0007] 针对现有技术中存在的缺陷，本发明的目的是提供一种用于城市道路拥堵分析的浮动车地图匹配数据预处理方法及系统。该方法及系统能够利用GPS历史定位数据解决车辆在低速行驶时航向角不准的问题，及车辆静止时GPS定位数据产生的漂移问题，从而提高地图匹配的精度和匹配的性能，以便能正确将定位数据匹配到相应的路段上并进行拥堵分析，为城市道路拥堵收费提供全面的定位技术支持。\n[0008] 为达到以上目的，本发明采用的技术方案是，一种浮动车地图匹配数据预处理方法，包括以下步骤：\n[0009] 步骤一、对系统参数进行初始化设置，包括设置数据缓存区BL_Cache，用于存放历史的经、纬度，设定缓存长度Len_Cache＝1；\n[0010] 步骤二、接收GPS定位数据，陀螺仪和加速度计数据，并提取GPS速度V_GPS，陀螺仪测量的航向角的角速率值G_Ang，计算加速度计测量值与重力加速度g的差值Acc；\n[0011] 步骤三、判断是否是首次定位，如果是首次定位，则更新定位数据，将当前定位数据赋值给BL_Cache(Len_Cache)，结束预处理，否则继续后续步骤处理；\n[0012] 步骤四、判断车辆是否静止，若是，则维持定位数据不变，否则返回步骤二；\n[0013] 步骤五、判断车辆是否正在慢速行驶，若是，则取出缓存中的第一条记录BL_Cache(1)和最后一条记录BL_Cache(Len_Cache)，并利用BL_Cache(1)和BL_Cache(Len_Cache)存储的经纬度来重新计算航向角。重新计算航向角，否则，更新定位数据，将当前定位数据(经纬度)赋值给BL_Cache(Len_Cache)，结束预处理。\n[0014] 进一步，步骤一中对系统参数进行初始化设置还包括：\n[0015] 1)设置陀螺仪零值门限G_Static；\n[0016] 2)设置加速度零值门限Acc_Static；\n[0017] 3)设定速度静止门限值V_Static；\n[0018] 4)设定速度低速门限值V_Low；\n[0019] 5)设置距离门限值S_Lmt，用于车辆低速行驶时重新计算航向角。\n[0020] 更进一步，\n[0021] 1)所述陀螺仪零值门限G_Static为0.03-0.07度/秒；\n[0022] 2)所述加速度零值门限Acc_Static为0.2-0.9m/s2；\n[0023] 3)所述速度静止门限值V_Static为0-1.8km/h；\n[0024] 4)所述速度低速门限值V_Low为20-40km/h；\n[0025] 5)所述距离门限值S_Lmt为25-35m。\n[0026] 再进一步，\n[0027] 1)所述陀螺仪零值门限G_Static为0.05度/秒；\n[0028] 2)所述加速度零值门限Acc_Static为0.6m/s2；\n[0029] 3)所述速度静止门限值V_Static为1km/h；\n[0030] 4)所述速度低速门限值V_Low为30km/h；\n[0031] 5)所述距离门限值S_Lmt为30m。\n[0032] 进一步，步骤四中，判断车辆是否静止的方法是：当陀螺仪输出的航向角的角速率低于零值门限G_Static值，且加速度计输出的数值与重力加速度g的差值低于加速度零值门限Acc_Static值时，且GPS接收机输出的速度值低于速度静止门限值V_Static时，则判断车辆处于静止状态。\n[0033] 进一步，步骤五中，判断车辆是否正在慢速行驶的方法是：\n[0034] (1)取出缓存中的第一条定位数据，设该位置与当前定位位置的距离为S1，如果S1<距离门限值S_Lmt，则跳转步骤(4)；\n[0035] (2)取出缓存中的第二条定位数据，设该位置与当前定位位置的距离为S2，如果S2<距离门限值S_Lmt，则跳转步骤(4)；\n[0036] (3)执行如下循环语句：\n[0037] For i＝1 to Len_Cache-1\n[0038] BL_Cache(i)＝BL_Cache(i+1)\n[0039] End\n[0040] (4)缓冲区的长度加1，即令Len_Cache＝Len_Cache+1；\n[0041] (5)判断V_GPS