论文题名: | 基于MEMS-IMU的USV导航系统非线性滤波方法研究 |
关键词: | 无人水面艇;MEMS-IMU技术;导航系统;非线性滤波;鲁棒滤波;贝叶斯理论 |
摘要: | 导航系统是水面无人艇(USV)在各类复杂海况下,安全、自主、有效的完成不同类型作业任务的重要保障。USV相对较低的研发成本和有限的载荷能力,决定了其导航系统可配置的传感器需要在成本、重量、体积、功耗和精度等指标之间做权衡。微机电惯性传感器(MEMS-IMU)具有低成本、微重量、低功耗等特点,但是其精度相对较低。研究基于MEMS-IMU技术的INS/GNSS组合导航状态估计滤波方法对于低成本、低载荷、高导航精度要求的USV具有重要意义。对基于MEMS-IMU的USV导航系统状态估计,存在以下需要解决的问题:1.由于 MEMS-IMU相对较低的测量精度进一步加重了INS/GNSS紧耦合组合导航系统的非线性程度,需要针对具有强非线性特性的MEMS-IMU/GNSS导航系统设计更加有效的非线性状态估计算法;2.GNSS测量噪声统计通常无法精确已知,且存在野值等受污染情况,需要滤波算法实时对系统测量噪声统计特性做出反应,适时调节系统参数,保障滤波算法收敛;3.现有的状态估计方法大都是基于贝叶斯理论或其改进的滤波方法,结构复杂,形式单一,且其稳定性和收敛性的证明。需要寻求计算法复杂度低、运算效率高,且稳定性能够保障的状态估计方法。基于以上分析,本文主要研究工作有以下几个方面: 针对基于MEMS-IMU的INS/GNSS紧耦合组合导航系统的强非线性问题,提出一种基于贝叶斯估计理论的改进的混合粒子滤波算法框架。将贝叶斯后验状态估计作为粒子滤波采样的重要性概率密度函数,粒子无需重复使用,避免了粒子退化问题和粒子重采样过程,在保障了滤波精度的同时,有效减少同等精度下所需粒子个数。 针对INS/GNSS紧耦合组合导航系统测量噪声协方差统计特性存在不准确、突变等问题,提出一种基于残差序列的自适应无迹粒子滤波算法。通过仿真,验证了当GNSS伪距和伪距率测量噪声方差存在突变时,AUPF算法能够较为准确的跟踪噪声方差变化趋势,从而获得较高的滤波精度。 针对GNSS测量噪声协方差矩阵存在未知、时变、受扰动和污染等问题,基于变分贝叶斯估计理论和Huber鲁棒估计理论,提出一种变分贝叶斯鲁棒自适应无迹粒子滤波算法。通过逆Wishart分布近似逼近系统测量噪声协方差矩阵分布,推导出基于高斯分布假设条件下的变分贝叶斯自适应无迹卡尔曼滤波算法(VBAUKF)。考虑到GNSS测量值存在野值等受污染情况,将Huber估计与VBAUKF算法相结合,提出一种VBRAUKF算法,并结合本文所提出的的混合粒子滤波算法框架,提出了VBRAUPF算法。仿真结果表明,当系统测量噪声统计特性存在时变、受扰动或污染等情况时,VBRAUPF能够有效解决INS/GNSS紧耦合组合导航系统滤波发散问题,同时增强了系统的鲁棒性,具有较高的估计精度。 将 USV多传感器组合导航状态估计问题转换为非线性内反馈级联系统状态估计问题,提出了一种基于辅助虚拟高程测量的变增益非线性观测器。基于非线性观测器设计理论,由Riccati方程计算观测器增益矩阵,通过Lyapunov分析证明了所设计的观测器的稳定性。仿真结果表明,姿态观测器提供四元数姿态向量估计的同时,能够提供陀螺仪偏差估计;辅助虚拟高程测量的引入改善了 USV垂向的位置和速度估计精度。基于非线性观测器理论的估计方法,为 USV多传感器组合导航状态估计提供了一种新的解决思路。当 USV低速运行时,针对一阶波浪力引起的波频运动经控制回路反馈易对执行机构带来不必要耗损的问题,提出了一种不基于船舶动力学模型的自适应海浪滤波观测器。设计海浪遭遇频率估计算法,并基于该估计设计自适应陷波滤波器。由陷波滤波器的输出和导航系统非线性观测器输出重构USV水平方向低频运动状态量。 |
作者: | 王国庆 |
专业: | 控制理论与控制工程 |
导师: | 夏国清 |
授予学位: | 博士 |
授予学位单位: | 哈尔滨工程大学 |
学位年度: | 2017 |
正文语种: | 中文 |