基于KF/FIR和LS-SVM融合的INS/UWB组合导航算法及系统技术方案

本发明专利技术公开了基于KF/FIR和LS‑SVM融合的INS/UWB组合导航算法及系统，当UWB信号可用时，KF/FIR滤波器正常工作，为组合导航系统提供导航信息的最优预估。与此同时，LS‑SVM算法处于培训模式，将INS解算的位置信息与KF/FIR滤波器给出的INS位置误差的最优预估分别作为LS‑SVM算法的输入和培训目标，力求通过培训构造INS位置与位置误差的映射关系。一旦UWB信号不可用，LS‑SVM算法替代不能工作的KF/FIR滤波器，利用构建的映射关系对INS位置误差进行预估。本发明专利技术的提出，克服了传统KF/FIR滤波器在UWB失锁状态下不能正常工作的缺陷，实现了对导航信息的无缝预估。

INS/UWB Integrated Navigation Algorithms and Systems Based on KF/FIR and LS-SVM Fusion

The invention discloses an INS/UWB integrated navigation algorithm and system based on the fusion of KF/FIR and LS SVM. When the UWB signal is available, the KF/FIR filter works normally and provides the optimal prediction of navigation information for the integrated navigation system. At the same time, LS SVM algorithm is in the training mode. The location information of INS solution and the optimal estimation of INS position error given by KF/FIR filter are regarded as the input and training objective of LS SVM algorithm respectively, and the mapping relationship between INS position and position error is constructed through training. Once the UWB signal is unavailable, LS SVM algorithm replaces the KF/FIR filter which can not work. The position error of INS is estimated by using the mapping relationship constructed. The invention overcomes the defect that the traditional KF/FIR filter can not work normally when the UWB is unlocked, and achieves seamless prediction of navigation information.

