一种鲁棒自适应因子图智能铁鞋导航系统和算法技术方案

本发明专利技术公开了一种鲁棒自适应因子图智能铁鞋导航系统和算法，鲁棒自适应因子图算法选取Sage

【技术实现步骤摘要】
一种鲁棒自适应因子图智能铁鞋导航系统和算法


[0001]本专利技术属于智能铁鞋定位领域，尤其是一种鲁棒自适应因子图智能铁鞋导航系统系统和算法。

技术介绍

[0002]随着我国在铁路交通领域的蓬勃发展，铁路行业将重心放在确保列车在铁路站场拥有安全的工作环境。在整个铁路工作环境中，列车在完成进站操作后发生频率较高的列车事故之一就是列车溜逸事故。溜逸事故的定义是铁路列车在铁路轨道上停置时，站场的工作人员未能及时进行防溜逸作业操作或者未能严格遵守安全规章的流程要求来进行防溜逸作业操作，导致防溜逸作业不合格，列车受到本身重力或外力发生列车顺铁路轨道滑动甚至导致多列车溜出轨道、发生碰撞等严重安全事故。
[0003]防溜铁鞋是一种固定车轮的制动装置，需要将其抵靠于铁路轨道的车轮旁，防止发生列车溜逸。我国制定的《铁路技术管理规程》中有明文说明：停靠在铁路轨道上的列车，如果不进行作业，必须要采用铁鞋等防溜设备加固稳定。铁路站场的列车制动人员在获取了防溜作业的委派时，采取在铁路作业规定轨道进行防溜铁鞋放置，防止溜逸事故发生在站场铁路轨道上停置的列车上。在传统的防溜铁鞋作业过程中，大量采用人工操作的方式来对铁鞋进行放置、撤出、巡检、维护等操作，随着铁路交通市场的繁荣，列车防溜作业的工作量急剧加大，铁路站场工作人员使用人工操作放置维护铁鞋进行防溜作业需要承担的人力资源成本随之不断提高，与此同时铁鞋缺少实时的数字化、信息化管理，无法对防溜逸工作中的全部铁鞋进行全天候、精准的实时监控，如果发生人工放置铁鞋漏放、放置姿态不合规等疏漏，就很有可能造成列车发生溜逸、脱轨、带鞋开车等安全事故，严重威胁了铁路站场的安全工作环境。因此可知，传统的防溜铁鞋已经无法担任列车防溜作业的任务。
[0004]对传统铁鞋进行智能化改造，已经成为现代化铁路站点的迫切需要，其中最关键的就是对铁鞋的位置进行精准的实时监控。只有做到实时的铁鞋导航定位，才能保证防溜逸系统的正常运行。在智能铁鞋的导航定位系统中，仅使用单独的导航系统会受限于该系统自身的应用能力，若是组合多种类型不同的导航系统，不同的系统可以互相填充各自的弱势领域，采用滤波的方式把不同的导航系统的输出数据信息融合，来达到提升整个智能铁鞋导航定位系统的精度的目的。
[0005]前期，我们提出“一种基于因子图消元优化的多传感器融合智能铁鞋定位系统和算法”(申请号202310082400.0)提供了多个不同传感器的信息融合算法，实现了导航系统的热插拔性。但是，单独的信息融合算法，并不能抵抗由传感器受到干扰产生的误差。
[0006]主流因子图系统导航算法在对量测噪声的设定中往往采用固定设定，即假定量测噪声不变，同时各个传感器的权重分配固定。但在铁路站场工作环境下，障碍物遮挡信号、附近车厢干扰信号源以及传感装置自身改变等多种不可预见状况皆可导致测量噪声偏离初始状态，在某些干扰严重时甚至大幅降低导航精度。因此，初始时刻设定的参数已经不再适合当前时刻的导航系统。目前基于因子图的多传感器导航系统未考虑未知情况下传感器
状态变化以及量测信息变化的系统鲁棒性。

技术实现思路

