航位推算中初始方向的确定方法技术

本发明专利技术公开一种航位推算中初始方向的确定方法，包括选取有效的ＧＰＳ定位点；在有效的ＧＰＳ定位点中选取两个ＧＰＳ定位点之间的距离大于等于阈值且距离偏差在容差范围内的两个ＧＰＳ定位点以确定初始方向线段；根据所述初始方向线段计算出初始方向。采用本发明专利技术航位推算中初始方向的确定方法的技术方案能够使得初始方向的确定更准确。

【技术实现步骤摘要】

本专利技术涉及导^^支术领域，尤指一种。
技术介绍
在导^iU支术领域，GPS (全球定位系统)是美国第二代无线电卫星导航定位系 统，它負^够全球性、全天候、实时地提糾航、定位和授时信息，但它要求可见卫 星数量至少iii'j 3颗才能正常定位。在高楼林立的城市道路、隧道或树木浓密等GPS 信号遮挡比较严重的地域，由于可见卫星数量太少，GPS将不能正常获得准确可靠 的位置数据。在这种情况下，通常将GPS与其他传感器(如贯导、电子罗盘等)进 ^iEL合，来消除这种影响。即，当GPS由于信号遮挡而不能可靠定位时，GPS/DR(航 位推算，Dead-Reckoning)系统自动切换到DR ^^方式来持续输出车辆在^—时刻 的位置信息，直至GPS十^1正常接》|1^,系统再回到GPS与DR的组合^M元方式。DR是一种常用的，定位技术，其基本原理是利用方向传感器和i!A传感器 来推算车辆的瞬时位置，可以实现连续自主式定位。但由于期,算过程是一个累加 过程，方向传感器的误差随时间的延长而积累；另夕卜，推算只能确定相对位置和航 向。导航开始时，需要预知车辆的初始绝对位置和初始方向。DR技术所使用到的硬 lti殳备包括车速传感器和陀螺仪，其中车速传感器推算当前的运动距离，陀螺仪 推算当前的运动方向，两者的融^^得到当前车辆的准确位置。车辆沿着待测道^^f亍驶，车载GPS/DR系统中的GPS设备实时接收GPS卫星信 号，并从中获取车辆位置、卫星接收状态等数据。在卫星接收状态良好时，将相邻 时刻的GPS定位点的连线方向作为车辆的行驶方向，当接收状态不好时，以此方向 作为航位推算的起始基准方向。也就是说，现有技术M用相邻时刻的GPS定位点 的连线方向作为艇位推算的初始方向。为了保证^/f立推算的初始方向的准确性，一 ^^选择一条比较开阔无遮挡的平直道路，且车辆能够以较高的# (如〉70km/h) 持续行驶一段时间。开阔的环境能确保GPS接收才/W妻^^较多的GPS卫星(如>6), 提供比较精确的定位信息，平直的道路则可以使初始方向不会有太大的变化，而较 高的车速可以让相邻的两个GPS定位点之间的距离加大，从而提高初始方向的准确性。综上所述，现有技术航位导航中初始方向的确定方法存在下列缺陷首先，由于在拥挤的城市道路上，车辆太多，车速"fi4较低，而且城市街道高楼林立，遮挡比较"fi4,比较难以满足开阔条件的要求。其次，规有技术^L^用相邻的两个GPS定位点连线方向作为航位推算初始方向， 由于两个GPS定位点的距离太短，例如，假定车速为100km/h，则两GPS定位点之间 的距离约为28m, GPS单点定位精度一般在5m以上，由》bit成的方向偏差可能必ij 20度，从而导致初始方向误差较大。随着时间的推移，航位推算的误差累积将越来 越大，其定位结果4艮快将不可用。
技术实现思路
本专利技术要解决的问题是提供一种准确性高的。 为了解决上述问题，本专利技术的技术方案包括 步骤1)选取有效的GPS定位点；步骤2 )在有效的GPS定位点中选取两个GPS定位点之间的距离大于等于阈值 iU巨离偏差在容差范围内的两个GPS定位点以确定初始方向线段； 步骤3)根据所述初始方向线段计算出初始方向。 其中，所述步骤1)还进一步包括步骤11)读取GPS定位点并判断其定位状态是否有效，若无效，重复纟似亍步 骤ll);步骤12)判断所述GPS定位点是否是3D定卩封莫式，若不是，纟W亍步骤11); 步骤13)判断卫星it量是否大于等于阈值，若否，扭J亍步骤11); 步骤14)判断7K平坐标的精度强弱vl^否小于阈值，若否，执行步骤ll); 步骤15)所述GPS定位点为有效，重复才W亍步骤11)直至选取出若干有效的 GPS定位点。与现有技^N目比，本专利技术的有益效果为 首先，由于选取不相邻的两个GPS点的方向作为初始方向，这两个不相邻的点之间的距离可以远大于相邻两点之间的距离，从而可以削弱由于GPS定位点的定位误差造成的初始方向误差，准确性高。其次，由于作为计算初始方向的两个GPS定位点可以不是相邻的两个GPS定4位点，消除了必须依靠相邻的两GPS定位点来确定初始方向的限制。向，从而降低了 GPS定位点数据有效的判断标准。附图说明图1是本专利技术的法L^呈图； 图2是图1中的步骤1)的进一步细分的^d呈图。具体实施例方式如图1所示，本专利技术航/f立推算中初始方向的确定方法包括 步骤1)选取有效的GPS定位点；步骤2 )在有效的GPS定位点中选取两个GPS定位点之间的距离大于等于阈值 JJ巨离偏差在容差范围内的两个GPS定位点以确定初始方向线—度； 步骤3)根据所述初始方向线段计算出初始方向。由上述可知，本专利技术M选取有效的GPS定位点，也就是说只有满足一定^^牛 的GPS定位点才有可能作为判断初始方向的勤出。这样可以进一步地J呆证结果的准 确性。其中，如图2所示，所述步骤l)还进一步包括步骤11)读取GPS定位点并判断其定位状态是否有效，若无效，重复执行步 骤ll);步骤12)判断所述GPS定位点是否是3D定4封莫式，若不是，4似于步骤11);步骤13)判断卫星数量是否大于等于阈值，若否，执行步骤ll);步骤14)判断HDOP (水平(即二维)坐标的精度强弱度，Horizontal Dilution ofPrecision)是否小于阈值，若否，执行步骤ll);步骤15)所述GPS定位点为有效，重复执行步骤11)直至选取出若干有效的 GPS定位点。由上述可知，作为有效的GPS定位点的条件A^位状态有效、3D定位模式、 卫星数量和HDOP的值，所述HDOP的值指纬度和经度等误差平方和的开根号值。 只有这四个条件都满足的GPS定位点才被视为有效的GPS定位点。一般情况下，卫星数量的阈值设为5， HDOP的阈值设为4。有效GPS定位点5的判断力fd呈如下接4tJiJGPS数据后，先判断该条数悟的有效性，如果无效，则该 GPS定位点无效，接着读取下一个GPS定位点并判断；若有效，则判断GPS定位 模式，如果不为3D模式，则接着读取下一个GPS定位点并判断；若符合^f牛，则 判断卫星凄tA否符合条件，如卫星数<5，则该GPS定位点无效，4妻着读取下一个 GPS定位点并判断；若符合^^牛，判断HDOP是否小于4，若不符合^^牛，GPS定 位点无效，接着读耳又下一个GPS定位点并判断，若符合^^牛，该GPS定位点被视 为有效GPS定位点。在确定初始方向线段的时候，以两个GPS定位点组成的线段的方向作为初始方 向，本专利技术选取的这两个GPS定位点应满足如下条 件1) 两个GPS定位点有效2) 两GPS定位点之间的距离要大于阈值，例如〉50m3 )由这两个GPS定位点的GPS坐标计算出的距离与由里程计测量出的这两个 GPS定位点之间的距离偏差在容差范围内，例如〈lm螺仪角度输出值在容差范围内(如-0.1度 0.1度)当这两个GPS定位点确g，就可以计算初始方向了， "i殳这两个GPS定位点 的坐标分别为(xl,yl), (x2,y2),即可根据公式angle=arctan((yl-y2)/(xl-x2》(先计算 两点在坐标系y轴上的坐标差(yl-y2)，然后计算两点在坐标系本文档来自技高网...

【技术保护点】
一种航位推算中初始方向的确定方法，其特征在于，包括：　步骤１）选取有效的ＧＰＳ定位点；　步骤２）在有效的ＧＰＳ定位点中选取两个ＧＰＳ定位点之间的距离大于等于阈值且距离偏差在容差范围内的两个ＧＰＳ定位点以确定初始方向线段；　 步骤３）根据所述初始方向线段计算出初始方向。

【技术特征摘要】

【专利技术属性】
技术研发人员：杨自华，
申请(专利权)人：高德软件有限公司，
类型：发明
国别省市：11[中国|北京]