【技术实现步骤摘要】
基于KF/FIR和LS-SVM融合的INS/UWB组合导航算法及系统
本专利技术涉及复杂环境下组合定位
，尤其涉及基于KF/FIR和LS-SVM融合的INS/UWB组合导航算法及系统。
技术介绍
近年来，行人导航(PedestrianNavigation,PN)作为导航技术应用的新兴领域，正越来越受到各国学者的重视，并逐渐成为该领域的研究热点。然而在隧道、大型仓库、地下停车场等室内环境下，外界无线电信号微弱、电磁干扰强烈等因素都会对目标行人导航信息获取的准确性、实时性及鲁棒性有很大影响。如何将室内环境下获取的有限信息进行有效的融合以消除室内复杂环境影响，保证行人导航精度的持续稳定，具有重要的科学理论意义和实际应用价值。在现有的定位方式中，全球卫星导航系统(GlobalNavigationSatelliteSystem,GNSS)是最为常用的一种方式。虽然GNSS能够通过精度持续稳定的位置信息，但是其易受电磁干扰、遮挡等外界环境影响的缺点限制了其应用范围，特别是在室内、地下巷道等一些密闭的、环境复杂的场景，GNSS信号被严重遮挡，无法进行有效的工作。近年来，UWB(UltraWideband)以其在复杂环境下定位精度高的特点在短距离局部定位领域表现出很大的潜力。学者们提出将基于UWB的目标跟踪应用于GNSS失效环境下的行人导航。这种方式虽然能够实现室内定位，但是由于室内环境复杂多变，UWB信号十分容易受到干扰而导致定位精度下降甚至失锁；与此同时，由于UWB采用的通信技术通常为短距离无线通信技术，因此若想完成大范围的室内目标跟踪定位，需要大量的网络节点共同完成，这必将引入网络组织结构优化设计、多节点多簇网络协同通信等一系列问题。因此现阶段基于UWB的目标跟踪在室内导航领域仍旧面临很多挑战。在导航模型方面，目前在室内行人组合导航领域应用较多的为松组合导航模型。该模型具有容易实现的优点，但是需要指出的是，该模型的实现需要参与组合导航的多种技术能够独立的完成导航定位。例如，需要UWB设备能够提供行人的导航信息，这就要求目标行人所处的环境必须能够获取至少3个参考节点信息，这大大的降低了组合导航模型的应用范围，与此同时，参与导航的子技术独立完成定位，也引入了新的误差，不利于组合导航技术精度的提高。为了克服这一问题，学者们提出将紧组合模型应用于室内行人导航领域，紧组合模型直接将参与组合导航的子技术的原始传感器数据应用于最后的导航信息的解算，减少了子技术自行解算引入新误差的风险，提高了组合导航的精度，但是需要指出的是，现有紧组合导航模型均使用集中式模式，这一方式系统容错能力差，并不利于日益精确复杂的组合导航模型。
技术实现思路
本专利技术的目的就是为了解决上述难题，提供了一种基于KF/FIR和LS-SVM融合的INS/UWB组合导航算法及系统。当UWB信号可用时，KF/FIR滤波器正常工作，为组合导航系统提供导航信息的最优预估。与此同时，LS-SVM算法处于培训模式，将INS解算的位置信息与KF/FIR滤波器给出的INS位置误差的最优预估分别作为LS-SVM算法的输入和培训目标，力求通过培训构造INS位置与位置误差的映射关系。一旦UWB信号不可用，LS-SVM算法替代不能工作的KF/FIR滤波器，利用构建的映射关系对INS位置误差进行预估。本专利技术的提出，克服了传统KF/FIR滤波器在UWB失锁状态下不能正常工作的缺陷，实现了对导航信息的无缝预估。为实现上述目的，本专利技术的具体方案如下：本专利技术的第一目的是公开一种基于KF/FIR和LS-SVM融合的INS/UWB组合导航算法，包括：以惯性导航器件IMU的误差向量和各UWB参考节点的东向和北向位置作为状态量，以惯性导航器件IMU测量得到的目标行人的东向和北向位置之差作为系统观测量构建INS/UWB松组合导航模型；当UWB信号可用时，KF/FIR滤波器正常工作，为组合导航系统提供导航信息的最优预估，同时，将INS解算的位置信息与KF/FIR滤波器给出的INS位置误差的最优预估分别作为LS-SVM算法的输入和培训目标，通过培训构造INS位置与位置误差的映射关系；一旦UWB信号不可用，利用INS位置与位置误差的映射关系对INS位置误差进行预估，并对INS的解算误差进行补偿，最终得到当前时刻的行人最优的位置信息。进一步地，所述惯性导航器件IMU固定在目标行人足部，UWB参考节点预先布置在位置已知的导航环境中，UWB目标节点固定在目标行人身上。进一步地，惯性导航器件IMU的误差向量和各UWB参考节点的东向和北向位置的初值根据实际需要自行设定。进一步地，所述KF/FIR滤波器的状态方程为：其中，分别为k时刻和k-1时刻INS测量得到的导航坐标系下目标行人的东向和北向两个个方向的速度误差；分别为k时刻和k-1时刻导航坐标系下目标行人的东向和北向两个个方向的位置误差；ωk为状态噪声；T为采样周期。进一步地，所述KF/FIR滤波器的观测方程为：其中，为k时刻惯性器件IMU解算的东向和北向位置；为k时刻UWB解算的东向和北向位置；为k时刻INS测量得到的导航坐标系下目标行人的东向和北向两个个方向的速度误差；为k时刻导航坐标系下目标行人的东向和北向两个个方向的位置误差；vk为观测噪声；为k时刻INS东向位置误差的观测值、为k时刻INS北向位置误差的观测值。进一步地，所述KF/FIR滤波器中KF算法的性能评估方法为：计算信道质量评价指标Dk，判断Dk与门限door的关系，如果Dk<door，则信道质量正常，反之，则信道质量差，引入FIR滤波器。本专利技术的第二目的是公开一种基于KF/FIR和LS-SVM融合的INS/UWB组合导航系统，包括：服务器，所述服务器包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，所述处理器执行所述程序时实现以下步骤：以惯性导航器件IMU的误差向量和各UWB参考节点的东向和北向位置作为状态量，以惯性导航器件IMU测量得到的目标行人的东向和北向位置之差作为系统观测量构建INS/UWB松组合导航模型；当UWB信号可用时，KF/FIR滤波器正常工作，为组合导航系统提供导航信息的最优预估，同时，将INS解算的位置信息与KF/FIR滤波器给出的INS位置误差的最优预估分别作为LS-SVM算法的输入和培训目标，通过培训构造INS位置与位置误差的映射关系；一旦UWB信号不可用，利用INS位置与位置误差的映射关系对INS位置误差进行预估，并对INS的解算误差进行补偿，最终得到当前时刻的行人最优的位置信息。本专利技术的第三目的是公开一种计算机可读存储介质，其上存储有计算机程序，该程序被处理器执行时执行以下步骤：以惯性导航器件IMU的误差向量和各UWB参考节点的东向和北向位置作为状态量，以惯性导航器件IMU测量得到的目标行人的东向和北向位置之差作为系统观测量构建INS/UWB松组合导航模型；当UWB信号可用时，KF/FIR滤波器正常工作，为组合导航系统提供导航信息的最优预估，同时，将INS解算的位置信息与KF/FIR滤波器给出的INS位置误差的最优预估分别作为LS-SVM算法的输入和培训目标，通过培训构造INS位置与位置误差的映射关系；一旦UWB信号不可用，利用INS位本文档来自技高网...

