一种定位性能良好的巡逻车的制作方法

文档序号:12359778阅读:176来源:国知局
一种定位性能良好的巡逻车的制作方法与工艺

本发明涉及车辆管理技术领域,具体涉及一种定位性能良好的巡逻车。



背景技术:

为了尽可能提高卫星定位的精度,目前已发展出了多种卫星定位增强技术,例如,局域差分GPS,广域差分GPS等,可大幅度卫星定位的精度。然而,具备卫星定位增强功能的全球导航卫星系统接收机普遍存在结构复杂、价格高昂的问题。相关技术中的高速用巡逻车需要对管辖的车辆进行定位,若直接采用具备卫星定位增强功能的全球导航卫星系统接收机进行需定位车辆的定位,将会极大地增加管理成本。



技术实现要素:

为解决上述问题,本发明提供一种

本发明的目的采用以下技术方案来实现:

一种定位性能良好的巡逻车,所述巡逻车上设置全球导航卫星系统增强定位系统,所述全球导航卫星系统增强定位系统包括设置于巡逻车上的依次连接的用户端、定位服务器、位置修正模块以及与所述位置修正模块通过网络传输模块连接的具有卫星定位增强功能的全球导航卫星系统接收机;所述用户端用于向定位服务器发起定位请求;所述定位服务器用于在接收定位请求后获取需定位车辆的普通卫星定位信号,并将所述需定位车辆的普通卫星定位信号发送到位置修正模块;所述全球导航卫星系统接收机,用于根据同一卫星天线同时接收自身的增强卫星定位信号和普通卫星定位信号,进行增强定位和位置解算处理,获取自身的高精度坐标,并将自身的高精度坐标与普通卫星定位信号之间的差分数据通过网络传输模块实时传输给所述位置修正模块;所述位置修正模块用于利用差分数据对所述需定位车辆的普通卫星定位信号进行修正,并根据修正后的普通卫星定位信号得到需定位车辆的高精度位置信息。

本发明的有益效果为:仅需要增加一部具有卫星定位增强功能的全球导航卫星系统接收机,即可有效提高多个不具有卫星定位增强功能的需定位车辆的定位精度,有效解决了高精度定位需求与低使用成本之间的矛盾,从而解决了上述的技术问题。

附图说明

利用附图对本发明作进一步说明,但附图中的实施例不构成对本发明的任何限制,对于本领域的普通技术人员,在不付出创造性劳动的前提下,还可以根据以下附图获得其它的附图。

图1本发明的结构示意图;

图2是全球导航卫星系统接收机的结构示意图。

附图标记:

用户端1、定位服务器2、位置修正模块3、全球导航卫星系统接收机4、位置显示模块5、增强卫星定位信号接收单元41、普通卫星定位信号接收单元42、卫星伪距测量结果获取单元43、卫星测量伪距误差消除单元44、位置解算粗差消除单元45。

具体实施方式

结合以下实施例对本发明作进一步描述。

应用场景1

参见图1、图2,本应用场景的一个实施例的定位性能良好的巡逻车,所述巡逻车上设置全球导航卫星系统增强定位系统,所述全球导航卫星系统增强定位系统包括设置于巡逻车上的依次连接的用户端1、定位服务器2、位置修正模块3以及与所述位置修正模块3通过网络传输模块连接的具有卫星定位增强功能的全球导航卫星系统接收机4;所述用户端1用于向定位服务器2发起定位请求;所述定位服务器2用于在接收定位请求后获取需定位车辆的普通卫星定位信号,并将所述需定位车辆的普通卫星定位信号发送到位置修正模块3;所述全球导航卫星系统接收机4,用于根据同一卫星天线同时接收自身的增强卫星定位信号和普通卫星定位信号,进行增强定位和位置解算处理,获取自身的高精度坐标,并将自身的高精度坐标与普通卫星定位信号之间的差分数据通过网络传输模块实时传输给所述位置修正模块3;所述位置修正模块3用于利用差分数据对所述需定位车辆的普通卫星定位信号进行修正,并根据修正后的普通卫星定位信号得到需定位车辆的高精度位置信息。

优选的,所述全球导航卫星系统接收机4设有用于接收自身的增强卫星定位信号的增强卫星定位信号接收单元41和用于接收自身普通卫星定位信号的普通卫星定位信号接收单元42。

本发明上述实施例仅需要增加一部具有卫星定位增强功能的全球导航卫星系统接收机4,即可有效提高多个不具有卫星定位增强功能的需定位车辆的定位精度,有效解决了高精度定位需求与低使用成本之间的矛盾,从而解决了上述的技术问题。

优选的,所述全球导航卫星系统增强定位系统还包括用于显示所述需定位车辆的高精度位置信息的位置显示模块5。

本优选实施例便于巡逻人员实时掌握巡逻车辆实时位置和巡查信息,促进所辖路段的安全畅通。

优选的,所述全球导航卫星系统接收机4还包括卫星伪距测量结果获取单元43、卫星测量伪距误差消除单元44、位置解算粗差消除单元45,所述卫星伪距测量结果获取单元43用于同时处理多颗卫星的伪距观测,获取卫星伪距测量数据;所述卫星测量伪距误差消除单元44用于消除卫星伪距测量过程中的系统误差;所述位置解算粗差消除单元45用于采用最小二乘法对消除系统误差后的卫星伪距测量数据进行位置解算,并在解算过程中进行粗差消除,最终获取所述高精度坐标。

本优选实施例构建了全球导航卫星系统接收机4的主要架构。

优选的,所述卫星伪距测量结果获取单元43采用的卫星伪距的测量计算公式为:

