基于公交车的城市GNSS脆弱性监测系统及其方法与流程

本发明涉及的是一种交通运输领域的技术，具体是一种基于公交车的城市gnss脆弱性监测系统及其方法。

背景技术：

全球卫星导航系统(gnss)能全球、全天候、实时地提供定位、测速和授时等服务。在高楼林立、树木茂密、电磁辐射污染较严重的城市区域中，gnss信号很容易受到遮挡、多径、干扰等影响，使城市gnss导航的脆弱性大大提高。gnss脆弱性监测是监测gnss系统内外因素对gnss服务性能的不利影响，其结果可指示gnss服务性能受不利影响的程度。为了提高城市gnss应用的性能和可靠性，有必要监测、掌握城市gnss脆弱性。而现在对城市gnss导航的监测主要是基于设立的少数固定监测站点，相关科学研究也是通过专用实验车辆对城市少数特定的街道进行gnss导航数据的采样与分析，都存在覆盖面小、采样样本数有限、实时性不足等缺点，无法对城市gnss脆弱性进行实时、全面的监测。

技术实现要素：

本发明针对现有技术或没有考虑和分析gnss脆弱性的影响、或没有结合地图信息和里程计对惯性导航进行反馈校正，导致其在卫星导航及其差分定位被欺骗或不可用时，将导致系统输出的定位结果出现严重偏差或随惯性导航误差的累积而发散等缺陷，提出一种基于公交车的城市gnss脆弱性监测系统及其方法。

本发明是通过以下技术方案实现的：

本发明涉及一种基于公交车的城市gnss脆弱性监测系统，包括：惯性导航模块、gnss导航模块、地图匹配导航模块、组合导航分析模块、gnss脆弱性分析模块和网络通信模块，其中：gnss导航模块测得公交车位置gnss导航坐标[lg，λg，hg]，当地东北天地理坐标系oxeynzu中gnss导航速度和伪距伪距率惯性导航模块采集公交车的加速度信息和角速度信息通过捷联惯性导航算法得到惯性导航坐标[lins，λins，hins]和惯性导航速度地图匹配导航模块采集行车信息后通过地图匹配算法得到地图匹配导航坐标[lodon，λodon，hodon]和公交车本体坐标系oxbybzb中地图匹配导航速度组合导航分析模块接收惯性导航模块、gnss导航模块和地图匹配导航模块的坐标和速度等得到公交车的估计坐标[lfinal，λfinal，hfinal]和估计速度gnss脆弱性分析模块根据估计坐标[lfinal，λfinal，hfinal]和估计速度计算gnss脆弱性参数并通过网络通信模块传送到监测中心。

所述的地图匹配算法是指采集公交车与设置于公交车运行路线中识别点k之间的距离和速度比照公交车在电子地图中运行路线获得地图匹配导航坐标[lodon，λodon，hodon]和地图匹配导航速度

所述的识别点分别设置于公交车站台、道路转弯处和道路陡坡处。

所述的距离通过公式进行校正，速度通过公式进行校正。

所述的组合导航分析模块首先对惯性导航坐标[lins，λins，hins]、惯性导航速度地图匹配导航坐标[lodon，λodon，hodon]和地图匹配导航速度进行松组合导航滤波，对gnss伪距伪距率惯性导航坐标[lins，λins，hins]和惯性导航速度进行紧组合导航滤波，再经联邦滤波得到估计坐标[lfinal，λfinal，hfinal]和估计速度

所述的松组合导航滤波的观测方程为：

，和分别为惯性导航航向角和根据磁强计输出估计的航向角，δl，δλ，δh(纬度误差、经度误差、高度误差)、δve，δvn，δvu(坐标系oxeynzu下的速度误差)、φe，φn，φu(姿态误差)为组合导航滤波状态量中包含的惯性导航误差状态。

所述的gnss脆弱性参数包括伪距误差方差、gnss信号功率、载噪比、dop值、定位误差方差。

所述的伪距误差方差其中：ρfinal为通过估计坐标[lfinal，λfinal，hfinal]计算的第i颗gnss卫星的伪距值。

本发明涉及一种基于上述系统的公交车的城市gnss脆弱性监测方法，包括以下步骤：

1)测量公交车位置gnss导航坐标[lg，λg，hg]和坐标系oxeynzu中gnss导航速度和伪距伪距率

2)采集公交车的加速度信息和角速度信息通过捷联惯性导航算法得到惯性导航坐标[lins，λins，hins]和惯性导航速度

3)通过地图匹配算法得到公交车的地图匹配导航坐标[lodon，λodon，hodon]和地图匹配导航速度

4)对惯性导航坐标[lins，λins，hins]、惯性导航速度地图匹配导航坐标[lodon，λodon，hodon]和地图匹配导航速度进行松组合导航滤波，对gnss伪距伪距率惯性导航坐标[lins，λins，hins]和惯性导航速度进行紧组合导航滤波，再经联邦滤波得到估计坐标[lfinal，λfinal，hfinal]和估计速度

