(19)中华人民共和国国家知识产权局
汽车gps定位
(12)发明专利说明书
(10)申请公布号 CN 105044756 A
(43)申请公布日 2015.11.11
(21)申请号 CN201510559262.6
(22)申请日 2015.08.29
(71)申请人 安凯
    地址 264670 山东省烟台市高新区航天路513号
(72)发明人 安凯 安培亮 安宏亮 王晓英
(74)专利代理机构
    代理人
(51)Int.CI
      G01S19/48
                                                                  权利要求说明书 说明书 幅图
(54)发明名称
      一种基于GPS和电子指南针的车辆跟踪方法
(57)摘要
      发明了一种基于GPS伪距差分定位数据和车载电子指南针的车辆跟踪方法。该方法周期性地同时采集车辆的GPS伪距差分定位数据和车载电子指南针的角度数据，通过一种数据融合方法将两类数据进行融合，实时给出经过误差修正的车辆运行轨迹。本发明的有益效果在于：车载电子指南针的角度不会产生误差积累，可以对GPS伪距差分定位数据进行有效的修正，从而提供更精确的车辆运行轨迹。
法律状态
法律状态公告日
法律状态信息
法律状态
权 利 要 求 说 明 书
1.一种基于GPS和电子指南针的车辆跟踪方法，其特征在于：以道路上车辆出发点作为原点建立地面直角坐标系，横轴为过原点的纬线的切线，方向向右；纵轴为过原点的经线的切线，方向向上；以周期T同时对车辆的GPS定位数据和车载电子指南针的角度数据进行n次采样，并将GPS定位数据转化为地面直角坐标系中的坐标，用       
<Image></Image>
分别表示转化后的车辆在直角坐标系中的坐标以及带有误差的车载电子指南针测量的车辆运行方向与横轴的角度；令       
<Image></Image>
其中       
<Image></Image>
由此可以得到车辆的测量轨迹点为       
<Image></Image>
<Image></Image>
<Image></Image>
…       
</Image>。                       
说  明  书
技术领域
本发明涉及一种基于GPS和电子指南针的车辆跟踪方法。
背景技术
随着我国社会的进步和经济的发展，机动车辆的数量不断增加。虽然道路交通状况也得到了很大的改善，但其改善速度远远滞后于车辆的增加速度，车多路少的矛盾越来越明显，导致交通拥挤、交通事故日益增多等社会急需解决的问题。然而，要解决道路交通面临的问题，按照传统的交通发展策略，仅靠增加道路的面积，提高路网的总体容量，完善路网的布局是不可行的。因为这种发展的模式不仅成本比较高，对生态环境有比较大的影响，而且其缓解交通拥挤的效果也是很有限的。信息技术的快速发展为解决交通问题提供一个新的思路。在解决道路交通问题的过程中，不仅要改善现有的交通基础设施，而且要借助系统论、控制论和信息论的思想，把先进的信息技术应用于交通管理和控制中，通过信息的沟通与连接，加强现有交通系统的管理，最大限度地提高现有道路的交通效率，使道路更加顺畅。
GPS定位系统以其定位广泛、快速、准确的特点，在航空航天、大地测量、陆地导航、军事等各方面得到了广泛应用。但由于受选择可用性(SA)、电离层、对流层延迟、地面反射、天线相位中心偏差和多路径效应等多种误差因素的影响，它的实际定位精度并不理想，单点定
位精度大约为10米。为此，人们发展了差分定位技术。使用差分定位技术可以有效地消除包括SA误差、大部分的电离层延迟和部分对流层延迟，因此可以使定位精度大大提高。据报道，有一种GPS伪距差分定位系统，使用GSM网络的短消息服务作为差分系统和用户终端之间的数据传输方式，用户终端使用ARM微处理器进行控制，实验结果表明能够提供2-5m的平面定位精度。可见使用GPS对车辆定位，其误差不会小于米级，如此精度的GPS只能用来确定车辆的大体位置，而不能用于确定车辆与某条交通标志线的相对位置。可见，要提高车辆的定位精度仅采用GPS定位数据是不行的，必须借助另外一种定位手段对GPS定位数据进行修正。
随着数字化技术的发展，目前已实现了基于磁通门、磁感应式和霍尔效应等的数字化指南针。其中磁通门和磁感应式指南针精度较高，可达到±1°。将数字化电子指南针用于车辆方向的确定，并融合GPS定位数据对车辆实施跟踪，是提高跟踪精度的有效途径。
发明内容
发明了一种基于GPS伪距差分定位数据和车载电子指南针的车辆跟踪方法。该方法周期性地同时采集车辆的GPS伪距差分定位数据和车载电子指南针的角度数据，通过一种数据融合方
法将两类数据进行融合，实时给出经过误差修正的车辆运行轨迹。
本发明的有益效果在于：车载电子指南针的角度不会产生误差积累，可以对GPS伪距差分定位数据进行有效的修正，从而提供更精确的车辆运行轨迹。
附图说明
图1是车辆分段路径示意图。
图2是真实路径、GPS定位数据的模拟点连线和车辆的测量轨迹对比图。
标号说明：1真实路径，2GPS定位数据的模拟点连线，3车辆的测量轨迹。
具体实施方式
1.建立地面直角坐标系
以道路上车辆出发点作为原点建立地面直角坐标系，如图1所示。横轴为过原点的纬线的切线，方向向右；纵轴为过原点的经线的切线，方向向上。
2.获取定位数据
由于所考察的车辆运行轨迹在以上定义的直角坐标系的原点附近，可以认为车辆运行在坐标平面内。按照微积分的思想，在任何一段曲线都可以看成是由分点足够多的直线段连接而成的。假定以周期T同时对车辆的GPS伪距差分定位数据和车载数字化电子指南针的角度数据采样，并将GPS伪距差分定位数据转化为地面直角坐标系中的坐标，得到的位置和角度数据分别为
<Math><MathText>><mrow><mrow><mo>(</mo><msub><mover><mi>x</mi><mo>~</mo></mover><mi>i</mi></msub><mo>,</mo><msub><mover><mi>y</mi><mo>~</mo></mover><mi>i</mi></msub><mo>,</mo><mo>)</mo></mrow><mo>,</mo><msub><mover><mi>α</mi><mo>~</mo></mover><mi>i</mi></msub><mo>,</mo><mi>i</mi><mo>=</mo><mn>1,2</mn><mo>,</mo><mo>·</mo><mo>·</mo><mo>·</mo></mrow></math>></Math>
其中<Image>是带有误差的定位数据，而<Image>是带有误差的车载电子指南针实际测量的车辆行驶方向与x轴夹角度数。
3.确定轨迹
如图1所示，在第i个采样时刻，车辆在地面直角坐标系中的真实位置为
(x<Sub>i</Sub>，y<Sub>i</Sub>，)，i＝1，2，…
以P<Sub>i</Sub>表示点(x<Sub>i</Sub>，y<Sub>i</Sub>，)，于是车辆的路径可以看成是由有向直线段<Image>首尾相接连成的曲线。不妨设有向直线段<Image>的长度为l<Sub>i+1</Sub>，与x轴的夹角为α<Sub>i+1</Sub>(i＝0，1，2，…)。
对i＝1，2，…，n，P<Sub>i</Sub>点的坐标(x<Sub>i</Sub>，y<Sub>i</Sub>，)可表示为
<Math><MathText>><mrow><msub><mi>x</mi><mi>i</mi></msub><mo>=</mo><munderover><mi>Σ</mi><mrow><mi>k</mi><mo>=</mo><mn>1</mn></mrow><mi>i</mi></munderover><msub><mi>l</mi><mi>k</mi></msub><mi>cos</mi><msub><mi>α</mi><mi>k</mi></msub></mrow></math>></Math>
<Math><MathText>><mrow><msub><mi>y</mi><mi>i</mi></msub><mo>=</mo><munde
rover><mi>Σ</mi><mrow><mi>k</mi><mo>=</mo><mn>1</mn></mrow><mi>i</mi></munderover><msub><mi>l</mi><mi>k</mi></msub><mi>sin</mi><msub><mi>α</mi><mi>k</mi></msub></mrow></math>></Math>