[0007]本专利技术针对
技术介绍
中存在的问题，提出了一种鲁棒自适应因子图智能铁鞋导航系统和算法。
[0008]技术方案：
[0009]本专利技术首先公开了一种鲁棒自适应因子图智能铁鞋导航系统，该系统包括定位卫星、智能铁鞋及监控上位机：
[0010]所述的智能铁鞋包括智能铁鞋监测器MCU、惯性导航器IMU、GPS接收机、多普勒导航系统DNS、无线电高度表RA、自适应滤波模块及铁鞋本体；
[0011]所述的定位卫星与GPS接收器建立通信，将铁鞋本体定位信号发送至GPS接收器；
[0012]所述的惯性导航器IMU包括陀螺仪传感器和加速度传感器，采集铁鞋本体角加速度和加速度数据，采集加速度和角加速度，并进行捷联数据解算，得到更新的位置信息，将信息发送至智能铁鞋监测器；
[0013]所述的GPS接收机由GPS接收机天线单元、GPS接收机主机单元和电源三部组成；接收定位卫星发送的铁鞋本体定位信号，以计算得到自身定位信息，将信息发送至智能铁鞋；
[0014]所述的多普勒导航系统DNS由多普勒雷达和陀螺组成；通过多普勒导航雷达采集载体的多普勒频移数据来解算载体的速度，通过陀螺采集载体的姿态信息；
[0015]所述的无线电高度表RA向地面发射无线电信号，接收从地面反射而来的无线电波，根据反射电波信息解算载体的高度；
[0016]所述的自适应滤波模块包括可观测度分析模块和可信度计算模块，通过可信度分析自适应调整各个导航因子的权重，从而显著提高系统的稳定性。
[0017]所述的智能铁鞋监测器MCU汇集来自惯性导航器IMU、GPS接收器、多普勒导航系统DNS和无线电高度表RA的信息，基于鲁棒自适应因子图的智能铁鞋导航系统算法，构建智能铁鞋系统的因子图模型，将模型数据导入基于因子图消元优化的信息融合算法中，计算获得最终铁鞋本体位置数据信息，并将定位数据发送至监控上位机；
[0018]所述的监控上位机接收来自智能铁鞋的定位信息。
[0019]本专利技术还公开了一种鲁棒自适应因子图智能铁鞋导航系统算法，基于所述的系统，所述的鲁棒自适应因子图智能铁鞋导航系统算法步骤分为：捷联惯性基导航因子构建、可观测度分析、可信度计算、自适应因子构建，具体流程如下：
[0020]步骤1：捷联惯性基导航因子构建
[0021]系统以惯性导航器IMU为核心，GPS、多普勒导航系统DNS和无线电高度表RA为辅助传感器，通过自适应卡尔曼滤波算法，将各个辅助传感器与核心传感器构成导航因子，对各个辅助传感器的量测噪声方差矩阵进行实时的自适应更新；
[0022]步骤2：可观测度分析
[0023]为了确定导航系统的量测信息质量，引入了一种基于可观测性分析的方法，对系统量化分析，用于数值评估外部辅助传感器的性能和每个时间时刻的导航误差状态的可估计性；
[0024]步骤3：可信度计算
[0025]利用上节所述的可观测度分析方法，实现对智能防溜铁鞋全源导航系统中导航因子信号可信度的计算；
[0026]步骤4：自适应因子构建
[0027]根据导航系统的可信度原理，在导航因子中引入可信度，设计了自适应导航因子，重新加入导航系统中；将模型数据导入基于因子图消元优化的信息融合算法中，计算获得最终铁鞋本体位置数据信息。
[0028]具体的，将各个辅助传感器与核心传感器构成导航因子，其步骤如下：
[0029]1‑
1)设组合导航系统的数学形式有：
[0030][0031]式中，X
k
表示系统在t
k
时刻的状态变量，Z
k
表示t
k
时刻的量测信息，Φ
k,k
‑1表示t
k
‑1到t
k
时刻的转移矩阵，H
k
表示本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种鲁棒自适应因子图智能铁鞋导航系统，其特征在于，该系统包括定位卫星、智能铁鞋及监控上位机：所述的智能铁鞋包括智能铁鞋监测器MCU、惯性导航器IMU、GPS接收机、多普勒导航系统DNS、无线电高度表RA、自适应滤波模块及铁鞋本体；所述的定位卫星与GPS接收器建立通信，将铁鞋本体定位信号发送至GPS接收器；所述的惯性导航器IMU包括陀螺仪传感器和加速度传感器，采集铁鞋本体角加速度和加速度数据，采集加速度和角加速度，并进行捷联数据解算，得到更新的位置信息，将信息发送至智能铁鞋监测器；所述的GPS接收机由GPS接收机天线单元、GPS接收机主机单元和电源三部组成；接收定位卫星发送的铁鞋本体定位信号，以计算得到自身定位信息，将信息发送至智能铁鞋；所述的多普勒导航系统DNS由多普勒雷达和陀螺组成；通过多普勒导航雷达采集载体的多普勒频移数据来解算载体的速度，通过陀螺采集载体的姿态信息；所述的无线电高度表RA向地面发射无线电信号，接收从地面反射而来的无线电波，根据反射电波信息解算载体的高度；所述的自适应滤波模块包括可观测度分析模块和可信度计算模块，通过可信度分析自适应调整各个导航因子的权重，从而显著提高系统的稳定性。所述的智能铁鞋监测器MCU汇集来自惯性导航器IMU、GPS接收器、多普勒导航系统DNS和无线电高度表RA的信息，基于鲁棒自适应因子图的智能铁鞋导航系统算法，构建智能铁鞋系统的因子图模型，将模型数据导入基于因子图消元优化的信息融合算法中，计算获得最终铁鞋本体位置数据信息，并将定位数据发送至监控上位机；所述的监控上位机接收来自智能铁鞋的定位信息。2.一种鲁棒自适应因子图智能铁鞋导航系统算法，基于权利要求1所述的系统，其特征在于，所述的鲁棒自适应因子图智能铁鞋导航系统算法步骤分为：捷联惯性基导航因子构建、可观测度分析、可信度计算、自适应因子构建，具体流程如下：步骤1：捷联惯性基导航因子构建系统以惯性导航器IMU为核心，GPS、多普勒导航系统DNS和无线电高度表RA为辅助传感器，通过自适应卡尔曼滤波算法，将各个辅助传感器与核心传感器构成导航因子，对各个辅助传感器的量测噪声方差矩阵进行实时的自适应更新；步骤2：可观测度分析为了确定导航系统的量测信息质量，引入了一种基于可观测性分析的方法，对系统量化分析，用于数值评估外部辅助传感器的性能和每个时间时刻的导航误差状态的可估计性；步骤3：可信度计算利用上节所述的可观测度分析方法，实现对智能防溜铁鞋全源导航系统中导航因子信号可信度的计算；步骤4：自适应因子构建根据导航系统的可信度原理，在导航因子中引入可信度，设计了自适应导航因子，重新加入导航系统中；将模型数据导入基于因子图消元优化的信息融合算法中，计算获得最终铁鞋本体位置数据信息。
3.根据权利要求2所述的方法，其特征在于，将各个辅助传感器与核心传感器构成导航因子，其步骤如下：1
‑
1)设组合导航系统的数学形式有：式中，X
k
表示系统在t
k
时刻的状态变量，Z
k
表示t
k
时刻的量测信息，Φ
k,k
‑1表示t
k
‑1到t
k
时刻的转移矩阵，H
k
表示量测函数矩阵，Γ
k
‑1表示系统噪声驱动矩阵，V
k
代表量测噪声，W
k
‑1时系统激励噪声；其中系统噪声和量测噪声互不影响，且二者均值为零；令Q
k
表示系统噪声方差矩阵，且该矩阵是非负定的矩阵，令R
k
表示量测噪声方差矩阵，且该矩阵是正定矩阵；1
‑
2)根据步骤1
‑
1所设系统的数学形式进行一步状态预测有：其中，表示t
k
‑1到t
k
时刻的一步状态预测，表示t
k
‑1时刻的状态估计，t
k
时刻的状态估计状态估计其中，滤波增益K
k
：或一步预测均方误差：其中，P
k/k
‑1表示表示t
k
‑1到t
k
时刻的一步预测均方误差，P

【专利技术属性】
技术研发人员：叶彦斐，胡龙癸，侯翔一，程立，徐涛，张勇气，陈天石，
申请(专利权)人：南京富岛信息工程有限公司，
类型：发明
国别省市：