CN103438897A - 基于栅格地图的路径轨迹校正方法 - Google Patents

基于栅格地图的路径轨迹校正方法 Download PDF

Info

Publication number
CN103438897A
CN103438897A CN2013103969099A CN201310396909A CN103438897A CN 103438897 A CN103438897 A CN 103438897A CN 2013103969099 A CN2013103969099 A CN 2013103969099A CN 201310396909 A CN201310396909 A CN 201310396909A CN 103438897 A CN103438897 A CN 103438897A
Authority
CN
China
Prior art keywords
vector
point
road
satellite
angle
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN2013103969099A
Other languages
English (en)
Other versions
CN103438897B (zh
Inventor
韩德培
林强
杨德军
杨东成
张宗军
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Chengdu Dongxin Science & Technology Co. Ltd.
Original Assignee
Hangzhou Dongxin Jiejun Science & Technology Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Hangzhou Dongxin Jiejun Science & Technology Co Ltd filed Critical Hangzhou Dongxin Jiejun Science & Technology Co Ltd
Priority to CN201310396909.9A priority Critical patent/CN103438897B/zh
Publication of CN103438897A publication Critical patent/CN103438897A/zh
Application granted granted Critical
Publication of CN103438897B publication Critical patent/CN103438897B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Position Fixing By Use Of Radio Waves (AREA)
  • Navigation (AREA)

Abstract

本发明涉及一种基于栅格地图的路径轨迹校正方法。其特征在于包括以下步骤：一、根据移动终端获取到卫星定位所包含的数据建立卫星定位数据模型；二、识别跨路段的相邻卫星定位点；三、对跨路段的相邻卫星定位点的判断方法；四、对跨路段的相邻卫星定位点进行校正。本发明主要实现了基于栅格地图的路径轨迹校正方法，其不借助道路路网的矢量数据，在栅格地图上识别偏离道路的卫星定位异常点；不借助道路路网的矢量数据，在栅格地图上识别跨路段的相邻卫星定位点；实现了基于栅格地图的跨路段轨迹校正方法。

Description

基于栅格地图的路径轨迹校正方法
技术领域
本发明涉及一种基于栅格地图的路径轨迹校正方法。
背景技术
卫星定位定位应用系统从逻辑结构上可由物理层、处理层和应用层三个层次构成。物理层提供当前移动终端的相关信息，包括定位、方向、时间等信息；处理层负责在移动终端相关信息的基础上，进行一系列的数据处理；应用层则实现卫星定位定位的最终应用。
卫星定位用于移动终端物体的定位，总会存在随机定位偏差，在车辆导航系统或实时跟踪移动终端的系统的显示屏幕上经常会出现被定位终端偏离轨道或道路的情况，如移动终端“行进”到一些建筑物上或者相邻的卫星定位点跨越路段而出现移动终端穿越建筑物或斜穿道路路口。借助常识，虽然我们可以准确地判断实际情况，但是会造成系统使用的麻烦，以及降低了用户对系统的信任度。
常见的基于卫星定位轨迹数据是一系列包含有经纬度、速度和方向信息的时序卫星定位轨迹点。
卫星定位定位的偏差问题，在物理层上主要通过提高移动终端定位的精度。移动终端定位的精度取决于移动终端所采用的定位方式。目前采用卫星定位接收机来实现移动终端的定位。应用差分卫星定位方法提高卫星定位的定位精度，但是该方法需要硬件上的支持，费用也相对较高。
在处理层上，矢量地图生产商采用实地跑车采集车辆沿道路行驶的轨迹来校正道路路网以提高矢量地图的精度，导致成本居高不下。而对于非矢量地图，由于没有地图矢量库和地图数据库，无法根据移动终端卫星定位判断其与道路的相对位置关系，因此对于应用于非矢量地图的卫星定位，无法有效识别跨越路段的相邻卫星定位点，并对偏离道路的路径轨迹进行校正。
目前，在基于现有卫星定位偏差的基础上主要在处理层将卫星定位轨迹数据（如速度和方向信息等）结合数字地图上的路网数据进行地图匹配获得移动终端的轨迹描述。主要步骤如下：
1.计算当前点的可能行驶的路段集RC；
2.计算RC与各阶段总体路径path(i)的最后一条路段Rlast的后续可行路段集NR_Rlast(i)的交集Rinsect(i)；
3.由Rinsect(i)更新并重组备选总体路径集path；
4.所有待处理的卫星定位点循环完毕后，计算path中的各条可能路径与由卫星定位轨迹路径的曲线相似度Sim(i)，选取最相似的路径作为整体轨迹的匹配路径。
现有技术主要在卫星定位系统的处理层，将一系列包含有经纬度、速度和方向信息的时序卫星定位轨迹点，结合路网信息进行道路匹配，实现对偏离道路的轨迹描述点进行校正。但是这种方法需要知道路网的数据，所依赖的地图主要是矢量地图。利用矢量地图提供的地图矢量数据和地图描述数据，确定每个卫星定位点与周围道路网的相对位置关系。但是对于非矢量地图则无法获取路网数据，无法实现通过道路匹配校正偏离道路的轨迹描述点。
诸多卫星定位相关的应用系统，由于系统本身的原因，使用了栅格地图。如果要求系统使用矢量地图，则必须购买地图矢量数据库和地图描述数据库，增加了系统开发的成本。
发明内容
针对现有技术中存在的问题，本发明的目的在于提供一种基于栅格地图的路径轨迹校正方法的技术方案，在不使用矢量地图中的路网数据，不增加地图成本的前提下，校正跨路段而偏离道路的轨迹点。
所述的基于栅格地图的路径轨迹校正方法，其特征在于包括以下步骤：
一、根据移动终端获取到卫星定位所包含的数据建立卫星定位数据模型
移动终端使用卫星定位接收机在物理层获取到得卫星定位数据主要包括物体的经度、纬度、方向和速度信息，实际地理坐标不能直接在屏幕上显示，要使用墨卡托投影算法Mercator Projection实现地理坐标到屏幕坐标的转换；
1）移动终端每次获取到的卫星定位数据，构成一个卫星定位数据点，该数据点包含经度、纬度、方向和速度信息，构建数据模型：
GPSPoint =（lon, lat, dir, v），      
GPSPoint：每次获取到的卫星定位点，
lon：当前位置的经度，
lat：当前位置的纬度，
dir：当前位置处的移动方向，
v：当前位置处的速度；
2）使用墨卡托投影算法将点GPSPoint进行处理，如下：
MercatorProjection（GPSPoint）= PlaneGPSPoint =（X, Y, dir, v）
其中：X、Y为变换之后的点PlaneGPSPoint在屏幕坐标ScreenPoint中的X轴和Y轴的值，并且X、Y一一对应lon、lat，这样每一个GPSPoint都一一对应到屏幕坐标点ScreenPoint（X, Y）；
二、识别跨路段的相邻卫星定位点
在进行跨路段的相邻卫星定位点识别时，首先需要对产生较大误差的卫星定位点进行判断并做处理，该类点会影响跨路段的相邻卫星定位点的识别，用ErrorPoint点表示偏离道路的异常点，由于栅格地图没有相关路网及道路的矢量数据，需要根据现有的卫星定位数据，使用距离及角度方法进行判断，具体如下：
a）                                                
Figure 289971DEST_PATH_IMAGE001
    其中，i=0,1,2,3,…；error下标为异常点的唯一标识；
b）向量
Figure 813356DEST_PATH_IMAGE002
，向量
Figure 852988DEST_PATH_IMAGE003
，
   向量
Figure 94613DEST_PATH_IMAGE004
，向量
Figure 510682DEST_PATH_IMAGE005
；
其中：
向量为道路内正常点GPSPoint0与偏离道路异常点ErrorPoint连接构成；
向量
Figure 489319DEST_PATH_IMAGE007
为道路内偏离道路异常点ErrorPoint与正常点GPSPoint1连接构成；
向量
Figure 828028DEST_PATH_IMAGE008
为道路内正常点GPSPoint0与正常点GPSPoint1连接构成；
向量
Figure 172422DEST_PATH_IMAGE009
为道路内正常点GPSPoint0与正常点GPSPoint2连接构成；
c）使用平面向量夹角公式：
Figure 545765DEST_PATH_IMAGE010
求得角度a、b、c及向量
Figure 51833DEST_PATH_IMAGE008
所在直线与向量所在直线的夹角d；
其中：
角度a表示向量所在直线与向量
Figure 378406DEST_PATH_IMAGE006
所在直线的夹角；
角度b表示向量所在直线与向量
Figure 368676DEST_PATH_IMAGE008
所在直线的夹角；
角度c表示向量
Figure 930238DEST_PATH_IMAGE008
所在直线与向量
Figure 137229DEST_PATH_IMAGE007
所在直线的夹角；
d）如果b>90°或者c>90°，则ErrorPoint为误差异常点；
如果b<90°且a<90°，则ErrorPoint为误差异常点；对于该类误差异常点，直接舍去，即轨迹描述的路线为GPSPoint0
Figure 250678DEST_PATH_IMAGE011
GPSPoint1
Figure 51275DEST_PATH_IMAGE011
GPSPoint2；
三、对跨路段的相邻卫星定位点的判断方法
跨路段的相邻卫星定位点是属于正常接收到的点，必须先排除掉产生较大误差的卫星定位点，使用步骤二的方法可以有效识别卫星定位误差异常点并做处理；
跨路段的相邻卫星定位点
Figure 275583DEST_PATH_IMAGE012
与为相邻的卫星定位点，它们分别在道路R1和道路R2两个不同的路段上，由于轨迹线穿越道路，该类跨越路段的相邻卫星定位点的判断步骤如下： 
ⅰ）首先对卫星定位点经纬度数据做转换
，
其中i=0,1,2,3,…；
ⅱ）计算向量
Figure 784690DEST_PATH_IMAGE015
；向量
Figure 812689DEST_PATH_IMAGE016
；
其中：
Figure 994272DEST_PATH_IMAGE017
为道路上的正常点与
Figure 224713DEST_PATH_IMAGE012
连接构成的向量；
Figure 666190DEST_PATH_IMAGE019
为道路上的正常点
Figure 702279DEST_PATH_IMAGE013
与
Figure 328432DEST_PATH_IMAGE020
连接构成的向量；
ⅲ）使用平面向量夹角公式：
Figure 325338DEST_PATH_IMAGE010
令：
Figure 695140DEST_PATH_IMAGE021
，
Figure 726681DEST_PATH_IMAGE022
，可求得向量
Figure 523735DEST_PATH_IMAGE023
与向量的夹角β；
ⅳ）根据公路路线设计规范，平面交叉的斜交角度必须严格限制在70°-110°之间，也即多岔道路路口转角的角度范围；如果角度β在70°-110°之间，则可判定点
Figure 915851DEST_PATH_IMAGE012
与为跨路段相邻卫星定位点；
四、对跨路段的相邻卫星定位点进行校正
识别出跨路段的相邻的卫星定位点之后，应用平面几何的知识对跨路段的轨迹进行校正，使轨迹尽可能的沿着道路前进，步骤如下：
Ⅰ）跨路段的相邻卫星定位点
Figure 894488DEST_PATH_IMAGE012
与
Figure 865986DEST_PATH_IMAGE013
分别在道路R1和道路R2上，分别延长线段
Figure 577590DEST_PATH_IMAGE025
和线段
Figure 607161DEST_PATH_IMAGE026
，使得直线line1与line2相交于点E；
Ⅱ）已知点
Figure 746018DEST_PATH_IMAGE027
，应用平面几何知识求得直线line1与line2的解析式：
line1：
Figure 63867DEST_PATH_IMAGE028
  
line2：
Figure 454528DEST_PATH_IMAGE029
构建方程组：  
Figure 439802DEST_PATH_IMAGE030
得到E点屏幕坐标（X，Y），由反墨卡托投影变换即可得到对应的经纬度值，构建一个校正路径轨迹线的卫星定位点CorrectGPSPoint，依次连接各点便形成校正之后的路径轨迹线。
本发明主要实现了基于栅格地图的路径轨迹校正方法，其不借助道路路网的矢量数据，在栅格地图上识别偏离道路的卫星定位异常点；不借助道路路网的矢量数据，在栅格地图上识别跨路段的相邻卫星定位点；实现了基于栅格地图的跨路段轨迹校正方法。
附图说明
图1为识别跨路段的相邻卫星定位点的结构示意图；
图2为跨路段的相邻卫星定位点的判断方法的结构示意图；
图3为跨路段的相邻卫星定位点进行校正的结构示意图。
具体实施方式
栅格地图没有矢量地图的地图矢量库和地图数据库，因此也就没有道路路网相关的矢量数据，需要判断异常卫星定位点是否偏离道路及哪些点是跨路段的相邻卫星定位点，从而实现对跨路段的路径轨迹校正。
图1为识别跨路段的相邻卫星定位点的结构示意图，假设行进道路上一次上报卫星定位点GPSPoint0、ErrorPoint、GPSPoint、GPSPoint2，GPSPoint0、GPSPoint1、GPSPoint2表示上报正常的点，ErrorPoint表示上报异常即偏离道路的点。
图2为跨路段的相邻卫星定位点的判断方法的结构示意图，假设道路R1上有卫星定位点
Figure 624927DEST_PATH_IMAGE031
，道路R2上有卫星定位点
Figure 430072DEST_PATH_IMAGE032
，延长线段，相交于点E，构成角度
Figure 198625DEST_PATH_IMAGE036
。
图3为跨路段的相邻卫星定位点进行校正的结构示意图，点CorrectGPSPoint为校正之后在物体行进路径上通过校正算法添加的点。
本发明基于栅格地图的路径轨迹校正方法包括以下步骤：
一、根据移动终端获取到卫星定位所包含的数据建立卫星定位数据模型
由于移动终端使用卫星定位接收机在物理层获取到得卫星定位数据主要包括物体的经度、纬度、方向和速度信息，实际地理坐标不能直接在屏幕上显示，必须进行坐标变换，本发明中使用墨卡托投影算法（Mercator Projection）实现地理坐标到屏幕坐标的转换，墨卡托投影算法的内容为现有技术，在此不做详述,具体转换步骤为：
1）移动终端每次获取到的卫星定位数据，构成一个卫星定位数据点，该数据点包含经度、纬度、方向和速度信息，构建数据模型：
GPSPoint =（lon, lat, dir, v），      
GPSPoint：每次获取到的卫星定位点，
lon：当前位置的经度，
lat： 当前位置的纬度，
dir：当前位置处的移动方向，
v：当前位置处的速度；
2）使用墨卡托投影算法将点GPSPoint进行处理，如下：
MercatorProjection（GPSPoint）= PlaneGPSPoint =（X, Y, dir, v）
其中：X、Y为变换之后的点PlaneGPSPoint在屏幕坐标ScreenPoint中的X轴和Y轴的值，并且X、Y一一对应lon、lat，这样每一个GPSPoint都一一对应到屏幕坐标点ScreenPoint（X, Y）；
二、识别跨路段的相邻卫星定位点
在进行跨路段的相邻卫星定位点识别时，首先需要对产生较大误差的卫星定位点进行判断并做处理，因为该类点会影响跨路段的相邻卫星定位点的识别，产生较大误差的卫星定位点如图1所示，用ErrorPoint点表示偏离道路的异常点，由于栅格地图没有相关路网及道路的矢量数据，需要根据现有的卫星定位数据，使用距离及角度方法进行判断，具体如下：
a）
    其中，i=0,1,2,3,…；error下标为异常点的唯一标识；
b）向量
Figure 237305DEST_PATH_IMAGE002
，向量
Figure 704189DEST_PATH_IMAGE003
，
   向量
Figure 664055DEST_PATH_IMAGE004
，向量
Figure 190982DEST_PATH_IMAGE005
；
其中：
向量为道路内正常点GPSPoint0与偏离道路异常点ErrorPoint连接构成；
向量
Figure 365929DEST_PATH_IMAGE007
为道路内偏离道路异常点ErrorPoint与正常点GPSPoint1连接构成；
向量
Figure 55667DEST_PATH_IMAGE008
为道路内正常点GPSPoint0与正常点GPSPoint1连接构成；
向量
Figure 878130DEST_PATH_IMAGE009
为道路内正常点GPSPoint0与正常点GPSPoint2连接构成；
c）使用平面向量夹角公式：
Figure 20529DEST_PATH_IMAGE010
求得角度a、b、c及向量
Figure 219429DEST_PATH_IMAGE008
所在直线与向量
Figure 888308DEST_PATH_IMAGE009
所在直线的夹角d；
其中：
角度a表示向量
Figure 757038DEST_PATH_IMAGE007
所在直线与向量
Figure 511368DEST_PATH_IMAGE006
所在直线的夹角，此时；
角度b表示向量
Figure 912710DEST_PATH_IMAGE006
所在直线与向量所在直线的夹角，此时
Figure 193967DEST_PATH_IMAGE038
；
角度c表示向量
Figure 734670DEST_PATH_IMAGE008
所在直线与向量
Figure 112561DEST_PATH_IMAGE007
所在直线的夹角，此时
Figure DEST_PATH_IMAGE039
；
角度d表示向量
Figure 588673DEST_PATH_IMAGE008
所在直线与向量
Figure 927382DEST_PATH_IMAGE009
所在直线的夹角，此时
Figure 271775DEST_PATH_IMAGE040
；
d）如果b>90°或者c>90°，则ErrorPoint为误差异常点；
如果b<90°且a<90°，则ErrorPoint为误差异常点；对于该类误差异常点，直接舍去，即轨迹描述的路线为GPSPoint0
Figure 504174DEST_PATH_IMAGE011
GPSPoint1
Figure 151187DEST_PATH_IMAGE011
GPSPoint2；
三、对跨路段的相邻卫星定位点的判断方法
由于跨路段的相邻卫星定位点是属于正常接收到的点，因此必须先排除掉产生较大误差的卫星定位点，使用步骤二的方法可以有效识别卫星定位误差异常点并做处理；
跨路段的相邻卫星定位点如图2所示，跨路段的相邻卫星定位点
Figure 101825DEST_PATH_IMAGE012
与为相邻的卫星定位点，它们分别在道路R1和道路R2两个不同的路段上，由于轨迹线穿越道路，该类跨越路段的相邻卫星定位点的判断步骤如下： 
ⅰ）首先对卫星定位点经纬度数据做转换
Figure 212181DEST_PATH_IMAGE014
，
其中i=0,1,2,3,…；
ⅱ）计算向量；向量
Figure 468030DEST_PATH_IMAGE016
；
其中：
Figure 154226DEST_PATH_IMAGE017
为道路上的正常点
Figure 361216DEST_PATH_IMAGE018
与连接构成的向量；
Figure 275263DEST_PATH_IMAGE019
为道路上的正常点
Figure 499571DEST_PATH_IMAGE013
与连接构成的向量；
ⅲ）使用平面向量夹角公式：
令：
Figure 8678DEST_PATH_IMAGE021
，
Figure 36677DEST_PATH_IMAGE022
，求得向量
Figure 218259DEST_PATH_IMAGE023
所在直线与向量
Figure 548878DEST_PATH_IMAGE024
所在直线的夹角β；
ⅳ）根据公路路线设计规范，平面交叉的斜交角度必须严格限制在70°-110°之间，也即多岔道路路口转角的角度范围；如果角度β在70°-110°之间，则可判定点
Figure 183121DEST_PATH_IMAGE012
与
Figure 624598DEST_PATH_IMAGE013
为跨路段相邻卫星定位点；
四、对跨路段的相邻卫星定位点进行校正
识别出跨路段的相邻的卫星定位点之后，应用平面几何的知识对跨路段的轨迹进行校正，使轨迹尽可能的沿着道路前进，如图3所示，步骤如下：
Ⅰ）跨路段的相邻卫星定位点与
Figure 552420DEST_PATH_IMAGE013
分别在道路R1和道路R2上，分别延长线段
Figure 549326DEST_PATH_IMAGE025
和线段
Figure 919127DEST_PATH_IMAGE026
，使得直线line1与line2相交于点E；
Ⅱ）已知点
Figure 950668DEST_PATH_IMAGE027
，应用平面几何知识求得直线line1与line2的解析式：
line1：  
line2：
Figure 356559DEST_PATH_IMAGE029
构建方程组：  
Figure 139838DEST_PATH_IMAGE030
得到E点屏幕坐标（X，Y），由反墨卡托投影变换即可得到对应的经纬度值，构建一个校正路径轨迹线的卫星定位点CorrectGPSPoint，依次连接各点便形成校正之后的路径轨迹线。
本发明是在原有栅格地图而不额外增加成本的基础上，借助平面几何的知识对卫星定位点包含的数据进行分析和计算，识别卫星定位偏离道路的异常点和跨路段的相邻点，从而实时校正跨路段路径。 
本发明不借助道路路网的矢量数据，在栅格地图上识别偏离道路的卫星定位异常点；不借助道路路网的矢量数据，在栅格地图上识别跨路段的相邻卫星定位点；实现了基于栅格地图的跨路段轨迹校正方法。

Claims (1)

1.基于栅格地图的路径轨迹校正方法，其特征在于包括以下步骤：
一、根据移动终端获取到卫星定位所包含的数据建立卫星定位数据模型
移动终端使用卫星定位接收机在物理层获取到得卫星定位数据主要包括物体的经度、纬度、方向和速度信息，实际地理坐标不能直接在屏幕上显示，要使用墨卡托投影算法Mercator Projection实现地理坐标到屏幕坐标的转换；
1）移动终端每次获取到的卫星定位数据，构成一个卫星定位数据点，该数据点包含经度、纬度、方向和速度信息，构建数据模型：
GPSPoint =（lon, lat, dir, v），      
GPSPoint：每次获取到的卫星定位点，
lon：当前位置的经度，
lat：当前位置的纬度，
dir：当前位置处的移动方向，
v：当前位置处的速度；
2）使用墨卡托投影算法将点GPSPoint进行处理，如下：
MercatorProjection（GPSPoint）= PlaneGPSPoint =（X, Y, dir, v）
其中：X、Y为变换之后的点PlaneGPSPoint在屏幕坐标ScreenPoint中的X轴和Y轴的值，并且X、Y一一对应lon、lat，这样每一个GPSPoint都一一对应到屏幕坐标点ScreenPoint（X, Y）；
二、识别跨路段的相邻卫星定位点
在进行跨路段的相邻卫星定位点识别时，首先需要对产生较大误差的卫星定位点进行判断并做处理，该类点会影响跨路段的相邻卫星定位点的识别，用ErrorPoint点表示偏离道路的异常点，由于栅格地图没有相关路网及道路的矢量数据，需要根据现有的卫星定位数据，使用距离及角度方法进行判断，具体如下：
a）                                                
Figure 675923DEST_PATH_IMAGE001
    其中，i=0,1,2,3,…；error下标为异常点的唯一标识；
b）向量
Figure 31949DEST_PATH_IMAGE002
，向量
Figure 589970DEST_PATH_IMAGE003
，
   向量，向量
Figure 751141DEST_PATH_IMAGE005
；
其中：
向量
Figure 668281DEST_PATH_IMAGE006
为道路内正常点GPSPoint0与偏离道路异常点ErrorPoint连接构成；
向量为道路内偏离道路异常点ErrorPoint与正常点GPSPoint1连接构成；
向量
Figure 718594DEST_PATH_IMAGE008
为道路内正常点GPSPoint0与正常点GPSPoint1连接构成；
向量为道路内正常点GPSPoint0与正常点GPSPoint2连接构成；
c）使用平面向量夹角公式：
Figure 230795DEST_PATH_IMAGE010
求得角度a、b、c及向量
Figure 497828DEST_PATH_IMAGE008
所在直线与向量
Figure 696728DEST_PATH_IMAGE009
所在直线的夹角d；
其中：
角度a表示向量
Figure 240973DEST_PATH_IMAGE007
所在直线与向量
Figure 234337DEST_PATH_IMAGE006
所在直线的夹角；
角度b表示向量
Figure 699970DEST_PATH_IMAGE006
所在直线与向量所在直线的夹角；
角度c表示向量
Figure 960367DEST_PATH_IMAGE008
所在直线与向量
Figure 265578DEST_PATH_IMAGE007
所在直线的夹角；
d）如果b>90°或者c>90°，则ErrorPoint为误差异常点；
如果b<90°且a<90°，则ErrorPoint为误差异常点；对于该类误差异常点，直接舍去，即轨迹描述的路线为GPSPoint0
Figure 507203DEST_PATH_IMAGE011
GPSPoint1
Figure 657693DEST_PATH_IMAGE011
GPSPoint2；
三、对跨路段的相邻卫星定位点的判断方法
跨路段的相邻卫星定位点是属于正常接收到的点，必须先排除掉产生较大误差的卫星定位点，使用步骤二的方法可以有效识别卫星定位误差异常点并做处理；
跨路段的相邻卫星定位点
Figure 301164DEST_PATH_IMAGE012
与
Figure 636330DEST_PATH_IMAGE013
为相邻的卫星定位点，它们分别在道路R1和道路R2两个不同的路段上，由于轨迹线穿越道路，该类跨越路段的相邻卫星定位点的判断步骤如下： 
ⅰ）首先对卫星定位点经纬度数据做转换
，
其中i=0,1,2,3,…；
ⅱ）计算向量
Figure 319432DEST_PATH_IMAGE015
；向量
Figure 817410DEST_PATH_IMAGE016
；
其中：
为道路上的正常点
Figure 415062DEST_PATH_IMAGE018
与
Figure 172933DEST_PATH_IMAGE012
连接构成的向量；
Figure 525417DEST_PATH_IMAGE019
为道路上的正常点
Figure 467965DEST_PATH_IMAGE013
与连接构成的向量；
ⅲ）使用平面向量夹角公式：
Figure 201883DEST_PATH_IMAGE010
令：
Figure 549819DEST_PATH_IMAGE021
，
Figure 663268DEST_PATH_IMAGE022
，可求得向量与向量
Figure 688173DEST_PATH_IMAGE024
的夹角β；
ⅳ）根据公路路线设计规范，平面交叉的斜交角度必须严格限制在70°-110°之间，也即多岔道路路口转角的角度范围；如果角度β在70°-110°之间，则可判定点
Figure 749670DEST_PATH_IMAGE012
与
Figure 34021DEST_PATH_IMAGE013
为跨路段相邻卫星定位点；
四、对跨路段的相邻卫星定位点进行校正
识别出跨路段的相邻的卫星定位点之后，应用平面几何的知识对跨路段的轨迹进行校正，使轨迹尽可能的沿着道路前进，步骤如下：
Ⅰ）跨路段的相邻卫星定位点
Figure 321914DEST_PATH_IMAGE012
与
Figure 349913DEST_PATH_IMAGE013
分别在道路R1和道路R2上，分别延长线段
Figure 406862DEST_PATH_IMAGE026
和线段，使得直线line1与line2相交于点E；
Ⅱ）已知点
Figure 496358DEST_PATH_IMAGE028
，应用平面几何知识求得直线line1与line2的解析式：
line1：
Figure 937834DEST_PATH_IMAGE029
  
line2：
Figure 239503DEST_PATH_IMAGE030
构建方程组：  
Figure 475443DEST_PATH_IMAGE031
得到E点屏幕坐标（X，Y），由反墨卡托投影变换即可得到对应的经纬度值，构建一个校正路径轨迹线的卫星定位点CorrectGPSPoint，依次连接各点便形成校正之后的路径轨迹线。
CN201310396909.9A 2013-09-04 2013-09-04 基于栅格地图的路径轨迹校正方法 Active CN103438897B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310396909.9A CN103438897B (zh) 2013-09-04 2013-09-04 基于栅格地图的路径轨迹校正方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310396909.9A CN103438897B (zh) 2013-09-04 2013-09-04 基于栅格地图的路径轨迹校正方法

Publications (2)

Publication Number Publication Date
CN103438897A true CN103438897A (zh) 2013-12-11
CN103438897B CN103438897B (zh) 2016-02-17

Family

ID=49692593

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310396909.9A Active CN103438897B (zh) 2013-09-04 2013-09-04 基于栅格地图的路径轨迹校正方法

Country Status (1)

Country Link
CN (1) CN103438897B (zh)

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104035985A (zh) * 2014-05-30 2014-09-10 同济大学 一种面向基础地理信息异常数据的挖掘方法
WO2016180218A1 (zh) * 2015-05-12 2016-11-17 腾讯科技（深圳）有限公司 生成轨迹线顶点序列的方法、终端和服务器
CN106482737A (zh) * 2016-10-09 2017-03-08 西北工业大学 室内无线终端定位准确性保证及轨迹校正方法
CN106599565A (zh) * 2016-12-07 2017-04-26 中国电子科技集团公司第五十四研究所 基于位置时‑距分层的通航飞行器越界高效监视方法
CN106646554A (zh) * 2016-12-08 2017-05-10 北京三快在线科技有限公司 一种gps定位数据的处理方法及装置，电子设备
CN107195192A (zh) * 2017-06-21 2017-09-22 南京邮电大学 一种车载定向运行状态的识别方法
CN108242145A (zh) * 2016-12-26 2018-07-03 高德软件有限公司 异常轨迹点检测方法和装置
CN108731691A (zh) * 2017-04-19 2018-11-02 腾讯科技（深圳）有限公司 导航设备的偏航点的确定方法和装置
CN109324621A (zh) * 2018-09-26 2019-02-12 博康智能信息技术有限公司 一种无人巡逻车路径规划方法
CN109345838A (zh) * 2018-10-21 2019-02-15 浙江浙大中控信息技术有限公司 基于完整地图信息的计算子路段行程车速的方法
CN109491384A (zh) * 2018-11-14 2019-03-19 哈工大机器人（合肥）国际创新研究院 一种道路划线数据的获取方法及装置
CN110473422A (zh) * 2019-07-16 2019-11-19 盐城工学院 一种室外公共区域地面停车位导航装置
CN110856119A (zh) * 2019-11-08 2020-02-28 中国测绘科学研究院 一种基于几何向量的港口车辆轨迹纠偏方法
CN111324686A (zh) * 2020-02-28 2020-06-23 浙江大华技术股份有限公司 目标测量轨迹的获取方法及装置、存储介质、电子装置
CN111481109A (zh) * 2019-01-28 2020-08-04 北京奇虎科技有限公司 基于扫地机的地图噪点消除方法及装置
CN112415536A (zh) * 2020-11-11 2021-02-26 南京市测绘勘察研究院股份有限公司 一种自动获取车载激光点云行车轨迹异常区域的方法
CN114383621A (zh) * 2021-12-06 2022-04-22 杭州易现先进科技有限公司 基于网格地图的轨迹纠偏方法、电子设备和存储介质

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000121718A (ja) * 1998-10-09 2000-04-28 Casio Comput Co Ltd 現在位置検出装置、現在位置検出方法及びプログラム記録媒体
JP2005266627A (ja) * 2004-03-22 2005-09-29 Electronic Navigation Research Institute 電子地図情報の補正方法及び移動局位置監視システム
US20060271285A1 (en) * 2002-09-05 2006-11-30 Denso Corporation Navigation device
JP2009058490A (ja) * 2007-09-04 2009-03-19 Meidensha Corp Ｇｐｓ測位システム
CN101458094A (zh) * 2007-12-14 2009-06-17 环达电脑(上海)有限公司 可根据地图匹配位置进行校正的导航装置及其方法
CN101630463A (zh) * 2009-07-30 2010-01-20 上海交通大学 路网栅格数字地图自动矢量化方法
CN102375151A (zh) * 2010-08-13 2012-03-14 国基电子（上海）有限公司 电子装置及其gps误差侦测方法
CN102761959A (zh) * 2011-04-26 2012-10-31 上海真石信息技术有限公司 Lbs定位纠偏过滤技术

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000121718A (ja) * 1998-10-09 2000-04-28 Casio Comput Co Ltd 現在位置検出装置、現在位置検出方法及びプログラム記録媒体
US20060271285A1 (en) * 2002-09-05 2006-11-30 Denso Corporation Navigation device
JP2005266627A (ja) * 2004-03-22 2005-09-29 Electronic Navigation Research Institute 電子地図情報の補正方法及び移動局位置監視システム
JP2009058490A (ja) * 2007-09-04 2009-03-19 Meidensha Corp Ｇｐｓ測位システム
CN101458094A (zh) * 2007-12-14 2009-06-17 环达电脑(上海)有限公司 可根据地图匹配位置进行校正的导航装置及其方法
CN101630463A (zh) * 2009-07-30 2010-01-20 上海交通大学 路网栅格数字地图自动矢量化方法
CN102375151A (zh) * 2010-08-13 2012-03-14 国基电子（上海）有限公司 电子装置及其gps误差侦测方法
CN102761959A (zh) * 2011-04-26 2012-10-31 上海真石信息技术有限公司 Lbs定位纠偏过滤技术

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
李清泉: "基于GPS轨迹数据的地图匹配算法", 《测绘学报》 *

Cited By (28)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104035985B (zh) * 2014-05-30 2017-07-07 同济大学 一种面向基础地理信息异常数据的挖掘方法
CN104035985A (zh) * 2014-05-30 2014-09-10 同济大学 一种面向基础地理信息异常数据的挖掘方法
WO2016180218A1 (zh) * 2015-05-12 2016-11-17 腾讯科技（深圳）有限公司 生成轨迹线顶点序列的方法、终端和服务器
CN106482737A (zh) * 2016-10-09 2017-03-08 西北工业大学 室内无线终端定位准确性保证及轨迹校正方法
CN106599565B (zh) * 2016-12-07 2018-11-06 中国电子科技集团公司第五十四研究所 基于位置时-距分层的通航飞行器越界高效监视方法
CN106599565A (zh) * 2016-12-07 2017-04-26 中国电子科技集团公司第五十四研究所 基于位置时‑距分层的通航飞行器越界高效监视方法
CN106646554A (zh) * 2016-12-08 2017-05-10 北京三快在线科技有限公司 一种gps定位数据的处理方法及装置，电子设备
CN108242145B (zh) * 2016-12-26 2020-10-16 阿里巴巴（中国）有限公司 异常轨迹点检测方法和装置
CN108242145A (zh) * 2016-12-26 2018-07-03 高德软件有限公司 异常轨迹点检测方法和装置
CN108731691A (zh) * 2017-04-19 2018-11-02 腾讯科技（深圳）有限公司 导航设备的偏航点的确定方法和装置
CN107195192B (zh) * 2017-06-21 2019-10-01 南京邮电大学 一种车载定向运行状态的识别方法
CN107195192A (zh) * 2017-06-21 2017-09-22 南京邮电大学 一种车载定向运行状态的识别方法
CN109324621A (zh) * 2018-09-26 2019-02-12 博康智能信息技术有限公司 一种无人巡逻车路径规划方法
CN109345838A (zh) * 2018-10-21 2019-02-15 浙江浙大中控信息技术有限公司 基于完整地图信息的计算子路段行程车速的方法
CN109345838B (zh) * 2018-10-21 2020-11-17 浙江浙大中控信息技术有限公司 基于完整地图信息的计算子路段行程车速的方法
CN109491384A (zh) * 2018-11-14 2019-03-19 哈工大机器人（合肥）国际创新研究院 一种道路划线数据的获取方法及装置
CN109491384B (zh) * 2018-11-14 2022-04-19 哈工大机器人（合肥）国际创新研究院 一种道路划线数据的获取方法及装置
CN111481109B (zh) * 2019-01-28 2022-08-26 北京奇虎科技有限公司 基于扫地机的地图噪点消除方法及装置
CN111481109A (zh) * 2019-01-28 2020-08-04 北京奇虎科技有限公司 基于扫地机的地图噪点消除方法及装置
CN110473422A (zh) * 2019-07-16 2019-11-19 盐城工学院 一种室外公共区域地面停车位导航装置
CN110856119B (zh) * 2019-11-08 2021-07-13 中国测绘科学研究院 一种基于几何向量的港口车辆轨迹纠偏方法
CN110856119A (zh) * 2019-11-08 2020-02-28 中国测绘科学研究院 一种基于几何向量的港口车辆轨迹纠偏方法
CN111324686B (zh) * 2020-02-28 2021-09-17 浙江大华技术股份有限公司 目标测量轨迹的获取方法及装置、存储介质、电子装置
CN111324686A (zh) * 2020-02-28 2020-06-23 浙江大华技术股份有限公司 目标测量轨迹的获取方法及装置、存储介质、电子装置
CN112415536A (zh) * 2020-11-11 2021-02-26 南京市测绘勘察研究院股份有限公司 一种自动获取车载激光点云行车轨迹异常区域的方法
CN112415536B (zh) * 2020-11-11 2023-07-14 南京市测绘勘察研究院股份有限公司 一种自动获取车载激光点云行车轨迹异常区域的方法
CN114383621A (zh) * 2021-12-06 2022-04-22 杭州易现先进科技有限公司 基于网格地图的轨迹纠偏方法、电子设备和存储介质
CN114383621B (zh) * 2021-12-06 2024-04-09 杭州易现先进科技有限公司 基于网格地图的轨迹纠偏方法、电子设备和存储介质

Also Published As

Publication number Publication date
CN103438897B (zh) 2016-02-17

Similar Documents

Publication Publication Date Title
CN103438897B (zh) 基于栅格地图的路径轨迹校正方法
CN107328410B (zh) 用于定位自动驾驶车辆的方法和汽车电脑
US10698100B2 (en) Method and device for determining the position of a vehicle
CN110160542B (zh) 车道线的定位方法和装置、存储介质、电子装置
US9978161B2 (en) Supporting a creation of a representation of road geometry
US9377313B2 (en) Methods and systems for creating digital street network database
CN108303720B (zh) 一种车辆定位方法、装置及终端设备
JP5216665B2 (ja) 地図データ更新システム及び地図データ更新プログラム、並びにこれを利用したナビゲーション装置及び車両制御装置
CN109900298B (zh) 一种车辆定位校准方法及系统
WO2021041402A1 (en) Systems and methods for vehicle navigation
CN111380542B (zh) 一种车辆定位、导航方法和装置及相关系统
JP6229523B2 (ja) 自車走行位置特定装置及び自車走行位置特定プログラム
KR101921429B1 (ko) 정밀지도 제작 방법 및 정밀지도 제작 시스템
JP6828668B2 (ja) 車線ネットワークデータ生成装置、車線ネットワークデータ生成プログラム及び記憶媒体
CN110530377B (zh) 用于实施用于车辆的至少一个提高安全性的措施的方法和装置
CN103033184A (zh) 用于惯性导航系统的纠错方法、装置和系统
JP2019526067A (ja) 最適化位置決め地図の作成方法及び装置並びに車両用位置決め地図の作成方法
CN109740274B (zh) 高精度道路地图生成方法及装置
CN103376114B (zh) 由点数据产生对地理对象的路线进行连续描述的几何数据
CN102506872B (zh) 一种判定飞行航路偏离的方法
JP2017138196A (ja) 位置補正装置、ナビゲーションシステム、及び自動運転システム
CN111207759B (zh) 一种显示车辆位置的方法及装置
CN102012231A (zh) 数据更新方法和装置
US20190212747A1 (en) Lane Marker Signal Improvement through Mapped Geo-Referenced Lane Boundaries
WO2020008221A1 (ja) 走行支援方法及び走行支援装置

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20191113

Address after: 610000 unit 1, building 106, No. 18, new airway, Chengdu high tech Zone (West Zone), Sichuan Province

Patentee after: Chengdu Dongxin Science & Technology Co. Ltd.

Address before: 310013 B106 room, block B, Huaxing modern industrial park, 18 Tong Miao Road, Hangzhou, Zhejiang, Xihu District, China

Patentee before: Hangzhou Dongxin Jiejun Science & Technology Co., Ltd.