一种基于噪声矩阵实时修正的船舶动力定位方法技术

本发明专利技术涉及一种基于噪声矩阵实时修正的船舶动力定位方法，包括：由综合位置测量系统测量船舶本身位置信号，并通过基于噪声矩阵实时修正的卡尔曼数字滤波器滤去上述信号中的噪声信号，并分离出船舶的高、低频信号，并将低频信号传输给控制系统；环境测量传感器系统测量船舶所处环境的参数，将测得的环境参数信号传输给控制系统；控制系统根据滤波后的低频信号及部分环境信号计算船舶定位控制信号；推力分配器将计算出的船舶定位控制信号分配给推力系统的各推力器；各推力器根据船舶定位控制信号，将船舶推动至预期的位置。本发明专利技术通过实时计算系统噪声，将计算结果应用于修正噪声序列的方差，使动力定位系统在复杂海况下，仍能保持较好的定位精度。

【技术实现步骤摘要】

本专利技术涉及船舶动力定位技术，特别是涉及一种基于噪声矩阵实时修正的船舶动 力定位方法。
技术介绍
动力定位Dynamic Positioning是指海上作业系统比如轮船、深海钻井平台等系 统利用其本身具有的动力来克服风、波浪、海流等外部环境干扰，从而使之能够保持在一定 的位置和方向上，更进一步说明是指不借助锚泊系统的作用，而用精密先进的仪器来测定 海上作业系统因为风、浪、流作用而发生的位移和方向变化，同时通过计算机等自动控制系 统对信息进行处理和计算并自动控制若干个不同方向的推进器的推力或力矩使得海上作 业系统回复到设定位置。此外，如果将定位点以一定速度沿预定轨迹运动，也可实现航迹保 持。与普通依靠舵实线航迹保持相比，动力定位具有横向运动的能力，从而为实现更高精度 的航迹保持提供了可能性，随着人类对海洋的开发、探索，动力定位技术显得越来越重要。在动力定位中，需要进行位置和速度的测量，对于位置的测量，一般分为方位和角 度。其中，角度的测量，在动力定位系统中通常采用电罗经，而方位的测量通常采用卫星导 航系统(GPS)，速率陀螺仪用于测量角速度、横荡速度和纵荡速度(1)电罗经，又称陀螺罗经，它能自动、连续地提供舰船的航向信号，并通过航向 发送装置将航向信号传递到舰船需要航向信号的各个部位，从而满足舰船导航和定位的要 求，是舰船必不可少的精密导航设备，被称为舰船的“眼睛”。全套设备由主罗经、分罗经和 附属仪器三部分组成，核心部件是主罗经内的陀螺球。电罗经受到其机械结构和工作环境 等的影响，不可避免的存在误差，需要进行滤波。(2)卫星导航系统有两种商用的卫星导航系统，美国的Navstar GPS系统和俄罗 斯的GL0NASS系统。GPS定位是利用一组卫星的伪距、星历、卫星发射时间等观测量来实现 的，同时还必须知道用户时钟差。因此，要获得地面点的三维坐标，必须对4颗卫星进行测 量。在这一定位过程中，存在着三部分误差。一部分是对每一个用户接收机所公有的，例 如，卫星钟误差、星历误差、电离层误差、对流层误差等；第二部分为不能由用户测量或由校 正模型来计算的传播延迟误差；第三部分为各用户接收机所固有的误差，例如内部噪声、通 道延迟、多径效应等。利用差分GPS定位技术(DGPS)，除第三部分误差无法消除外，第一部分误差完全 可以消除，第二部分误差大部分可以消除，其主要取决于基准接收机和用户接收机的距离。 差分GPS定位已将卫星钟误差和星历误差消除，并将电离层延迟和对流层延迟误差部分消 除，定位精度大大提高。所以，差分GPS定位技术(DGPS)在最近几年中得到了迅速发展和 广泛应用。根据差分GPS基准站发送的信息方式可将差分GPS定位技术(DGPS)分为三类， 即位置差分、伪距差分和相位差分。这三类差分方式的工作原理是相同的，即都是由基准 站发送改正数，由用户站接收并对其测量结果进行改正，以获得精确的定位结果。所不同的是，发送改正数的具体内容不一样，其差分定位精度也不同。(3)速率陀螺仪。用以直接测定运载器角速率的二自由度陀螺装置。把均衡陀螺 仪的外环固定在运载器上并令内环轴垂直于要测量角速率的轴。当运载器连同外环以角速 度绕测量轴旋进时，陀螺力矩将迫使内环连同转子一起相对运载器旋进。陀螺仪中有弹簧 限制这个相对旋进，而内环的旋进角正比于弹簧的变形量。由平衡时的内环旋进角即可求 得陀螺力矩和运载器的角速率。它在远距离测量系统或自动控制、惯性导航平台中使用较多ο由于差分GPS和速率陀螺仪同样存在误差，需要进行滤波处理。卡尔曼滤波是卡尔曼在1960年提出的从被提取信号有关的观测量中通过算法估 计出所需要信号的一种滤波算法。把状态空间的概念引入到随机估计理论中，把信号过程 视为白噪声作用下的一个线性系统的输出，用状态空间来描述这种输入一输出关系，估计 过程中利用系统状态方程，观测方程和白噪声激励的统计特性形成滤波算法，由于所用的 信息都是时域内的量，所以不但可以对平稳的一维随机过程进行估计，也可以对非平稳的、 多维随机过程进行估计。卡尔曼滤波作为一种重要的最优估计理论被广泛应用到实际工程中，比如惯性导 航、制导系统、全球定位系统、目标跟踪、通信和信号过程、金融，电机等。卡尔曼滤波设计方法简单易行，随着其广泛的应用，也暴露出一些问题，尤其是应 用到某些具体领域。如它必须在数字计算机上运行，随着微型计算机尤其是嵌入式芯片的 普及，人们对卡尔满滤波数值的稳定性、计算效率、实用性和有效性的要求也越来越高。由 于计算机的字长有限，使计算机舍入误差和截断误差累积、传递，造成误差方差阵失去对称 正定性，数值不稳定。在卡尔曼滤波的发展中，针对这个问题提出了平方根滤波、UD分解 滤波、奇异值分解滤波等一系列数值鲁棒的滤波算法。又如传统的卡尔曼滤波是建立在模 型精确和随机干扰信号统计特性已知的基础上。对于一个实际系统，往往存在着模型不确 定或干扰信号统计特性不完全已知，这些不确定因素使得传统的卡尔曼滤波算法失去最优 性，估计精度大大降低，严重时会引起滤波发散。为此，人们将鲁棒控制的思想引入到滤波 中，形成了鲁棒滤波理论。在进行动力定位系统的相关研究中，针对动力定位中实时位置采样普遍采用的卡 尔曼滤波进行较为细致的研究。发现在传统的卡尔曼滤波算法中，一般将系统噪声均看作 高斯白噪声。由于白噪声信号的方差恒定，故卡尔曼滤波算法中的系统噪声矩阵Q可作为 常数矩阵处理。这样做的优点，是使得系统进行卡尔曼滤波迭代时的计算更简便。通常，可 以根据海试实验资料选择相应的初值。但上述做法也存在较大的问题，当实际海况比较复 杂、系统未知扰动较大时，将系统噪声矩阵Q作为常数矩阵处理，将严重影响卡尔曼滤波的 精度。另外，受到海试实验的局限性影响，给定的初始Q矩阵的值可能存在较大误差，将影 响卡尔曼滤波的精度和快速性。
技术实现思路
本专利技术所要解决的技术问题就是为了克服上述现有技术存在的缺陷而提供一种 基于噪声矩阵实时修正的船舶动力定位方法。本专利技术的目的可以通过以下技术方案来实现一种基于噪声矩阵实时修正的船舶4动力定位方法，其特征在于，包括以下步骤由综合位置测量系统测量船舶本身位置信号，并通过基于噪声矩阵实时修正的卡 尔曼数字滤波器滤去上述信号中的噪声信号，并分离出船舶位置和姿态的高、低频信号，并 将低频信号传输给控制系统；由环境测量传感器系统测量船舶所处环境的参数，将测得的环境参数信号传输给 控制系统；控制系统根据滤波后的低频信号及环境信号计算船舶定位控制信号；推力分配器将计算出的船舶定位控制信号分配给推力系统的各推力器；各推力器根据船舶定位控制信号，将船舶推动至预期的位置。所述的综合位置测量系统包括处理器、用于测量艏摇角度的电罗经、用于测量横 荡位置和纵荡位置的差分卫星导航系统(GPS)以及用于测量角速度、横荡速度和纵荡速度 的速率陀螺仪，所述的电罗经、差分GPS以及速率陀螺仪均与处理器连接，该处理器采用基 于噪声矩阵实时修正的卡尔曼数字滤波器进行滤波。所述的基于噪声矩阵实时修正的卡尔曼数字滤波器通过以下步骤进行滤波(1)给定初始值f(0),P(0)；(2) x{k\k-\) = Jx{k-\) + BU(3) m{k-\) = (HE-ψ)+ ，通过更新 本文档来自技高网...

【技术保护点】
一种基于噪声矩阵实时修正的船舶动力定位方法，其特征在于，包括以下步骤：由综合位置测量系统测量船舶本身位置信号，并通过基于噪声矩阵实时修正的卡尔曼数字滤波器滤去上述信号中的噪声信号，并分离出船舶位置与姿态的高、低频信号，并将低频信号传输给控制系统；由环境测量传感器系统测量船舶所处环境的参数，将测得的环境参数信号传输给控制系统；控制系统根据滤波后的低频信号及环境信号计算船舶定位控制信号；推力分配器将计算出的船舶定位控制信号分配给推力系统的各推力器；各推力器根据船舶定位控制信号，将船舶推动至预期的位置。

【技术特征摘要】

【专利技术属性】
技术研发人员：陈启军，赵霞，姜威，
申请(专利权)人：同济大学，
类型：发明
国别省市：31[中国|上海]