《一种浮动车地图匹配数据预处理方法及系统.pdf》由会员分享,可在线阅读,更多相关《一种浮动车地图匹配数据预处理方法及系统.pdf(12页完整版)》请在专利查询网上搜索。
1、(10)申请公布号 CN 103727946 A (43)申请公布日 2014.04.16 CN 103727946 A (21)申请号 201310712862.2 (22)申请日 2013.12.20 G01C 21/26(2006.01) G08G 1/01(2006.01) (71)申请人 北京握奇数据系统有限公司 地址 100102 北京市朝阳区望京利泽中园 101 号启明国际大厦 7 层 (72)发明人 余振华 (74)专利代理机构 北京天悦专利代理事务所 ( 普通合伙 ) 11311 代理人 田明 任晓航 (54) 发明名称 一种浮动车地图匹配数据预处理方法及系统 (57) 摘要。
2、 本发明涉及一种浮动车地图匹配数据预处理 方法及系统。本发明所述的方法包括以下步骤 : 对系统参数进行初始化设置 ; 接收 GPS 定位数据, 陀螺仪和加速度计数据, 并提取 GPS 速度, 陀螺仪 测量的航向角的角速率值, 计算加速度计测量值 与重力加速度 g 的差值 Acc ; 判断是否是首次定 位, 判断车辆是否静止, 及判断车辆是否正在慢速 行驶, 根据判断情况进行定位数据的更新等操作。 采用本发明所述的方法和系统可以利用 GPS 历史 定位数据解决车辆在低速行驶时航向角不准的问 题, 及车辆静止时 GPS 定位数据产生的漂移问题, 从而提高地图匹配的精度和匹配的性能, 以便能 正确将。
3、定位数据匹配到相应的路段上并进行拥堵 分析, 为城市道路拥堵收费提供全面的定位技术 支持。 (51)Int.Cl. 权利要求书 3 页 说明书 5 页 附图 3 页 (19)中华人民共和国国家知识产权局 (12)发明专利申请 权利要求书3页 说明书5页 附图3页 (10)申请公布号 CN 103727946 A CN 103727946 A 1/3 页 2 1. 一种浮动车地图匹配数据预处理方法, 包括以下步骤 : 步骤一、 对系统参数进行初始化设置, 包括设置数据缓存区 BL_Cache, 用于存放历史的 经、 纬度, 设定缓存长度 Len_Cache=1 ; 步骤二、 接收 GPS 定位数。
4、据, 陀螺仪和加速度计数据, 并提取 GPS 速度 V_GPS, 陀螺仪测 量的航向角的角速率值 G_Ang, 计算加速度计测量值与重力加速度 g 的差值 Acc ; 步骤三、 判断是否是首次定位, 如果是首次定位, 则更新定位数据, 将当前定位数据赋 值给 BL_Cache(Len_Cache), 结束预处理, 否则继续后续步骤处理 ; 步骤四、 判断车辆是否静止, 若是, 则维持定位数据不变, 否则返回步骤二 ; 步骤五、 判断车辆是否正在慢速行驶, 若是, 则取出缓存中的第一条记录 BL_Cache(1) 和最后一条记录BL_Cache(Len_Cache), 并利用BL_Cache(1。
5、)和BL_Cache(Len_Cache)存储 的经纬度来重新计算航向角, 否则, 更新定位数据, 将当前定位数据赋值给 BL_Cache(Len_ Cache), 结束预处理。 2. 如权利要求 1 所述的一种浮动车地图匹配数据预处理方法, 其特征是, 步骤一中对 系统参数进行初始化设置还包括 : 1) 设置陀螺仪零值门限 G_Static; 2) 设置加速度零值门限 Acc_Static; 3) 设定速度静止门限值 V_Static ; 4) 设定速度低速门限值 V_Low ; 5) 设置距离门限值 S_Lmt, 用于车辆低速行驶时重新计算航向角。 3. 如权利要求 2 所述的一种浮动车地。
6、图匹配数据预处理方法, 其特征是, 步骤四中, 判 断车辆是否静止的方法是 : 当陀螺仪输出的航向角的角速率低于零值门限 G_Static 值, 且 加速度计输出的数值与重力加速度 g 的差值低于加速度零值门限 Acc_Static 值时, 且 GPS 接收机输出的速度值低于速度静止门限值 V_Static 时, 则判断车辆处于静止状态。 4. 如权利要求 2 所述的一种浮动车地图匹配数据预处理方法, 其特征是, 步骤五中, 判 断车辆是否正在慢速行驶的方法是 : (1)取出缓存中的第一条定位数据, 设该位置与当前定位位置的距离为S1, 如果S1距 离门限值 S_Lmt, 则跳转步骤 (4) 。
7、; (2)取出缓存中的第二条定位数据, 设该位置与当前定位位置的距离为S2, 如果S2距 离门限值 S_Lmt, 则跳转步骤 (4) ; (3) 执行如下循环语句 : For i=1to Len_Cache-1 BL_Cache(i)=BL_Cache(i+1) End (4) 缓冲区的长度加 1, 即令 Len_Cache=Len_Cache+1 ; (5) 判断 V_GPSV_Low 是否成立, 如果成立, 则说明车辆正在慢速行驶。 5. 如权利要求 2 所述的一种浮动车地图匹配数据预处理方法, 其特征是, 1) 所述陀螺仪零值门限 G_Staticy 为 0.03-0.07 度 / 秒 。
8、; 2) 所述加速度零值门限 Acc_Static 为 0.2-0.9m/s2; 3) 所述速度静止门限值 V_Static 为 0-1.8km/h ; 权 利 要 求 书 CN 103727946 A 2 2/3 页 3 4) 所述速度低速门限值 V_Low 为 20-40km/h ; 5) 所述距离门限值 S_Lmt 为 25-35m。 6. 如权利要求 5 所述的一种浮动车地图匹配数据预处理方法, 其特征是, 1) 所述陀螺仪零值门限 G_Staticy 为 0.05 度 / 秒 ; 2) 所述加速度零值门限 Acc_Static 为 0.6m/s2; 3) 所述速度静止门限值 V_St。
9、atic 为 1km/h ; 4) 所述速度低速门限值 V_Low 为 30km/h ; 5) 所述距离门限值 S_Lmt 为 30m。 7. 一种浮动车地图匹配数据预处理系统, 包括预处理模块, 与预处理模块连接的 GPS 定模块、 速度计、 地图数据模和陀螺仪, 其特征在于, 所述的预处理模块包括以下装置 : 初始化装置, 用于对系统参数进行初始化设置, 包括设置数据缓存区 BL_Cache, 用于存 放历史的经、 纬度, 设定缓存长度 Len_Cache=1 ; 数据接收及提取装置, 用于接收 GPS 定位数据, 陀螺仪和加速度计数据, 并提取 GPS 速 度 V_GPS, 陀螺仪测量的。
10、航向角的角速率值 G_Ang, 计算加速度计测量值与重力加速度 g 的 差值 Acc ; 判断装置一, 用于判断是否是首次定位, 如果是首次定位, 则更新定位数据, 将当前定 位数据赋值给 BL_Cache(Len_Cache), 结束预处理, 否则继续后续步骤处理 ; 判断装置二, 用于判断车辆是否静止, 若是, 则维持定位数据不变, 否则返回数据接收 及提取装置继续接收及提取相关数据 ; 判断装置三, 用于判断车辆是否正在慢速行驶, 若是, 则取出缓存中的第一条记录 BL_ Cache(1) 和最后一条记录 BL_Cache(Len_Cache), 并利用 BL_Cache(1) 和 BL。
11、_Cache(Len_ Cache) 存储的经纬度来重新计算航向角, 否则, 更新定位数据, 将当前定位数据赋值给 BL_ Cache(Len_Cache), 结束预处理。 8. 如权利要求 7 所述的一种浮动车地图匹配数据预处理系统, 其特征在于, 初始化装 置对系统参数进行初始化设置还包括 : 1) 设置陀螺仪零值门限 G_Static; 2) 设置加速度零值门限 Acc_Static; 3) 设定速度静止门限值 V_Static ; 4) 设定速度低速门限值 V_Low ; 5) 设置距离门限值 S_Lmt, 用于车辆低速行驶时重新计算航向角。 9. 如权利要求 8 所述的一种浮动车地图。
12、匹配数据预处理系统, 其特征在于, 判断装置 二判断车辆是否静止的方法是 : 当陀螺仪输出的航向角的角速率低于零值门限 G_Static 值, 且加速度计输出的数值与重力加速度 g 的差值低于加速度零值门限 Acc_Static 值时, 且 GPS 接收机输出的速度值低于速度静止门限值 V_Static 时, 则判断车辆处于静止状态。 10. 如权利要求 8 或 9 所述的一种浮动车地图匹配数据预处理系统, 其特征在于, 判断 装置三判断车辆是否正在慢速行驶的方法是 : (1)取出缓存中的第一条定位数据, 设该位置与当前定位位置的距离为S1, 如果S1距 离门限值 S_Lmt, 则跳转步骤 (。
13、4) ; (2)取出缓存中的第二条定位数据, 设该位置与当前定位位置的距离为S2, 如果S2距 权 利 要 求 书 CN 103727946 A 3 3/3 页 4 离门限值 S_Lmt, 则跳转步骤 (4) ; (3) 执行如下循环语句 : For i=1to Len_Cache-1 BL_Cache(i)=BL_Cache(i+1) End (4) 缓冲区的长度加 1, 即令 Len_Cache=Len_Cache+1 ; (5) 判断 V_GPSV_Low 是否成立, 如果成立, 则说明车辆正在慢速行驶。 权 利 要 求 书 CN 103727946 A 4 1/5 页 5 一种浮动车地。
14、图匹配数据预处理方法及系统 技术领域 0001 本发明属于智能交通车载定位技术领域, 特别涉及一种用于城市道路拥堵分析的 浮动车地图匹配数据预处理方法及系统。 背景技术 0002 基于 GPS 浮动车的城市道路交通拥堵分析技术被认为是实现先进的交通诱导的 重要途径 , 基于 GPS 浮动车交通参数检测技术作为一种新的检测方式, 如何提高其检测性 能是目前的核心问题。城市道路拥堵分析主要包括浮动车 GPS 定位数据获取、 地图匹配、 路 段交通状态及路网拥堵计算、 交通决策等内容。 0003 全球定位系统 (Global Positioning System, 简称 GPS) 提供实时、 全天候。
15、和全球 性的导航服务, 可以提供车辆定位、 行驶路线监控等功能。由于 GPS 技术所具有的全天候、 高精度和自动测量的特点, 已经融入了国民经济建设、 国防建设和社会发展的各个应用领 域。随着城市车辆保有量的急剧增加, 城市道路拥挤不堪, 交通事故频频发生, 把 GPS 用于 城市道路拥堵收费, 将显著提高城市道路运营的效率和增加行车的安全性。 0004 地图匹配技术是指通过浮动车装载的 GPS 接收机获取车辆的实时位置信息, 通过 一定的算法将其匹配到当时车辆所在的路段或者交通区域内。目前常用的地图匹配算法 有 : 几何投影匹配算法、 证据理论算法、 概率匹配算法、 模糊推理算法等。 000。
16、5 但是, 现有的 GPS 卫星定位技术用于车辆定位时存在以下两类显著的误差, 一则 车辆低速行驶时其航向角存在较大的误差, 二则在静止时也存在较大的漂移。现有地图匹 配技术尚未充分考虑并处理上述 GPS 的定位问题, 这样将导致地图匹配精度变差, 性能变 坏, 甚至产生错误的结果。 0006 因此, 当浮动车处于静止状态或低速行驶状态时, 其车载 GPS 接收机产生的定位 数据中航向角的误差较大, 如果不进行预处理, 则在地图匹配计算时将使得匹配精度或性 能降低, 甚至产生错误的匹配结果, 从而在进行道路拥堵分析中产生错误的结果。为此, 需 要提出一种数据预处理方法, 能够修正定位数据, 提。
17、高定位精度, 从而在地图匹配时提高匹 配精度和匹配性能, 正确进行道路拥堵计算。 发明内容 0007 针对现有技术中存在的缺陷, 本发明的目的是提供一种用于城市道路拥堵分析的 浮动车地图匹配数据预处理方法及系统。该方法及系统能够利用 GPS 历史定位数据解决车 辆在低速行驶时航向角不准的问题, 及车辆静止时 GPS 定位数据产生的漂移问题, 从而提 高地图匹配的精度和匹配的性能, 以便能正确将定位数据匹配到相应的路段上并进行拥堵 分析, 为城市道路拥堵收费提供全面的定位技术支持。 0008 为达到以上目的, 本发明采用的技术方案是, 一种浮动车地图匹配数据预处理方 法, 包括以下步骤 : 00。
18、09 步骤一、 对系统参数进行初始化设置, 包括设置数据缓存区 BL_Cache, 用于存放历 说 明 书 CN 103727946 A 5 2/5 页 6 史的经、 纬度, 设定缓存长度 Len_Cache=1 ; 0010 步骤二、 接收 GPS 定位数据, 陀螺仪和加速度计数据, 并提取 GPS 速度 V_GPS, 陀螺 仪测量的航向角的角速率值 G_Ang, 计算加速度计测量值与重力加速度 g 的差值 Acc ; 0011 步骤三、 判断是否是首次定位, 如果是首次定位, 则更新定位数据, 将当前定位数 据赋值给 BL_Cache(Len_Cache), 结束预处理, 否则继续后续步骤。
19、处理 ; 0012 步骤四、 判断车辆是否静止, 若是, 则维持定位数据不变, 否则返回步骤二 ; 0013 步骤五、 判断车辆是否正在慢速行驶, 若是, 则取出缓存中的第一条记录 BL_ Cache(1) 和最后一条记录 BL_Cache(Len_Cache), 并利用 BL_Cache(1) 和 BL_Cache(Len_ Cache) 存储的经纬度来重新计算航向角, 否则, 更新定位数据, 将当前定位数据 (经纬度) 赋 值给 BL_Cache(Len_Cache), 结束预处理。 0014 进一步, 步骤一中对系统参数进行初始化设置还包括 : 0015 1) 设置陀螺仪零值门限 G_S。
20、tatic; 0016 2) 设置加速度零值门限 Acc_Static; 0017 3) 设定速度静止门限值 V_Static ; 0018 4) 设定速度低速门限值 V_Low ; 0019 5) 设置距离门限值 S_Lmt, 用于车辆低速行驶时重新计算航向角。 0020 更进一步, 0021 1) 所述陀螺仪零值门限 G_Staticy 为 0.03-0.07 度 / 秒 ; 0022 2) 所述加速度零值门限 Acc_Static 为 0.2-0.9m/s2; 0023 3) 所述速度静止门限值 V_Static 为 0-1.8km/h ; 0024 4) 所述速度低速门限值 V_Low。
21、 为 20-40km/h ; 0025 5) 所述距离门限值 S_Lmt 为 25-35m。 0026 再进一步, 0027 1) 所述陀螺仪零值门限 G_Staticy 为 0.05 度 / 秒 ; 0028 2) 所述加速度零值门限 Acc_Static 为 0.6m/s2; 0029 3) 所述速度静止门限值 V_Static 为 1km/h ; 0030 4) 所述速度低速门限值 V_Low 为 30km/h ; 0031 5) 所述距离门限值 S_Lmt 为 30m。 0032 进一步, 步骤四中, 判断车辆是否静止的方法是 : 当陀螺仪输出的航向角的角速率 低于零值门限G_Stat。
22、ic值, 且加速度计输出的数值与重力加速度g的差值低于加速度零值 门限 Acc_Static 值时, 且 GPS 接收机输出的速度值低于速度静止门限值 V_Static 时, 则判 断车辆处于静止状态。 0033 进一步, 步骤五中, 判断车辆是否正在慢速行驶的方法是 : 0034 (1) 取出缓存中的第一条定位数据, 设该位置与当前定位位置的距离为 S1, 如果 S1 距离门限值 S_Lmt, 则跳转步骤 (4) ; 0035 (2) 取出缓存中的第二条定位数据, 设该位置与当前定位位置的距离为 S2, 如果 S2 距离门限值 S_Lmt, 则跳转步骤 (4) ; 0036 (3) 执行如下。
23、循环语句 : 0037 For i=1to Len_Cache-1 说 明 书 CN 103727946 A 6 3/5 页 7 0038 BL_Cache(i)=BL_Cache(i+1) 0039 End 0040 (4) 缓冲区的长度加 1, 即令 Len_Cache=Len_Cache+1 ; 0041 (5) 判断 V_GPSV_Low 是否成立, 如果成立, 则说明车辆正在慢速行驶。 0042 一种浮动车地图匹配数据预处理系统, 包括预处理模块, 与预处理模块连接的 GPS 定位模块、 速度计, 地图数据模块和陀螺仪, 所述的预处理模块包括以下装置 : 0043 初始化装置, 用于。
24、对系统参数进行初始化设置, 包括设置数据缓存区 BL_Cache, 用 于存放历史的经、 纬度, 设定缓存长度 Len_Cache=1 ; 0044 数据接收及提取装置, 用于接收 GPS 定位数据, 陀螺仪和加速度计数据, 并提取 GPS 速度 V_GPS, 陀螺仪测量的航向角的角速率值 G_Ang, 计算加速度计测量值与重力加速 度 g 的差值 Acc ; 0045 判断装置一, 用于判断是否是首次定位, 如果是首次定位, 则更新定位数据, 将当 前定位数据赋值给 BL_Cache(Len_Cache), 结束预处理, 否则继续后续步骤处理 ; 0046 判断装置二, 用于判断车辆是否静止。
25、, 若是, 则维持定位数据不变, 否则返回数据 接收及提取装置继续接收及提取相关数据 ; 0047 判断装置三, 用于判断车辆是否正在慢速行驶, 若是, 则取出缓存中的第一条 记录 BL_Cache(1) 和最后一条记录 BL_Cache(Len_Cache), 并利用 BL_Cache(1) 和 BL_ Cache(Len_Cache) 存储的经纬度来重新计算航向角, 否则, 更新定位数据, 将当前定位数据 (经纬度) 赋值给 BL_Cache(Len_Cache), 结束预处理。 0048 本发明的效果在于 : 采用本发明所述的方法及系统, 可以解决两个方面的定位问 题, 一则, 可以解决。
26、浮动车在低速行驶时航向角不准的问题。二则可以解决车辆静止时 GPS 定位数据产生的漂移的问题。从而提高地图匹配的精度和匹配的性能, 以便能正确将定 位数据匹配到相应的路段上并进行拥堵分析, 为城市道路拥堵收费提供全面的定位技术支 持。 附图说明 0049 图 1 是本发明所述方法的流程图 ; 0050 图 2 是本发明所述方法具体实施方式的流程图 ; 0051 图 3 是本发明所述系统具体实施方式的结构图。 具体实施方式 0052 下面结合附图和具体实施方式对本发明作进一步描述。 0053 如图 1 所示, 一种用于城市道路拥堵分析的浮动车地图匹配数据预处理方法, 包 括以下步骤 : 0054。
27、 S1, 步骤一 : 对系统参数进行初始化设置 ; 0055 S2, 步骤二 : 接收 GPS 定位数据, 陀螺仪和加速度计数据, 并提取 GPS 速度 V_GPS, 陀螺仪测量的航向角的角速率值 G_Ang, 计算加速度计测量值与重力加速度 g 的差值 Acc ; 0056 S3, 步骤三 : 判断是否是首次定位, 如果是首次定位, 则更新定位数据, 将当前定位 数据 (经纬度) 赋值给 BL_Cache(Len_Cache), 结束预处理, 否则继续后续步骤处理 ; 说 明 书 CN 103727946 A 7 4/5 页 8 0057 S4, 步骤四 : 判断车辆是否静止, 若是, 则维。
28、持定位数据不变, 否则返回步骤二 ; 0058 S5, 步骤五 : 判断车辆是否正在慢速行驶, 若是, 则取出缓存中的第一条记录 BL_ Cache(1) 和最后一条记录 BL_Cache(Len_Cache), 并利用 BL_Cache(1) 和 BL_Cache(Len_ Cache) 存储的经纬度来重新计算航向角, 否则, 更新定位数据, 将当前定位数据 (经纬度) 赋 值给 BL_Cache(Len_Cache), 结束预处理。 0059 如图 2 所示, 本实施例中, 一种用于城市道路拥堵分析的浮动车地图匹配数据预 处理方法 , 具体包括以下步骤。 0060 步骤一 : 对系统参数进。
29、行如下初始化设置 : 0061 1) 设置陀螺仪零值门限 G_Static, 当陀螺仪输出的航向角的角速率低于此门限 值时, 则判断车辆处于静止状态 ; 0062 2)设置加速度零值门限Acc_Static, 当加速度计输出的数值与重力加速度g的差 值 Acc 低于此门限值时, 则判断车辆处于静止状态 ; 0063 3) 设定速度静止门限值 V_Static, 当 GPS 接收机输出的速度值低于此门限值时, 则判断车辆处于静止状态 ; 0064 4) 设定速度低速门限值 V_Low, 当 GPS 接收机输出的速度值低于此门限值时, 则 认为车辆处于低速运行状态, 此时, GPS 接收机输出的航。
30、向角具有较大的偏差, 需要进行处 理 ; 0065 5) 设置距离门限值 S_Lmt, 用于车辆低速行驶时重新计算航向角。 0066 6) 设置数据缓存区 BL_Cache, 用于存放历史的经、 纬度。 0067 7) 设定缓存长度 Len_Cache=1。 0068 步骤二 : 接收 GPS 定位数据, 陀螺仪和加速度计数据, 并提取 GPS 速度 V_GPS, 陀螺 仪测量的航向角速率值 G_Ang, 计算加速度计测量值与重力加速度 g 的差值 Acc ; 0069 步骤三 : 判断是否是首次定位?如果是首次定位, 则跳转步骤十一。 0070 步骤四 : 判断 G_AngG_Static,。
31、 且 AccAcc_Static, 且 V_GPSV_Static ?如果以 上条件都满足, 则说明车辆静止, 维持定位数据不变。返回步骤二继续接收 GPS 定位数据。 0071 步骤五 : 取出缓存中的第一条定位数据, 设该位置与当前定位位置的距离为 S1, 如果 S1S_Lmt, 则跳转步骤八。 0072 步骤六 : 取出缓存中的第二条定位数据, 设该位置与当前定位位置的距离为 S2, 如果 S2S_Lmt, 则跳转步骤八。 0073 步骤七 : 执行如下循环语句 : 0074 For i=1to Len_Cache-1 0075 BL_Cache(i)=BL_Cache(i+1) 007。
32、6 End 0077 步骤八 : 缓冲区的长度加 1, 即令 Len_Cache=Len_Cache+1。 0078 步骤九 : 判断 V_GPSV_Low 是否成立, 如果成立, 则说明车辆正在慢速行驶, 跳转 步骤十, 否则, 跳转步骤十一。 0079 步骤十 : 取出缓存中的第一条记录 BL_Cache(1) 和最后一条记录 BL_Cache(Len_ Cache), 并利用 BL_Cache(1) 和 BL_Cache(Len_Cache) 存储的经纬度来重新计算航向角。 0080 步骤十一 : 更新定位数据, 将当前定位数据 (经纬度)赋值给 BL_Cache(Len_ 说 明 书 。
33、CN 103727946 A 8 5/5 页 9 Cache)。 0081 步骤十二 : 结束预处理后, 进行地图匹配 MM(Map Matching)。 0082 通常, 步骤一中对各系统参数进行如下初始化设置 : 0083 1) 所述陀螺仪零值门限 G_Staticy 为 0.03-0.07 度 / 秒 ; 0084 2) 所述加速度零值门限 Acc_Static 为 0.2-0.9m/s2; 0085 3) 所述速度静止门限值 V_Static 为 0-1.8km/h ; 0086 4) 所述速度低速门限值 V_Low 为 20-40km/h ; 0087 5) 所述距离门限值 S_Lm。
34、t 为 25-35m。 0088 优选的, 本实施例中, 步骤一中对各系统参数进行如下初始化设置 : 0089 1) 所述陀螺仪零值门限 G_Staticy 为 0.05 度 / 秒 ; 0090 2) 所述加速度零值门限 Acc_Static 为 0.6m/s2; 0091 3) 所述速度静止门限值 V_Static 为 1km/h ; 0092 4) 所述速度低速门限值 V_Low 为 30km/h ; 0093 5) 所述距离门限值 S_Lmt 为 30m。 0094 如图 3 所示, 一种用于城市道路拥堵分析的浮动车地图匹配数据预处理系统, 包 括预处理模块 1, 与预处理模块 1 连。
35、接的 GPS 定位模块 2、 速度计 3、 地图数据模块 4 和陀螺 仪 5, 所述的预处理模块 1 包括以下装置 : 0095 初始化装置 11, 用于对系统参数进行初始化设置, 包括设置数据缓存区 BL_ Cache, 用于存放历史的经、 纬度, 设定缓存长度 Len_Cache=1 ; 0096 数据接收及提取装置 12, 用于接收 GPS 定位数据, 陀螺仪和加速度计数据, 并提取 GPS 速度 V_GPS, 陀螺仪测量的航向角的角速率值 G_Ang, 计算加速度计测量值与重力加速 度 g 的差值 Acc ; 0097 判断装置一 13, 用于判断是否是首次定位, 如果是首次定位, 则。
36、更新定位数据, 将 当前定位数据赋值给 BL_Cache(Len_Cache), 结束预处理, 否则继续后续步骤处理 ; 0098 判断装置二 14, 用于判断车辆是否静止, 若是, 则维持定位数据不变, 否则返回数 据接收及提取装置继续接收及提取相关数据 ; 0099 判断装置三 15, 用于判断车辆是否正在慢速行驶, 若是, 则取出缓存中的第一条 记录 BL_Cache(1) 和最后一条记录 BL_Cache(Len_Cache), 并利用 BL_Cache(1) 和 BL_ Cache(Len_Cache) 存储的经纬度来重新计算航向角, 否则, 更新定位数据, 将当前定位数据 (经纬度。
37、) 赋值给 BL_Cache(Len_Cache), 结束预处理。 0100 根据上述实施例, 可以看出本发明所述的方法及系统利用了 GPS 历史定位数据解 决了车辆在低速行驶时航向角不准的问题, 及车辆静止时 GPS 定位数据产生的漂移问题, 从而提高地图匹配的精度和匹配的性能, 以便能正确将定位数据匹配到相应的路段上并进 行拥堵分析, 为城市道路拥堵收费提供全面的定位技术支持。 0101 本领域技术人员应该明白, 本发明所述的方法和系统并不限于具体实施方式中所 述的实施例, 上面的具体描述只是为了解释本发明的目的, 并非用于限制本发明。 本领域技 术人员根据本发明的技术方案得出其他的实施方式, 同样属于本发明的技术创新范围, 本 发明的保护范围由权利要求及其等同物限定。 说 明 书 CN 103727946 A 9 1/3 页 10 图 1 说 明 书 附 图 CN 103727946 A 10 2/3 页 11 图 2 说 明 书 附 图 CN 103727946 A 11 3/3 页 12 图 3 说 明 书 附 图 CN 103727946 A 12 。