5)计算gnss脆弱性参数并通过网络通信模块传送到监测中心。

技术效果

与现有技术相比，本发明能充分利用城市公交车这一大众交通工具及其车载设备，实施成本低，采集的数据实时性好、样本数量多、覆盖范围广，能得到可靠、准确、实时的统计分析结果，充分结合公交车的行车特点，利用里程计和电子地图进行特征点匹配和航位推测导航，即使在gnss导航不可用、受到干扰或欺骗时，也能保证系统有效地进行导航，从而实现连续的监测，更加准确地计算出公交车经受的gnss脆弱性。

附图说明

图1为本发明系统示意图；

图2为实施例坐标示意图；

图3为实施例实现场景示意图。

具体实施方式

如图1所示，本实施例中的基于公交车的城市gnss脆弱性监测系统，包括：惯性导航模块、gnss导航模块、地图匹配导航模块、组合导航分析模块、gnss脆弱性分析模块和网络通信模块，其中：gnss导航模块测得公交车位置gnss导航坐标[lg，λg，hg]和坐标系oxeynzu中gnss导航速度和伪距伪距率惯性导航模块采集公交车的加速度信息和角速度信息通过捷联惯性导航算法得到惯性导航坐标[lins，λins，hins]和惯性导航速度地图匹配导航模块采集行车信息后通过地图匹配算法得到地图匹配导航坐标[lodon，λodon，hodon]和地图匹配导航速度组合导航分析模块接收惯性导航模块、gnss导航模块和地图匹配导航模块的坐标和速度等得到公交车的估计坐标[lfinal，λfinal，hfinal]和估计速度gnss脆弱性分析模块根据估计坐标[lfinal，λfinal，hfinal]和估计速度计算gnss脆弱性参数并通过网络通信模块传送到监测中心。

所述的公交车上设有mems传感器，加速度计输出陀螺仪输出磁强计输出磁北角ψmag。mems传感器三轴方向与公交车本体坐标系oxbybzb三轴方向平行，oxb轴指向公交车正前方，ozb轴指向公交车上方，oyb轴与oxb轴、ozb轴形成右手直角坐标系。根据公交车的行车信息即里程计和车门开关状态量，可以得到车辆航向角的变化量车辆行驶距离的变化量实时车速车辆航向角为在当地东北天地理坐标系oxeynzu中的xeyn平面内，公交车轴线oxb的投影与oyn轴的夹角，北偏东为正，坐标系原点o为mems传感器中心位置。

所述的gnss导航模块接收gnss信号，解算得到gnss导航坐标[lg，λg，hg]和坐标系oxeynzu中gnss导航速度和伪距伪距率

所述的惯性导航模块接收mems传感器的加速度信息和角速度信息运行捷联惯性导航算法获得公交车惯性导航坐标[lins，λins，hins]和坐标系oxeynzu中的惯性导航速度以及姿态信息。姿态信息包括俯仰角滚动角和车辆航向角

所述的地图匹配导航模块采集行车信息后通过地图匹配算法得到地图匹配导航坐标[lodon，λodon，hodon]和地图匹配导航速度所述的地图匹配算法是指采集公交车与设置于公交车运行路线中识别点k之间的距离和速度比照公交车在电子地图中运行路线获得地图匹配导航坐标[lodon，λodon，hodon]和地图匹配导航速度

在公交车的运行线路上依次设置识别点，并编号为识别点设置于公交站台、道路转弯处或道路陡坡处。公交车行驶在特征点pk-1与pk之间时，因为公交车的行车线路固定，且线路上各点的坐标值已知，根据可知公交车相对于特征点pk-1在其行车线路上已行驶的距离，结合公交车电子地图可得到公交车在其行车线路上的位置，得到地图匹配导航坐标[lodon，λodon，hodon]和地图匹配导航速度为公交车从识别点pk-1开始的里程计的累加之和。

所述的距离通过公式进行校正，速度通过公式进行校正。k^odo为里程计输出的误差因子，和为噪声量，主要为道路路面平整度、车轮滑行和打滑等对的影响，公交车里程计车速，sk和为对应的无误差理想值。

所述的组合导航分析模块首先对惯性导航坐标[lins，λins，hins]、惯性导航速度地图匹配导航坐标[lodon，λodon，hodon]和地图匹配导航速度进行松组合导航滤波，对gnss伪距伪距率惯性导航坐标[lins，λins，hins]和惯性导航速度进行紧组合导航滤波，再经联邦滤波得到估计坐标[lfinal，λfinal，λfinal]和估计速度

所述的松组合导航滤波观测方程为：

