[发明专利]基于改进的联邦滤波的水下AUV传感器时间配准方法

说明书

本发明公开一种基于改进的联邦滤波的水下AUV传感器时间配准方法，包括：S1、构建测距声纳的测距模型，获得声纳数据；S2、获取配准周期内姿态传感器数据，作为第一姿态数据，对所述第一姿态数据进行预处理，获得处理后的配准周期内姿态传感器数据，作为第二姿态数据，对所述第二姿态数据进行滤波处理，同时对所述第二姿态数据和所述声纳数据进行融合修正处理，获得i个子滤波器数据；S3、对所述i个子滤波器数据进行最优融合估计处理获得子滤波的误差协方差矩阵，对所述误差协方差矩阵进行更新，完成水下AUV传感器时间配准。本申请降低了噪声干扰，提高了准确度。

技术领域

本发明涉及建筑结构裂缝检测领域，特别是涉及一种基于改进的联邦滤波的水下AUV传感器时间配准方法。

背景技术

近几十年来，随着海洋石油开发工程、水库大坝工程、港口码头以及桥梁工程的不断深入和发展，形成了一系列水下开发结构物的新模式。混凝土作为目前用量最大的一种建筑材料，现已被广泛应用在这些工程中。然而混凝土结构在长期服役过程中，都面临着耐久性不良的严重问题，尤其是处于水下的部分，由于外部环境(如风浪、腐蚀、水力冲刷以及温度应力等)的侵扰、材料性能的改变以及施工条件的限制等诸多因素的影响，不可避免的会产生不同类型的缺陷。其中，裂缝是影响结构耐久性最为严重和普遍的病害之一。传统对水面下坝体的检测只是依靠潜水员携带部分便携式检测仪器进行检测，不仅工作效率低，甚至威胁工作人员的生命安全。

随着水下机器人技术的快速发展，可利用水下机器人作为载体，搭载水下摄像机和超声纵波检测装置，对水下混凝土建筑结构裂缝进行检测。检测过程中要求水下机器人距离水下混泥土结构物壁面一定距离稳定运行，常用测距声纳实现这一功能，由于机器人的姿态信息对测距声纳的量测距离有很大的影响，需要结合姿态信息对声纳数据进行修正。由于声纳与姿态传感器的采样频率不一样，使用姿态数据对声纳数据进行修正前，势必要进行传感器的时间配准，目前常用的时间配准方法有泰勒展开修正法、最小二乘法、内插外插发、最大熵准则法等。其中泰勒展开法要求采样的间隔必须相等，且算法存在近似计算，配准精度不高；最小二乘法则对多传感器数据进行虚拟融合，但是采样点必须严格的对应，起始采样点必须相同且配准精度较低；运用最大熵准则和最小均方估计进行时间配准时对量测信号的统计特性和不同量测之间相关度有要求，并且精度较低。

本发明针对现有的时间配准算法存在的配准精度低、只能在限定条件下使用，且抗干扰能力弱等不足，提出一种基于改进的联邦滤波的水下AUV传感器时间配准方法。

发明内容

本发明的目的是提供一种基于改进的联邦滤波的水下AUV传感器时间配准方法，以解决上述现有技术存在的问题，使提高配准精度、增强抗干扰能力。

为实现上述目的，本发明提供了如下方案：本发明提供一种基于改进的联邦滤波的水下AUV传感器时间配准方法，具体包括步骤为，

S1、构建测距声纳的测距模型，获得声纳数据；

S2、获取配准周期内姿态传感器数据，作为第一姿态数据，对所述第一姿态数据进行预处理，获得处理后的配准周期内姿态传感器数据，作为第二姿态数据，对所述第二姿态数据进行滤波处理，同时对所述第二姿态数据和所述声纳数据进行融合修正处理，获得i个子滤波器数据；

S3、对所述i个子滤波器数据进行最优融合估计处理获得子滤波的误差协方差矩阵，对所述误差协方差矩阵进行更新，完成水下AUV传感器时间配准。

可选地，构建测距声纳的测距模型过程为：

构建AUV运动方程；

式中，AUV前向运动速度为V，AUV沿着结构物壁面运动，x_k、y_k为AUV在k时刻中心点的位置信息，α为AUV的艏向角度与结构物壁面的夹角，θ为AUV的横摇角度；