<mrow> <msup> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>=</mo> <msup> <mi>r</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>+</mo> <mi>c</mi> <mrow> <mo>(</mo> <msub> <mi>&delta;t</mi> <mi>s</mi> </msub> <mo>-</mo> <msup> <mi>&delta;t</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mo>+</mo> <mi>c</mi> <mrow> <mo>(</mo> <msup> <mi>Y</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mo>+</mo> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> </mrow>

式中,M=1,2,…,m为所有观测到卫星的临时编号,ρ(M)为每颗可见卫星的测量伪距,r(M)代表每颗卫星位置与全球导航卫星系统接收机4位置的几何距离,δts为全球导航卫星系统接收机4时钟与GPS时钟的钟差,δt(M)为每颗卫星与GPS时钟的钟差,Y(M)为信号延时误差,Y(M)=C(M)+D(M)+Z(M)+R(M),C(M)为每个卫星信号经过磁层的延时,D(M)为每个卫星信号经过电离层的延时,Z(M)为每个卫星信号经过中性层的延时,R(M)为地球自转效应的延时,为对每个卫星信号的伪距测量噪声;

其中,X为全球导航卫星系统接收机4的位置坐标向量,X(M)为卫星M的位置坐标向量。

本优选实施例提出了可见卫星的测量伪距的计算公式,在伪距的计算中考虑了各种延时误差,减少了初始定位的时间,减少了全球导航卫星系统接收机4的能量损耗,增加待机时间,提高了卫星伪距的测量精度。

优选的,所述消除卫星伪距测量过程中的系统误差包括:

(1)第一次对误差进行消除:

由于卫星轨道摄动,卫星在轨位置与真实位置会存在偏差p1,采取差分定位法进行消除,误差消减后偏差为p′1

由于存在时钟漂移和相对论效应,各个卫星时钟不可能与GPS时间严格同步,存在钟差p2,由卫星发布的导航电文进行消除,误差消减后偏差为p′2

由于各误差对定位精度影响不同,设定阈值T1,并引入误差评估因子P:

P=(p1-p′1)×(p2-p′2)

若P≤T1,则完成第一次的误差消除,否则,需继续进行第一次的误差消除;其中设定T1的取值范围为[30m,50m];

除δts无法通过接收的可见星信息进行修正,可得:

<mrow> <msqrt> <mrow> <mo>(</mo> <msup> <mi>x</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <msub> <mi>x</mi> <mi>s</mi> </msub> <mo>)</mo> <mo>+</mo> <mo>(</mo> <msup> <mi>y</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <msub> <mi>y</mi> <mi>s</mi> </msub> <mo>)</mo> <mo>+</mo> <mo>(</mo> <msup> <mi>z</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <msub> <mi>z</mi> <mi>s</mi> </msub> <mo>)</mo> </mrow> </msqrt> <mo>+</mo> <msub> <mi>&delta;t</mi> <mi>s</mi> </msub> <mo>=</mo> <msup> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mrow>

对其使用Taylor展开并进行一阶化线性化截断,忽略剩下的高阶项,从而使伪距测量方程线性化求解:Δρ(M)=H·ΔX

和分别为k和k-1时刻全球导航卫星系统接收机4相对卫星M的伪距,ΔX=Xk-Xk-1,Xk和Xk-1分别为k和k-1时刻全球导航卫星系统接收机4的位置;

(2)第二次对误差进行消除:

经过第一次误差消除,易得:

<mrow> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>=</mo> <msup> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <mo>|</mo> <mo>|</mo> <msup> <mi>X</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <mi>X</mi> <mo>|</mo> <mo>|</mo> <mo>-</mo> <msub> <mi>&delta;t</mi> <mi>s</mi> </msub> </mrow>

为了研究方便,假设测量误差符合独立分布的条件,并且符合正态分布:

<mrow> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>~</mo> <mi>N</mi> <mrow> <mo>(</mo> <mn>0</mn> <mo>,</mo> <msup> <mrow> <mo>(</mo> <msubsup> <mi>&sigma;</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>)</mo> </mrow> </mrow>

式中,为标准差,M为可见星的个数,令:

<mrow> <mfrac> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <msup> <mi>w</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mfrac> <mo>~</mo> <mi>N</mi> <mrow> <mo>(</mo> <mn>0</mn> <mo>,</mo> <msubsup> <mi>&sigma;</mi> <mn>0</mn> <mn>2</mn> </msubsup> <mo>)</mo> </mrow> </mrow>

w(M)为每个测量值对应的权重,σ0为标准差,ΔX通过下式求解:

<mrow> <mfrac> <mn>1</mn> <msup> <mi>w</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mfrac> <msup> <mi>&Delta;&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>=</mo> <mfrac> <mn>1</mn> <msup> <mi>w</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mfrac> <mi>H</mi> <mo>&CenterDot;</mo> <mi>&Delta;</mi> <mi>X</mi> </mrow>

每一个输出测量值ρ(M)对应一个权重w(M),并希望权重w(M)倒数越大的值在解算中作用越大,若ρ(M)测量误差越小,w(M)应越小;

其中,影响伪距测量精度的因素包括:与GPS卫星本身有关的误差E1、与全球导航卫星系统接收机4有关的误差E2、与卫星信号强度有关的误差E3、包括地球潮汐在内其它误差E4

其中,E1通过导航电文中测距精度因子N提供给用户,

E1越小时,测量误差越小,这满足加权算法中对权重因子的选择要求;

E由全球导航卫星系统接收机4本身预测和实际测量值得到的,每次测量误差都会得到与该测量误差相关的一组误差值,这样就每次测量都可以得到与之对应的测量误差的标准差σ(M)

w(M)=σ(M)

以该标准差作为权重因子;

E3用载噪比表示,采用SIGMA-ε模型进行误差衡量,

<mrow> <msup> <mrow> <mo>(</mo> <msup> <mi>&sigma;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>=</mo> <mi>a</mi> <mo>+</mo> <mi>b</mi> <mo>&CenterDot;</mo> <msup> <mn>10</mn> <mrow> <mo>(</mo> <mo>-</mo> <mfrac> <mi>C</mi> <msub> <mi>N</mi> <mrow> <mn>0</mn> <mo>,</mo> <mi>i</mi> </mrow> </msub> </mfrac> <mo>)</mo> <mo>/</mo> <mn>10</mn> </mrow> </msup> </mrow>

a、b为模型参数,N0,i为测量的载噪比,当载噪比越大时,测量误差也就越小,满足了加权算法中对权重因子的选择要求;

E4以地球潮汐为例,潮汐引起测站位移,位移越小,引起的误差越小,符合权重因子选取要求;

设E1、E2、E3、E4的权重因子分别为对其进行重新加权,得到:

<mrow> <msubsup> <mi>w</mi> <mrow> <mi>a</mi> <mi>d</mi> <mi>d</mi> </mrow> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>=</mo> <msub> <mi>a</mi> <mn>1</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>+</mo> <msub> <mi>a</mi> <mn>2</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>+</mo> <msub> <mi>a</mi> <mn>3</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>+</mo> <msub> <mi>a</mi> <mn>4</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>4</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> </mrow>

其中,系数j=1,2,3,4;

(3)确定误差消减后的定位误差:

确定两次误差消减对定位精度的影响因子分别为Q1和Q2,综合影响因子:

Q=Q1×Q2

定位精度用距离均方根(DRMS)表示,误差消减前后定位误差存在如下关系:

DRMSh=Q×DRMSq

DRMSq和DRMSh分别表示误差消减前后定位误差。

本优选实施例通过对卫星伪距测量过程中的系统误差进行消除,提高了全球导航卫星系统接收机4的灵敏度,进一步提高了卫星伪距的测量精度,从而提高了定位精度。

优选的,所述位置解算粗差消除单元45以计算机和滤波器为载体,包括依次连接的预处理子单元、位置解算子单元、粗差判断及消除子单元和滤波子单元;所述预处理子单元用于对所述消除系统误差后的卫星伪距测量数据进行预处理,剔除数据异常的卫星;所述位置解算子单元用于根据预处理后的卫星伪距测量数据,采用最小二乘法和初始权矩阵进行初始化的定位求解;所述粗差判断及消除子单元用于判断位置解算子单元输出的定位求解结果是否存在粗差,若存在粗差,剔除出现粗差的故障卫星,若不存在粗差,采用最小二乘法及新的权矩阵进行迭代计算,直到定位位置的增量小于预设的足够小的阀值T2时终止迭代,从而确定优选的卫星,进而得到并输出定位结果;所述滤波子单元用于对所述定位结果采用卡尔曼滤波进行滤波计算,并输出最终的定位结果;

其中,所述采用最小二乘法和初始权矩阵进行初始化的定位求解,包括:获取卫星伪距测量误差方程的系数阵和常数项,根据卫星高度角获取所述初始权矩阵;根据最小二乘法进行定位求解;

其中,所述判断位置解算子单元输出的定位求解结果是否存在粗差,包括:根据卫星的数目和相应的纳伪概率和弃真概率进行粗差检验,对检验的粗差,根据卫星伪距测量误差方程和初始化矩阵计算出新矩阵,计算新矩阵各向量之间的距离,采用K-means聚类方法对所述各向量之间的距离进行聚类分析,判断向量之间的亲疏关系,从而完成粗差识别。

本优选实施例将最小二乘法、迭代运算、聚类方法和滤波计算相结合,提高卫星优选和定位的精度,在消除伪距测量误差后、迭代运算之前进行是否存在粗差的判断,并隔离存在粗差的故障卫星,减小了计算量,进一步提高定位准确度。

在此应用场景中,设定阈值T1的取值为30mm,定位速度相对提高了10%,定位精度相对提高了12%。

应用场景2

参见图1、图2,本应用场景的一个实施例的定位性能良好的巡逻车,所述巡逻车上设置全球导航卫星系统增强定位系统,所述全球导航卫星系统增强定位系统包括设置于巡逻车上的依次连接的用户端1、定位服务器2、位置修正模块3以及与所述位置修正模块3通过网络传输模块连接的具有卫星定位增强功能的全球导航卫星系统接收机4;所述用户端1用于向定位服务器2发起定位请求;所述定位服务器2用于在接收定位请求后获取需定位车辆的普通卫星定位信号,并将所述需定位车辆的普通卫星定位信号发送到位置修正模块3;所述全球导航卫星系统接收机4,用于根据同一卫星天线同时接收自身的增强卫星定位信号和普通卫星定位信号,进行增强定位和位置解算处理,获取自身的高精度坐标,并将自身的高精度坐标与普通卫星定位信号之间的差分数据通过网络传输模块实时传输给所述位置修正模块3;所述位置修正模块3用于利用差分数据对所述需定位车辆的普通卫星定位信号进行修正,并根据修正后的普通卫星定位信号得到需定位车辆的高精度位置信息。

优选的,所述全球导航卫星系统接收机4设有用于接收自身的增强卫星定位信号的增强卫星定位信号接收单元41和用于接收自身普通卫星定位信号的普通卫星定位信号接收单元42。

本发明上述实施例仅需要增加一部具有卫星定位增强功能的全球导航卫星系统接收机4,即可有效提高多个不具有卫星定位增强功能的需定位车辆的定位精度,有效解决了高精度定位需求与低使用成本之间的矛盾,从而解决了上述的技术问题。

优选的,所述全球导航卫星系统增强定位系统还包括用于显示所述需定位车辆的高精度位置信息的位置显示模块5。

本优选实施例便于巡逻人员实时掌握巡逻车辆实时位置和巡查信息,促进所辖路段的安全畅通。

优选的,所述全球导航卫星系统接收机4还包括卫星伪距测量结果获取单元43、卫星测量伪距误差消除单元44、位置解算粗差消除单元45,所述卫星伪距测量结果获取单元43用于同时处理多颗卫星的伪距观测,获取卫星伪距测量数据;所述卫星测量伪距误差消除单元44用于消除卫星伪距测量过程中的系统误差;所述位置解算粗差消除单元45用于采用最小二乘法对消除系统误差后的卫星伪距测量数据进行位置解算,并在解算过程中进行粗差消除,最终获取所述高精度坐标。

本优选实施例构建了全球导航卫星系统接收机4的主要架构。

优选的,所述卫星伪距测量结果获取单元43采用的卫星伪距的测量计算公式为:

<mrow> <msup> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>=</mo> <msup> <mi>r</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>+</mo> <mi>c</mi> <mrow> <mo>(</mo> <msub> <mi>&delta;t</mi> <mi>s</mi> </msub> <mo>-</mo> <msup> <mi>&delta;t</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mo>+</mo> <mi>c</mi> <mrow> <mo>(</mo> <msup> <mi>Y</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mo>+</mo> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> </mrow>

式中,M=1,2,…,m为所有观测到卫星的临时编号,ρ(M)为每颗可见卫星的测量伪距,r(M)代表每颗卫星位置与全球导航卫星系统接收机4位置的几何距离,δts为全球导航卫星系统接收机4时钟与GPS时钟的钟差,δt(M)为每颗卫星与GPS时钟的钟差,Y(M)为信号延时误差,Y(M)=C(M)+D(M)+Z(M)+R(M),C(M)为每个卫星信号经过磁层的延时,D(M)为每个卫星信号经过电离层的延时,Z(M)为每个卫星信号经过中性层的延时,R(M)为地球自转效应的延时,为对每个卫星信号的伪距测量噪声;

其中,X为全球导航卫星系统接收机4的位置坐标向量,X(M)为卫星M的位置坐标向量。

本优选实施例提出了可见卫星的测量伪距的计算公式,在伪距的计算中考虑了各种延时误差,减少了初始定位的时间,减少了全球导航卫星系统接收机4的能量损耗,增加待机时间,提高了卫星伪距的测量精度。

优选的,所述消除卫星伪距测量过程中的系统误差包括:

(1)第一次对误差进行消除:

由于卫星轨道摄动,卫星在轨位置与真实位置会存在偏差p1,采取差分定位法进行消除,误差消减后偏差为p′1

由于存在时钟漂移和相对论效应,各个卫星时钟不可能与GPS时间严格同步,存在钟差p2,由卫星发布的导航电文进行消除,误差消减后偏差为p′2

由于各误差对定位精度影响不同,设定阈值T1,并引入误差评估因子P:

P=(p1-p′1)×(p2-p′2)

若P≤T1,则完成第一次的误差消除,否则,需继续进行第一次的误差消除;其中设定T1的取值范围为[30m,50m];

除δts无法通过接收的可见星信息进行修正,可得:

<mrow> <msqrt> <mrow> <mo>(</mo> <msup> <mi>x</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <msub> <mi>x</mi> <mi>s</mi> </msub> <mo>)</mo> <mo>+</mo> <mo>(</mo> <msup> <mi>y</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <msub> <mi>y</mi> <mi>s</mi> </msub> <mo>)</mo> <mo>+</mo> <mo>(</mo> <msup> <mi>z</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <msub> <mi>z</mi> <mi>s</mi> </msub> <mo>)</mo> </mrow> </msqrt> <mo>+</mo> <msub> <mi>&delta;t</mi> <mi>s</mi> </msub> <mo>=</mo> <msup> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mrow>

对其使用Taylor展开并进行一阶化线性化截断,忽略剩下的高阶项,从而使伪距测量方程线性化求解:Δρ(M)=H·ΔX

和分别为k和k-1时刻全球导航卫星系统接收机4相对卫星M的伪距,ΔX=Xk-Xk-1,Xk和Xk-1分别为k和k-1时刻全球导航卫星系统接收机4的位置;

(2)第二次对误差进行消除:

经过第一次误差消除,易得:

<mrow> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>=</mo> <msup> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <mo>|</mo> <mo>|</mo> <msup> <mi>X</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <mi>X</mi> <mo>|</mo> <mo>|</mo> <mo>-</mo> <msub> <mi>&delta;t</mi> <mi>s</mi> </msub> </mrow>

为了研究方便,假设测量误差符合独立分布的条件,并且符合正态分布:

<mrow> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>~</mo> <mi>N</mi> <mrow> <mo>(</mo> <mn>0</mn> <mo>,</mo> <msup> <mrow> <mo>(</mo> <msubsup> <mi>&sigma;</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>)</mo> </mrow> </mrow>

式中,为标准差,M为可见星的个数,令:

<mrow> <mfrac> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <msup> <mi>w</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mfrac> <mo>~</mo> <mi>N</mi> <mrow> <mo>(</mo> <mn>0</mn> <mo>,</mo> <msubsup> <mi>&sigma;</mi> <mn>0</mn> <mn>2</mn> </msubsup> <mo>)</mo> </mrow> </mrow>

w(M)为每个测量值对应的权重,σ0为标准差,ΔX通过下式求解:

<mrow> <mfrac> <mn>1</mn> <msup> <mi>w</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mfrac> <msup> <mi>&Delta;&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>=</mo> <mfrac> <mn>1</mn> <msup> <mi>w</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mfrac> <mi>H</mi> <mo>&CenterDot;</mo> <mi>&Delta;</mi> <mi>X</mi> </mrow>

每一个输出测量值ρ(M)对应一个权重w(M),并希望权重w(M)倒数越大的值在解算中作用越大,若ρ(M)测量误差越小,w(M)应越小;

其中,影响伪距测量精度的因素包括:与GPS卫星本身有关的误差E1、与全球导航卫星系统接收机4有关的误差E2、与卫星信号强度有关的误差E3、包括地球潮汐在内其它误差E4

其中,E1通过导航电文中测距精度因子N提供给用户,

E1越小时,测量误差越小,这满足加权算法中对权重因子的选择要求;

E2由全球导航卫星系统接收机4本身预测和实际测量值得到的,每次测量误差都会得到与该测量误差相关的一组误差值,这样就每次测量都可以得到与之对应的测量误差的标准差σ(M)

w(M)=σ(M)

以该标准差作为权重因子;

E3用载噪比表示,采用SIGMA-ε模型进行误差衡量,

<mrow> <msup> <mrow> <mo>(</mo> <msup> <mi>&sigma;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>=</mo> <mi>a</mi> <mo>+</mo> <mi>b</mi> <mo>&CenterDot;</mo> <msup> <mn>10</mn> <mrow> <mo>(</mo> <mo>-</mo> <mfrac> <mi>C</mi> <msub> <mi>N</mi> <mrow> <mn>0</mn> <mo>,</mo> <mi>i</mi> </mrow> </msub> </mfrac> <mo>)</mo> <mo>/</mo> <mn>10</mn> </mrow> </msup> </mrow>

a、b为模型参数,N0,i为测量的载噪比,当载噪比越大时,测量误差也就越小,满足了加权算法中对权重因子的选择要求;

E4以地球潮汐为例,潮汐引起测站位移,位移越小,引起的误差越小,符合权重因子选取要求;

设E1、E2、E3、E4的权重因子分别为对其进行重新加权,得到:

<mrow> <msubsup> <mi>w</mi> <mrow> <mi>a</mi> <mi>d</mi> <mi>d</mi> </mrow> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>=</mo> <msub> <mi>a</mi> <mn>1</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>+</mo> <msub> <mi>a</mi> <mn>2</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>+</mo> <msub> <mi>a</mi> <mn>3</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>+</mo> <msub> <mi>a</mi> <mn>4</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>4</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> </mrow>

其中,系数j=1,2,3,4;

(3)确定误差消减后的定位误差:

确定两次误差消减对定位精度的影响因子分别为Q1和Q2,综合影响因子:

Q=Q1×Q2

定位精度用距离均方根(DRMS)表示,误差消减前后定位误差存在如下关系:

DRMSh=Q×DRMSq

DRMSq和DRMSh分别表示误差消减前后定位误差。

本优选实施例通过对卫星伪距测量过程中的系统误差进行消除,提高了全球导航卫星系统接收机4的灵敏度,进一步提高了卫星伪距的测量精度,从而提高了定位精度。

优选的,所述位置解算粗差消除单元45以计算机和滤波器为载体,包括依次连接的预处理子单元、位置解算子单元、粗差判断及消除子单元和滤波子单元;所述预处理子单元用于对所述消除系统误差后的卫星伪距测量数据进行预处理,剔除数据异常的卫星;所述位置解算子单元用于根据预处理后的卫星伪距测量数据,采用最小二乘法和初始权矩阵进行初始化的定位求解;所述粗差判断及消除子单元用于判断位置解算子单元输出的定位求解结果是否存在粗差,若存在粗差,剔除出现粗差的故障卫星,若不存在粗差,采用最小二乘法及新的权矩阵进行迭代计算,直到定位位置的增量小于预设的足够小的阀值T2时终止迭代,从而确定优选的卫星,进而得到并输出定位结果;所述滤波子单元用于对所述定位结果采用卡尔曼滤波进行滤波计算,并输出最终的定位结果;

其中,所述采用最小二乘法和初始权矩阵进行初始化的定位求解,包括:获取卫星伪距测量误差方程的系数阵和常数项,根据卫星高度角获取所述初始权矩阵;根据最小二乘法进行定位求解;

其中,所述判断位置解算子单元输出的定位求解结果是否存在粗差,包括:根据卫星的数目和相应的纳伪概率和弃真概率进行粗差检验,对检验的粗差,根据卫星伪距测量误差方程和初始化矩阵计算出新矩阵,计算新矩阵各向量之间的距离,采用K-means聚类方法对所述各向量之间的距离进行聚类分析,判断向量之间的亲疏关系,从而完成粗差识别。

本优选实施例将最小二乘法、迭代运算、聚类方法和滤波计算相结合,提高卫星优选和定位的精度,在消除伪距测量误差后、迭代运算之前进行是否存在粗差的判断,并隔离存在粗差的故障卫星,减小了计算量,进一步提高定位准确度。

在此应用场景中,设定阈值T1的取值为35mm,定位速度相对提高了9%,定位精度相对提高了11%。

应用场景3

参见图1、图2,本应用场景的一个实施例的定位性能良好的巡逻车,所述巡逻车上设置全球导航卫星系统增强定位系统,所述全球导航卫星系统增强定位系统包括设置于巡逻车上的依次连接的用户端1、定位服务器2、位置修正模块3以及与所述位置修正模块3通过网络传输模块连接的具有卫星定位增强功能的全球导航卫星系统接收机4;所述用户端1用于向定位服务器2发起定位请求;所述定位服务器2用于在接收定位请求后获取需定位车辆的普通卫星定位信号,并将所述需定位车辆的普通卫星定位信号发送到位置修正模块3;所述全球导航卫星系统接收机4,用于根据同一卫星天线同时接收自身的增强卫星定位信号和普通卫星定位信号,进行增强定位和位置解算处理,获取自身的高精度坐标,并将自身的高精度坐标与普通卫星定位信号之间的差分数据通过网络传输模块实时传输给所述位置修正模块3;所述位置修正模块3用于利用差分数据对所述需定位车辆的普通卫星定位信号进行修正,并根据修正后的普通卫星定位信号得到需定位车辆的高精度位置信息。

优选的,所述全球导航卫星系统接收机4设有用于接收自身的增强卫星定位信号的增强卫星定位信号接收单元41和用于接收自身普通卫星定位信号的普通卫星定位信号接收单元42。

本发明上述实施例仅需要增加一部具有卫星定位增强功能的全球导航卫星系统接收机4,即可有效提高多个不具有卫星定位增强功能的需定位车辆的定位精度,有效解决了高精度定位需求与低使用成本之间的矛盾,从而解决了上述的技术问题。

优选的,所述全球导航卫星系统增强定位系统还包括用于显示所述需定位车辆的高精度位置信息的位置显示模块5。

本优选实施例便于巡逻人员实时掌握巡逻车辆实时位置和巡查信息,促进所辖路段的安全畅通。

优选的,所述全球导航卫星系统接收机4还包括卫星伪距测量结果获取单元43、卫星测量伪距误差消除单元44、位置解算粗差消除单元45,所述卫星伪距测量结果获取单元43用于同时处理多颗卫星的伪距观测,获取卫星伪距测量数据;所述卫星测量伪距误差消除单元44用于消除卫星伪距测量过程中的系统误差;所述位置解算粗差消除单元45用于采用最小二乘法对消除系统误差后的卫星伪距测量数据进行位置解算,并在解算过程中进行粗差消除,最终获取所述高精度坐标。

本优选实施例构建了全球导航卫星系统接收机4的主要架构。

优选的,所述卫星伪距测量结果获取单元43采用的卫星伪距的测量计算公式为:

<mrow> <msup> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>=</mo> <msup> <mi>r</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>+</mo> <mi>c</mi> <mrow> <mo>(</mo> <msub> <mi>&delta;t</mi> <mi>s</mi> </msub> <mo>-</mo> <msup> <mi>&delta;t</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mo>+</mo> <mi>c</mi> <mrow> <mo>(</mo> <msup> <mi>Y</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mo>+</mo> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> </mrow>

式中,M=1,2,…,m为所有观测到卫星的临时编号,ρ(M)为每颗可见卫星的测量伪距,r(M)代表每颗卫星位置与全球导航卫星系统接收机4位置的几何距离,δts为全球导航卫星系统接收机4时钟与GPS时钟的钟差,δt(M)为每颗卫星与GPS时钟的钟差,Y(M)为信号延时误差,Y(M)=C(M)+D(M)+Z(M)+R(M),C(M)为每个卫星信号经过磁层的延时,D(M)为每个卫星信号经过电离层的延时,Z(M)为每个卫星信号经过中性层的延时,R(M)为地球自转效应的延时,为对每个卫星信号的伪距测量噪声;

其中,X为全球导航卫星系统接收机4的位置坐标向量,X(M)为卫星M的位置坐标向量。

本优选实施例提出了可见卫星的测量伪距的计算公式,在伪距的计算中考虑了各种延时误差,减少了初始定位的时间,减少了全球导航卫星系统接收机4的能量损耗,增加待机时间,提高了卫星伪距的测量精度。

优选的,所述消除卫星伪距测量过程中的系统误差包括:

(1)第一次对误差进行消除:

由于卫星轨道摄动,卫星在轨位置与真实位置会存在偏差p1,采取差分定位法进行消除,误差消减后偏差为p′1

由于存在时钟漂移和相对论效应,各个卫星时钟不可能与GPS时间严格同步,存在钟差P2,由卫星发布的导航电文进行消除,误差消减后偏差为p′2

由于各误差对定位精度影响不同,设定阈值T1,并引入误差评估因子P:

P=(p1-p′1)×(p2-p′2)

若P≤T1,则完成第一次的误差消除,否则,需继续进行第一次的误差消除;其中设定T1的取值范围为[30m,50m];

除δts无法通过接收的可见星信息进行修正,可得:

<mrow> <msqrt> <mrow> <mo>(</mo> <msup> <mi>x</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <msub> <mi>x</mi> <mi>s</mi> </msub> <mo>)</mo> <mo>+</mo> <mo>(</mo> <msup> <mi>y</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <msub> <mi>y</mi> <mi>s</mi> </msub> <mo>)</mo> <mo>+</mo> <mo>(</mo> <msup> <mi>z</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <msub> <mi>z</mi> <mi>s</mi> </msub> <mo>)</mo> </mrow> </msqrt> <mo>+</mo> <msub> <mi>&delta;t</mi> <mi>s</mi> </msub> <mo>=</mo> <msup> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mrow>

对其使用Taylor展开并进行一阶化线性化截断,忽略剩下的高阶项,从而使伪距测量方程线性化求解:Δρ(M)=H·ΔX

和分别为k和k-1时刻全球导航卫星系统接收机4相对卫星M的伪距,ΔX=Xk-Xk-1,Xk和Xk-1分别为k和k-1时刻全球导航卫星系统接收机4的位置;

(2)第二次对误差进行消除:

经过第一次误差消除,易得:

<mrow> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>=</mo> <msup> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <mo>|</mo> <mo>|</mo> <msup> <mi>X</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <mi>X</mi> <mo>|</mo> <mo>|</mo> <mo>-</mo> <msub> <mi>&delta;t</mi> <mi>s</mi> </msub> </mrow>

为了研究方便,假设测量误差符合独立分布的条件,并且符合正态分布:

<mrow> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>~</mo> <mi>N</mi> <mrow> <mo>(</mo> <mn>0</mn> <mo>,</mo> <msup> <mrow> <mo>(</mo> <msubsup> <mi>&sigma;</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>)</mo> </mrow> </mrow>

式中,为标准差,M为可见星的个数,令:

<mrow> <mfrac> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <msup> <mi>w</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mfrac> <mo>~</mo> <mi>N</mi> <mrow> <mo>(</mo> <mn>0</mn> <mo>,</mo> <msubsup> <mi>&sigma;</mi> <mn>0</mn> <mn>2</mn> </msubsup> <mo>)</mo> </mrow> </mrow>

w(M)为每个测量值对应的权重,σ0为标准差,ΔX通过下式求解:

<mrow> <mfrac> <mn>1</mn> <msup> <mi>w</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mfrac> <msup> <mi>&Delta;&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>=</mo> <mfrac> <mn>1</mn> <msup> <mi>w</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mfrac> <mi>H</mi> <mo>&CenterDot;</mo> <mi>&Delta;</mi> <mi>X</mi> </mrow>

每一个输出测量值ρ(M)对应一个权重w(M),并希望权重w(M)倒数越大的值在解算中作用越大,若ρ(M)测量误差越小,w(M)应越小;

其中,影响伪距测量精度的因素包括:与GPS卫星本身有关的误差E1、与全球导航卫星系统接收机4有关的误差E2、与卫星信号强度有关的误差E3、包括地球潮汐在内其它误差E4

其中,E1通过导航电文中测距精度因子N提供给用户,

E1越小时,测量误差越小,这满足加权算法中对权重因子的选择要求;

E2由全球导航卫星系统接收机4本身预测和实际测量值得到的,每次测量误差都会得到与该测量误差相关的一组误差值,这样就每次测量都可以得到与之对应的测量误差的标准差σ(M)

w(M)=σ(M)

以该标准差作为权重因子;

E3用载噪比表示,采用SIGMA-ε模型进行误差衡量,

<mrow> <msup> <mrow> <mo>(</mo> <msup> <mi>&sigma;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>=</mo> <mi>a</mi> <mo>+</mo> <mi>b</mi> <mo>&CenterDot;</mo> <msup> <mn>10</mn> <mrow> <mo>(</mo> <mo>-</mo> <mfrac> <mi>C</mi> <msub> <mi>N</mi> <mrow> <mn>0</mn> <mo>,</mo> <mi>i</mi> </mrow> </msub> </mfrac> <mo>)</mo> <mo>/</mo> <mn>10</mn> </mrow> </msup> </mrow>

a、b为模型参数,N0,i为测量的载噪比,当载噪比越大时,测量误差也就越小,满足了加权算法中对权重因子的选择要求;

E4以地球潮汐为例,潮汐引起测站位移,位移越小,引起的误差越小,符合权重因子选取要求;

设E1、E2、E3、E4的权重因子分别为对其进行重新加权,得到:

<mrow> <msubsup> <mi>w</mi> <mrow> <mi>a</mi> <mi>d</mi> <mi>d</mi> </mrow> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>=</mo> <msub> <mi>a</mi> <mn>1</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>+</mo> <msub> <mi>a</mi> <mn>2</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>+</mo> <msub> <mi>a</mi> <mn>3</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>+</mo> <msub> <mi>a</mi> <mn>4</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>4</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> </mrow>

其中,系数j=1,2,3,4;

(3)确定误差消减后的定位误差:

确定两次误差消减对定位精度的影响因子分别为Q1和Q2,综合影响因子:

Q=Q1×Q2

定位精度用距离均方根(DRMS)表示,误差消减前后定位误差存在如下关系:

DRMSh=Q×DRMSq

DRMSq和DRMSh分别表示误差消减前后定位误差。

本优选实施例通过对卫星伪距测量过程中的系统误差进行消除,提高了全球导航卫星系统接收机4的灵敏度,进一步提高了卫星伪距的测量精度,从而提高了定位精度。

优选的,所述位置解算粗差消除单元45以计算机和滤波器为载体,包括依次连接的预处理子单元、位置解算子单元、粗差判断及消除子单元和滤波子单元;所述预处理子单元用于对所述消除系统误差后的卫星伪距测量数据进行预处理,剔除数据异常的卫星;所述位置解算子单元用于根据预处理后的卫星伪距测量数据,采用最小二乘法和初始权矩阵进行初始化的定位求解;所述粗差判断及消除子单元用于判断位置解算子单元输出的定位求解结果是否存在粗差,若存在粗差,剔除出现粗差的故障卫星,若不存在粗差,采用最小二乘法及新的权矩阵进行迭代计算,直到定位位置的增量小于预设的足够小的阀值T2时终止迭代,从而确定优选的卫星,进而得到并输出定位结果;所述滤波子单元用于对所述定位结果采用卡尔曼滤波进行滤波计算,并输出最终的定位结果;

其中,所述采用最小二乘法和初始权矩阵进行初始化的定位求解,包括:获取卫星伪距测量误差方程的系数阵和常数项,根据卫星高度角获取所述初始权矩阵;根据最小二乘法进行定位求解;

其中,所述判断位置解算子单元输出的定位求解结果是否存在粗差,包括:根据卫星的数目和相应的纳伪概率和弃真概率进行粗差检验,对检验的粗差,根据卫星伪距测量误差方程和初始化矩阵计算出新矩阵,计算新矩阵各向量之间的距离,采用K-means聚类方法对所述各向量之间的距离进行聚类分析,判断向量之间的亲疏关系,从而完成粗差识别。

本优选实施例将最小二乘法、迭代运算、聚类方法和滤波计算相结合,提高卫星优选和定位的精度,在消除伪距测量误差后、迭代运算之前进行是否存在粗差的判断,并隔离存在粗差的故障卫星,减小了计算量,进一步提高定位准确度。

在此应用场景中,设定阈值T1的取值为40mm,定位速度相对提高了13%,定位精度相对提高了13%。

应用场景4

参见图1、图2,本应用场景的一个实施例的定位性能良好的巡逻车,所述巡逻车上设置全球导航卫星系统增强定位系统,所述全球导航卫星系统增强定位系统包括设置于巡逻车上的依次连接的用户端1、定位服务器2、位置修正模块3以及与所述位置修正模块3通过网络传输模块连接的具有卫星定位增强功能的全球导航卫星系统接收机4;所述用户端1用于向定位服务器2发起定位请求;所述定位服务器2用于在接收定位请求后获取需定位车辆的普通卫星定位信号,并将所述需定位车辆的普通卫星定位信号发送到位置修正模块3;所述全球导航卫星系统接收机4,用于根据同一卫星天线同时接收自身的增强卫星定位信号和普通卫星定位信号,进行增强定位和位置解算处理,获取自身的高精度坐标,并将自身的高精度坐标与普通卫星定位信号之间的差分数据通过网络传输模块实时传输给所述位置修正模块3;所述位置修正模块3用于利用差分数据对所述需定位车辆的普通卫星定位信号进行修正,并根据修正后的普通卫星定位信号得到需定位车辆的高精度位置信息。

优选的,所述全球导航卫星系统接收机4设有用于接收自身的增强卫星定位信号的增强卫星定位信号接收单元41和用于接收自身普通卫星定位信号的普通卫星定位信号接收单元42。

本发明上述实施例仅需要增加一部具有卫星定位增强功能的全球导航卫星系统接收机4,即可有效提高多个不具有卫星定位增强功能的需定位车辆的定位精度,有效解决了高精度定位需求与低使用成本之间的矛盾,从而解决了上述的技术问题。

优选的,所述全球导航卫星系统增强定位系统还包括用于显示所述需定位车辆的高精度位置信息的位置显示模块5。

本优选实施例便于巡逻人员实时掌握巡逻车辆实时位置和巡查信息,促进所辖路段的安全畅通。

优选的,所述全球导航卫星系统接收机4还包括卫星伪距测量结果获取单元43、卫星测量伪距误差消除单元44、位置解算粗差消除单元45,所述卫星伪距测量结果获取单元43用于同时处理多颗卫星的伪距观测,获取卫星伪距测量数据;所述卫星测量伪距误差消除单元44用于消除卫星伪距测量过程中的系统误差;所述位置解算粗差消除单元45用于采用最小二乘法对消除系统误差后的卫星伪距测量数据进行位置解算,并在解算过程中进行粗差消除,最终获取所述高精度坐标。

本优选实施例构建了全球导航卫星系统接收机4的主要架构。

优选的,所述卫星伪距测量结果获取单元43采用的卫星伪距的测量计算公式为:

<mrow> <msup> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>=</mo> <msup> <mi>r</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>+</mo> <mi>c</mi> <mrow> <mo>(</mo> <msub> <mi>&delta;t</mi> <mi>s</mi> </msub> <mo>-</mo> <msup> <mi>&delta;t</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mo>+</mo> <mi>c</mi> <mrow> <mo>(</mo> <msup> <mi>Y</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mo>+</mo> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> </mrow>

式中,M=1,2,…,m为所有观测到卫星的临时编号,ρ(M)为每颗可见卫星的测量伪距,r(M)代表每颗卫星位置与全球导航卫星系统接收机4位置的几何距离,δts为全球导航卫星系统接收机4时钟与GPS时钟的钟差,δt(M)为每颗卫星与GPS时钟的钟差,Y(M)为信号延时误差,Y(M)=C(M)+D(M)+Z(M)+R(M),C(M)为每个卫星信号经过磁层的延时,D(M)为每个卫星信号经过电离层的延时,Z(M)为每个卫星信号经过中性层的延时,R(M)为地球自转效应的延时,为对每个卫星信号的伪距测量噪声;

其中,X为全球导航卫星系统接收机4的位置坐标向量,X(M)为卫星M的位置坐标向量。

本优选实施例提出了可见卫星的测量伪距的计算公式,在伪距的计算中考虑了各种延时误差,减少了初始定位的时间,减少了全球导航卫星系统接收机4的能量损耗,增加待机时间,提高了卫星伪距的测量精度。

优选的,所述消除卫星伪距测量过程中的系统误差包括:

(1)第一次对误差进行消除:

由于卫星轨道摄动,卫星在轨位置与真实位置会存在偏差p1,采取差分定位法进行消除,误差消减后偏差为p′1

由于存在时钟漂移和相对论效应,各个卫星时钟不可能与GPS时间严格同步,存在钟差p2,由卫星发布的导航电文进行消除,误差消减后偏差为p′2

由于各误差对定位精度影响不同,设定阈值T1,并引入误差评估因子P:

P=(p1-p′1)×(p2-p′2)

若P≤T1,则完成第一次的误差消除,否则,需继续进行第一次的误差消除;其中设定T1的取值范围为[30m,50m[;

除δts无法通过接收的可见星信息进行修正,可得:

<mrow> <msqrt> <mrow> <mo>(</mo> <msup> <mi>x</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <msub> <mi>x</mi> <mi>s</mi> </msub> <mo>)</mo> <mo>+</mo> <mo>(</mo> <msup> <mi>y</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <msub> <mi>y</mi> <mi>s</mi> </msub> <mo>)</mo> <mo>+</mo> <mo>(</mo> <msup> <mi>z</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <msub> <mi>z</mi> <mi>s</mi> </msub> <mo>)</mo> </mrow> </msqrt> <mo>+</mo> <msub> <mi>&delta;t</mi> <mi>s</mi> </msub> <mo>=</mo> <msup> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mrow>

对其使用Taylor展开并进行一阶化线性化截断,忽略剩下的高阶项,从而使伪距测量方程线性化求解:Δρ(M)=H·ΔX

和分别为k和k-1时刻全球导航卫星系统接收机4相对卫星M的伪距,ΔX=Xk-Xk-1,Xk和Xk-1分别为k和k-1时刻全球导航卫星系统接收机4的位置;

(2)第二次对误差进行消除:

经过第一次误差消除,易得:

<mrow> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>=</mo> <msup> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <mo>|</mo> <mo>|</mo> <msup> <mi>X</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <mi>X</mi> <mo>|</mo> <mo>|</mo> <mo>-</mo> <msub> <mi>&delta;t</mi> <mi>s</mi> </msub> </mrow>

为了研究方便,假设测量误差符合独立分布的条件,并且符合正态分布:

<mrow> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>~</mo> <mi>N</mi> <mrow> <mo>(</mo> <mn>0</mn> <mo>,</mo> <msup> <mrow> <mo>(</mo> <msubsup> <mi>&sigma;</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>)</mo> </mrow> </mrow>

式中,为标准差,M为可见星的个数,令:

<mrow> <mfrac> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <msup> <mi>w</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mfrac> <mo>~</mo> <mi>N</mi> <mrow> <mo>(</mo> <mn>0</mn> <mo>,</mo> <msubsup> <mi>&sigma;</mi> <mn>0</mn> <mn>2</mn> </msubsup> <mo>)</mo> </mrow> </mrow>

w(M)为每个测量值对应的权重,σ0为标准差,ΔX通过下式求解:

<mrow> <mfrac> <mn>1</mn> <msup> <mi>w</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mfrac> <msup> <mi>&Delta;&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>=</mo> <mfrac> <mn>1</mn> <msup> <mi>w</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mfrac> <mi>H</mi> <mo>&CenterDot;</mo> <mi>&Delta;</mi> <mi>X</mi> </mrow>

每一个输出测量值ρ(M)对应一个权重w(M),并希望权重w(M)倒数越大的值在解算中作用越大,若ρ(M)测量误差越小,w(M)应越小;

其中,影响伪距测量精度的因素包括:与GPS卫星本身有关的误差E1、与全球导航卫星系统接收机4有关的误差E2、与卫星信号强度有关的误差E3、包括地球潮汐在内其它误差E4

其中,E1通过导航电文中测距精度因子N提供给用户,

E1越小时,测量误差越小,这满足加权算法中对权重因子的选择要求;

E2由全球导航卫星系统接收机4本身预测和实际测量值得到的,每次测量误差都会得到与该测量误差相关的一组误差值,这样就每次测量都可以得到与之对应的测量误差的标准差σ(M)

w(M)=σ(M)

以该标准差作为权重因子;

E3用载噪比表示,采用SIGMA-ε模型进行误差衡量,

<mrow> <msup> <mrow> <mo>(</mo> <msup> <mi>&sigma;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>=</mo> <mi>a</mi> <mo>+</mo> <mi>b</mi> <mo>&CenterDot;</mo> <msup> <mn>10</mn> <mrow> <mo>(</mo> <mo>-</mo> <mfrac> <mi>C</mi> <msub> <mi>N</mi> <mrow> <mn>0</mn> <mo>,</mo> <mi>i</mi> </mrow> </msub> </mfrac> <mo>)</mo> <mo>/</mo> <mn>10</mn> </mrow> </msup> </mrow>

a、b为模型参数,N0,i为测量的载噪比,当载噪比越大时,测量误差也就越小,满足了加权算法中对权重因子的选择要求;

E4以地球潮汐为例,潮汐引起测站位移,位移越小,引起的误差越小,符合权重因子选取要求;

设E1、E2、E3、E4的权重因子分别为对其进行重新加权,得到:

<mrow> <msubsup> <mi>w</mi> <mrow> <mi>a</mi> <mi>d</mi> <mi>d</mi> </mrow> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>=</mo> <msub> <mi>a</mi> <mn>1</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>+</mo> <msub> <mi>a</mi> <mn>2</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>+</mo> <msub> <mi>a</mi> <mn>3</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>+</mo> <msub> <mi>a</mi> <mn>4</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>4</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> </mrow>

其中,系数j=1,2,3,4;

(3)确定误差消减后的定位误差:

确定两次误差消减对定位精度的影响因子分别为Q1和Q2,综合影响因子:

Q=Q1×Q2

定位精度用距离均方根(DRMS)表示,误差消减前后定位误差存在如下关系:

DRMSh=Q×DRMSq

DRMSq和DRMSh分别表示误差消减前后定位误差。

本优选实施例通过对卫星伪距测量过程中的系统误差进行消除,提高了全球导航卫星系统接收机4的灵敏度,进一步提高了卫星伪距的测量精度,从而提高了定位精度。

优选的,所述位置解算粗差消除单元45以计算机和滤波器为载体,包括依次连接的预处理子单元、位置解算子单元、粗差判断及消除子单元和滤波子单元;所述预处理子单元用于对所述消除系统误差后的卫星伪距测量数据进行预处理,剔除数据异常的卫星;所述位置解算子单元用于根据预处理后的卫星伪距测量数据,采用最小二乘法和初始权矩阵进行初始化的定位求解;所述粗差判断及消除子单元用于判断位置解算子单元输出的定位求解结果是否存在粗差,若存在粗差,剔除出现粗差的故障卫星,若不存在粗差,采用最小二乘法及新的权矩阵进行迭代计算,直到定位位置的增量小于预设的足够小的阀值T2时终止迭代,从而确定优选的卫星,进而得到并输出定位结果;所述滤波子单元用于对所述定位结果采用卡尔曼滤波进行滤波计算,并输出最终的定位结果;

其中,所述采用最小二乘法和初始权矩阵进行初始化的定位求解,包括:获取卫星伪距测量误差方程的系数阵和常数项,根据卫星高度角获取所述初始权矩阵;根据最小二乘法进行定位求解;

其中,所述判断位置解算子单元输出的定位求解结果是否存在粗差,包括:根据卫星的数目和相应的纳伪概率和弃真概率进行粗差检验,对检验的粗差,根据卫星伪距测量误差方程和初始化矩阵计算出新矩阵,计算新矩阵各向量之间的距离,采用K-means聚类方法对所述各向量之间的距离进行聚类分析,判断向量之间的亲疏关系,从而完成粗差识别。

本优选实施例将最小二乘法、迭代运算、聚类方法和滤波计算相结合,提高卫星优选和定位的精度,在消除伪距测量误差后、迭代运算之前进行是否存在粗差的判断,并隔离存在粗差的故障卫星,减小了计算量,进一步提高定位准确度。

在此应用场景中,设定阈值T1的取值为45mm,定位速度相对提高了14%,定位精度相对提高了15%。

应用场景5

参见图1、图2,本应用场景的一个实施例的定位性能良好的巡逻车,所述巡逻车上设置全球导航卫星系统增强定位系统,所述全球导航卫星系统增强定位系统包括设置于巡逻车上的依次连接的用户端1、定位服务器2、位置修正模块3以及与所述位置修正模块3通过网络传输模块连接的具有卫星定位增强功能的全球导航卫星系统接收机4;所述用户端1用于向定位服务器2发起定位请求;所述定位服务器2用于在接收定位请求后获取需定位车辆的普通卫星定位信号,并将所述需定位车辆的普通卫星定位信号发送到位置修正模块3;所述全球导航卫星系统接收机4,用于根据同一卫星天线同时接收自身的增强卫星定位信号和普通卫星定位信号,进行增强定位和位置解算处理,获取自身的高精度坐标,并将自身的高精度坐标与普通卫星定位信号之间的差分数据通过网络传输模块实时传输给所述位置修正模块3;所述位置修正模块3用于利用差分数据对所述需定位车辆的普通卫星定位信号进行修正,并根据修正后的普通卫星定位信号得到需定位车辆的高精度位置信息。

优选的,所述全球导航卫星系统接收机4设有用于接收自身的增强卫星定位信号的增强卫星定位信号接收单元41和用于接收自身普通卫星定位信号的普通卫星定位信号接收单元42。

本发明上述实施例仅需要增加一部具有卫星定位增强功能的全球导航卫星系统接收机4,即可有效提高多个不具有卫星定位增强功能的需定位车辆的定位精度,有效解决了高精度定位需求与低使用成本之间的矛盾,从而解决了上述的技术问题。

优选的,所述全球导航卫星系统增强定位系统还包括用于显示所述需定位车辆的高精度位置信息的位置显示模块5。

本优选实施例便于巡逻人员实时掌握巡逻车辆实时位置和巡查信息,促进所辖路段的安全畅通。

优选的,所述全球导航卫星系统接收机4还包括卫星伪距测量结果获取单元43、卫星测量伪距误差消除单元44、位置解算粗差消除单元45,所述卫星伪距测量结果获取单元43用于同时处理多颗卫星的伪距观测,获取卫星伪距测量数据;所述卫星测量伪距误差消除单元44用于消除卫星伪距测量过程中的系统误差;所述位置解算粗差消除单元45用于采用最小二乘法对消除系统误差后的卫星伪距测量数据进行位置解算,并在解算过程中进行粗差消除,最终获取所述高精度坐标。

本优选实施例构建了全球导航卫星系统接收机4的主要架构。

优选的,所述卫星伪距测量结果获取单元43采用的卫星伪距的测量计算公式为:

<mrow> <msup> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>=</mo> <msup> <mi>r</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>+</mo> <mi>c</mi> <mrow> <mo>(</mo> <msub> <mi>&delta;t</mi> <mi>s</mi> </msub> <mo>-</mo> <msup> <mi>&delta;t</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mo>+</mo> <mi>c</mi> <mrow> <mo>(</mo> <msup> <mi>Y</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mo>+</mo> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> </mrow>

式中,M=1,2,…,m为所有观测到卫星的临时编号,ρ(M)为每颗可见卫星的测量伪距,r(M)代表每颗卫星位置与全球导航卫星系统接收机4位置的几何距离,δts为全球导航卫星系统接收机4时钟与GPS时钟的钟差,δt(M)为每颗卫星与GPS时钟的钟差,Y(M)为信号延时误差,Y(M)=C(M)+D(M)+Z(M)+R(M),C(M)为每个卫星信号经过磁层的延时,D(M)为每个卫星信号经过电离层的延时,Z(M)为每个卫星信号经过中性层的延时,R(M)为地球自转效应的延时,为对每个卫星信号的伪距测量噪声;

其中,X为全球导航卫星系统接收机4的位置坐标向量,X(M)为卫星M的位置坐标向量。

本优选实施例提出了可见卫星的测量伪距的计算公式,在伪距的计算中考虑了各种延时误差,减少了初始定位的时间,减少了全球导航卫星系统接收机4的能量损耗,增加待机时间,提高了卫星伪距的测量精度。

优选的,所述消除卫星伪距测量过程中的系统误差包括:

(1)第一次对误差进行消除:

由于卫星轨道摄动,卫星在轨位置与真实位置会存在偏差p1,采取差分定位法进行消除,误差消减后偏差为p′1

由于存在时钟漂移和相对论效应,各个卫星时钟不可能与GPS时间严格同步,存在钟差p2,由卫星发布的导航电文进行消除,误差消减后偏差为p′2

由于各误差对定位精度影响不同,设定阈值T1,并引入误差评估因子P:

P=(p1-p′1)×(p2-p′2)

若P≤T1,则完成第一次的误差消除,否则,需继续进行第一次的误差消除;其中设定T1的取值范围为[30m,50m];

除δts无法通过接收的可见星信息进行修正,可得:

<mrow> <msqrt> <mrow> <mo>(</mo> <msup> <mi>x</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <msub> <mi>x</mi> <mi>s</mi> </msub> <mo>)</mo> <mo>+</mo> <mo>(</mo> <msup> <mi>y</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <msub> <mi>y</mi> <mi>s</mi> </msub> <mo>)</mo> <mo>+</mo> <mo>(</mo> <msup> <mi>z</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <msub> <mi>z</mi> <mi>s</mi> </msub> <mo>)</mo> </mrow> </msqrt> <mo>+</mo> <msub> <mi>&delta;t</mi> <mi>s</mi> </msub> <mo>=</mo> <msup> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mrow>

对其使用Taylor展开并进行一阶化线性化截断,忽略剩下的高阶项,从而使伪距测量方程线性化求解:Δρ(M)=H·ΔX

和分别为k和k-1时刻全球导航卫星系统接收机4相对卫星M的伪距,ΔX=Xk-Xk-1,Xk和Xk-1分别为k和k-1时刻全球导航卫星系统接收机4的位置;

(2)第二次对误差进行消除:

经过第一次误差消除,易得:

<mrow> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>=</mo> <msup> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <mo>|</mo> <mo>|</mo> <msup> <mi>X</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>-</mo> <mi>X</mi> <mo>|</mo> <mo>|</mo> <mo>-</mo> <msub> <mi>&delta;t</mi> <mi>s</mi> </msub> </mrow>

为了研究方便,假设测量误差符合独立分布的条件,并且符合正态分布:

<mrow> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>~</mo> <mi>N</mi> <mrow> <mo>(</mo> <mn>0</mn> <mo>,</mo> <msup> <mrow> <mo>(</mo> <msubsup> <mi>&sigma;</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>)</mo> </mrow> </mrow>

式中,为标准差,M为可见星的个数,令:

<mrow> <mfrac> <msubsup> <mi>n</mi> <mi>&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <msup> <mi>w</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mfrac> <mo>~</mo> <mi>N</mi> <mrow> <mo>(</mo> <mn>0</mn> <mo>,</mo> <msubsup> <mi>&sigma;</mi> <mn>0</mn> <mn>2</mn> </msubsup> <mo>)</mo> </mrow> </mrow>

w(M)为每个测量值对应的权重,σ0为标准差,ΔX通过下式求解:

<mrow> <mfrac> <mn>1</mn> <msup> <mi>w</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mfrac> <msup> <mi>&Delta;&rho;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>=</mo> <mfrac> <mn>1</mn> <msup> <mi>w</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> </mfrac> <mi>H</mi> <mo>&CenterDot;</mo> <mi>&Delta;</mi> <mi>X</mi> </mrow>

每一个输出测量值ρ(M)对应一个权重w(M),并希望权重w(M)倒数越大的值在解算中作用越大,若ρ(M)测量误差越小,w(M)应越小;

其中,影响伪距测量精度的因素包括:与GPS卫星本身有关的误差E1、与全球导航卫星系统接收机4有关的误差E2、与卫星信号强度有关的误差E3、包括地球潮汐在内其它误差E4

其中,E1通过导航电文中测距精度因子N提供给用户,

E1越小时,测量误差越小,这满足加权算法中对权重因子的选择要求;

E2由全球导航卫星系统接收机4本身预测和实际测量值得到的,每次测量误差都会得到与该测量误差相关的一组误差值,这样就每次测量都可以得到与之对应的测量误差的标准差σ(M)

w(M)=σ(M)

以该标准差作为权重因子;

E3用载噪比表示,采用SIGMA-ε模型进行误差衡量,

<mrow> <msup> <mrow> <mo>(</mo> <msup> <mi>&sigma;</mi> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>=</mo> <mi>a</mi> <mo>+</mo> <mi>b</mi> <mo>&CenterDot;</mo> <msup> <mn>10</mn> <mrow> <mo>(</mo> <mo>-</mo> <mfrac> <mi>C</mi> <msub> <mi>N</mi> <mrow> <mn>0</mn> <mo>,</mo> <mi>i</mi> </mrow> </msub> </mfrac> <mo>)</mo> <mo>/</mo> <mn>10</mn> </mrow> </msup> </mrow>

a、b为模型参数,N0,i为测量的载噪比,当载噪比越大时,测量误差也就越小,满足了加权算法中对权重因子的选择要求;

E4以地球潮汐为例,潮汐引起测站位移,位移越小,引起的误差越小,符合权重因子选取要求;

设E1、E2、E3、E4的权重因子分别为对其进行重新加权,得到:

<mrow> <msubsup> <mi>w</mi> <mrow> <mi>a</mi> <mi>d</mi> <mi>d</mi> </mrow> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>=</mo> <msub> <mi>a</mi> <mn>1</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>+</mo> <msub> <mi>a</mi> <mn>2</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>+</mo> <msub> <mi>a</mi> <mn>3</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> <mo>+</mo> <msub> <mi>a</mi> <mn>4</mn> </msub> <mo>&CenterDot;</mo> <msubsup> <mi>w</mi> <msub> <mi>E</mi> <mn>4</mn> </msub> <mrow> <mo>(</mo> <mi>M</mi> <mo>)</mo> </mrow> </msubsup> </mrow>

其中,系数j=1,2,3,4;

(3)确定误差消减后的定位误差:

确定两次误差消减对定位精度的影响因子分别为Q1和Q2,综合影响因子:

Q=Q1×Q2

定位精度用距离均方根(DRMS)表示,误差消减前后定位误差存在如下关系:

DRMSh=Q×DRMSq

DRMSq和DRMSh分别表示误差消减前后定位误差。

本优选实施例通过对卫星伪距测量过程中的系统误差进行消除,提高了全球导航卫星系统接收机4的灵敏度,进一步提高了卫星伪距的测量精度,从而提高了定位精度。

优选的,所述位置解算粗差消除单元45以计算机和滤波器为载体,包括依次连接的预处理子单元、位置解算子单元、粗差判断及消除子单元和滤波子单元;所述预处理子单元用于对所述消除系统误差后的卫星伪距测量数据进行预处理,剔除数据异常的卫星;所述位置解算子单元用于根据预处理后的卫星伪距测量数据,采用最小二乘法和初始权矩阵进行初始化的定位求解;所述粗差判断及消除子单元用于判断位置解算子单元输出的定位求解结果是否存在粗差,若存在粗差,剔除出现粗差的故障卫星,若不存在粗差,采用最小二乘法及新的权矩阵进行迭代计算,直到定位位置的增量小于预设的足够小的阀值T2时终止迭代,从而确定优选的卫星,进而得到并输出定位结果;所述滤波子单元用于对所述定位结果采用卡尔曼滤波进行滤波计算,并输出最终的定位结果;

其中,所述采用最小二乘法和初始权矩阵进行初始化的定位求解,包括:获取卫星伪距测量误差方程的系数阵和常数项,根据卫星高度角获取所述初始权矩阵;根据最小二乘法进行定位求解;

其中,所述判断位置解算子单元输出的定位求解结果是否存在粗差,包括:根据卫星的数目和相应的纳伪概率和弃真概率进行粗差检验,对检验的粗差,根据卫星伪距测量误差方程和初始化矩阵计算出新矩阵,计算新矩阵各向量之间的距离,采用K-means聚类方法对所述各向量之间的距离进行聚类分析,判断向量之间的亲疏关系,从而完成粗差识别。

本优选实施例将最小二乘法、迭代运算、聚类方法和滤波计算相结合,提高卫星优选和定位的精度,在消除伪距测量误差后、迭代运算之前进行是否存在粗差的判断,并隔离存在粗差的故障卫星,减小了计算量,进一步提高定位准确度。

在此应用场景中,设定阈值T1的取值为50mm,定位速度相对提高了15%,定位精度相对提高了16%。

最后应当说明的是,以上实施例仅用以说明本发明的技术方案,而非对本发明保护范围的限制,尽管参照较佳实施例对本发明作了详细地说明,本领域的普通技术人员应当理解,可以对本发明的技术方案进行修改或者等同替换,而不脱离本发明技术方案的实质和范围。

当前第1页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1