【技术保护点】
1.基于KF/FIR和LS‑SVM融合的INS/UWB组合导航算法，其特征在于，包括：以惯性导航器件IMU的误差向量和各UWB参考节点的东向和北向位置作为状态量，以惯性导航器件IMU测量得到的目标行人的东向和北向位置之差作为系统观测量构建INS/UWB松组合导航模型；当UWB信号可用时，KF/FIR滤波器正常工作，为组合导航系统提供导航信息的最优预估，同时，将INS解算的位置信息与KF/FIR滤波器给出的INS位置误差的最优预估分别作为LS‑SVM算法的输入和培训目标，通过培训构造INS位置与位置误差的映射关系；一旦UWB信号不可用，利用INS位置与位置误差的映射关系对INS位置误差进行预估，并对INS的解算误差进行补偿，最终得到当前时刻的行人最优的位置信息。

【技术特征摘要】
1.基于KF/FIR和LS-SVM融合的INS/UWB组合导航算法，其特征在于，包括：以惯性导航器件IMU的误差向量和各UWB参考节点的东向和北向位置作为状态量，以惯性导航器件IMU测量得到的目标行人的东向和北向位置之差作为系统观测量构建INS/UWB松组合导航模型；当UWB信号可用时，KF/FIR滤波器正常工作，为组合导航系统提供导航信息的最优预估，同时，将INS解算的位置信息与KF/FIR滤波器给出的INS位置误差的最优预估分别作为LS-SVM算法的输入和培训目标，通过培训构造INS位置与位置误差的映射关系；一旦UWB信号不可用，利用INS位置与位置误差的映射关系对INS位置误差进行预估，并对INS的解算误差进行补偿，最终得到当前时刻的行人最优的位置信息。2.如权利要求1所述的基于KF/FIR和LS-SVM融合的INS/UWB组合导航算法，其特征在于，所述惯性导航器件IMU固定在目标行人足部，UWB参考节点预先布置在位置已知的导航环境中，UWB目标节点固定在目标行人身上。3.如权利要求1所述的基于KF/FIR和LS-SVM融合的INS/UWB组合导航算法，其特征在于，惯性导航器件IMU的误差向量和各UWB参考节点的东向和北向位置的初值根据实际需要自行设定。4.如权利要求1所述的基于KF/FIR和LS-SVM融合的INS/UWB组合导航算法，其特征在于，所述KF/FIR滤波器的状态方程为：其中，分别为k时刻和k-1时刻INS测量得到的导航坐标系下目标行人的东向和北向两个个方向的速度误差；分别为k时刻和k-1时刻导航坐标系下目标行人的东向和北向两个个方向的位置误差；ωk为状态噪声；T为采样周期。5.如权利要求1所述的基于KF/FIR和LS-SVM融合的INS/UWB组合导航算法，其特征在于，所述KF/FIR滤波器的观测方程为：其中，为k时刻惯性器件IMU解算的东向和北向位置；为k时刻UWB解算的东向和北向位置；为k时刻INS测量得到的导航坐标系下目标行人的东向和北向两个个方向的速度误差；为k时刻导航坐标系下目标行人的东向和北向两个个方向的位置误差；vk为观测噪声；为k时刻INS...

【专利技术属性】
技术研发人员：徐元，李岳炀，赵钦君，冯宁，刘统乾，
申请(专利权)人：济南大学，
类型：发明
国别省市：山东,37