，其中：rm为当地子午圈曲率半径，rn为当地卯酉圈曲率半径，ωloose为测量噪声，c＝{cij}，i，j＝1，2，3为公交车本体坐标系oxbybzb至坐标系oxeynzu的转换矩阵。再经kalman滤波器进行滤波，得到惯性导航模块和地图匹配导航模块的松组合导航滤波结果。

如图2所示，所述的mems传感器中心位置取为坐标系oxbybzb与坐标系oxeynzu的坐标原点，其中为公交车所在道路的前行方向在坐标平面xeyn的投影与oyn轴的夹角，坐标轴oyn绕ozu轴旋转后与该投影重合，为公交车所在道路与坐标平面xeyn平面的夹角。当公交车行驶在识别点之间时，可认为公交车行的行车方向与行车道路保持一致，此时，地图匹配导航模块得到的公交车速度估计值在坐标系oxbybzb中可表示为其估计的公交车位置误差及里程计输出的车速误差体现在公交车行车线路方向上分别为和对于里程计，k^odo一般是一个较小的量，当k^odo被不断估计和校正后，其残差δk^odo可被认为是一个小量，里程计输出的位置误差和车速误差可分别表示为和

所述的紧组合导航滤波的观测值为和未接收到各gnss导航卫星的伪距校正量时，观测值为：和其中：为基于惯性导航结果计算的第i颗gnss卫星的伪距值，为基于惯性导航结果计算的第i颗gnss卫星的伪距率值。假定第i颗gnss卫星的高度角为且相对于坐标系oxbybzb中oxb轴的方位角，指向oxb轴为0°，顺时钟为正，为观测值和的测量方差设定为其中为公交车运营线路的电子地图中对应于该位置处第i颗gnss卫星的脆弱性信息中的伪距误差方差。

经过松组合导航滤波和紧组合导航滤波，再通过联邦滤波最终得到估计坐标[lfinal，λfinal，hfinal]和估计速度

所述的gnss脆弱性分析模块根据估计坐标[lfinal，λfinal，hfinal]和估计速度对gnss脆弱性参数进行分析。gnss脆弱性参数包括伪距误差方差、gnss信号功率、载噪比、dop值、定位误差方差、定位异常率和可用性。

所述的伪距误差方差其中：ρfinal为通过估计坐标[lfinal，λfinal，hfinal]计算的第i颗gnss卫星的伪距值。定位误差为elλh＝[lg，λg，hg]^t-[lfinal，λfinal，hfinal]^t。对于信号功率、载噪比和dop值可通过相应公式得到。用新得到的gnss脆弱性参数测量值和α滤波器对gnss脆弱性参数进行更新。gnss定位的可用性定义为该位置处gnss定位误差小于一定阀值的定位次数占总定位次数的比率，定位异常率定义为该位置处gnss定位误差大于一定阀值的定位次数占总定位次数的比率。

本实施例涉及一种基于公交车的城市gnss脆弱性监测方法，包括以下步骤：

1)测量公交车位置gnss导航坐标[lg，λg，hg]和坐标系oxeynzu中gnss导航速度和伪距伪距率

2)采集公交车的加速度信息和角速度信息通过捷联惯性导航算法得到惯性导航坐标[lins，λins，hins]和惯性导航速度

3)通过地图匹配算法得到公交车的地图匹配导航坐标[lodon，λodon，hodon]和地图匹配导航速度

4)对惯性导航坐标[lins，λins，hins]、惯性导航速度地图匹配导航坐标[lodon，λodon，hodon]和地图匹配导航速度进行松组合导航滤波，对gnss伪距伪距率惯性导航坐标[lins，λins，hins]和惯性导航速度进行紧组合导航滤波，再经联邦滤波得到估计坐标[lfinal，λfinal，hfinal]和估计速度

5)计算gnss脆弱性参数并通过网络通信模块传送到分析监测中心。

如图3所示，分析监测中心根据接收到各公交车的组合导航定位结果、gnss脆弱性监测信息和存储数据后综合分析得到整个城市的gnss脆弱性，并向用户发布gnss脆弱性监测信息。

与现有技术相比，本发明能充分利用城市公交车这一大众交通工具及其车载设备，实施成本低，采集的数据实时性好、样本数量多、覆盖范围广，能得到可靠、准确、实时的统计分析结果，充分结合公交车的行车特点，利用里程计和电子地图进行特征点匹配和航位推测导航，即使在gnss导航不可用、受到干扰或欺骗时，也能保证系统有效地进行导航，从而实现连续的监测，更加准确地计算出公交车经受的gnss脆弱性。

上述具体实施可由本领域技术人员在不背离本发明原理和宗旨的前提下以不同的方式对其进行局部调整，本发明的保护范围以权利要求书为准且不由上述具体实施所限，在其范围内的各个实现方案均受本发明之约束。