CN108460210B - 一种基于噪残差和协方差匹配的动力定位系统噪声特性实时估计方法 - Google Patents
一种基于噪残差和协方差匹配的动力定位系统噪声特性实时估计方法 Download PDFInfo
- Publication number
- CN108460210B CN108460210B CN201810169650.7A CN201810169650A CN108460210B CN 108460210 B CN108460210 B CN 108460210B CN 201810169650 A CN201810169650 A CN 201810169650A CN 108460210 B CN108460210 B CN 108460210B
- Authority
- CN
- China
- Prior art keywords
- noise
- filtering
- covariance matrix
- estimation
- adaptive
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F2218/00—Aspects of pattern recognition specially adapted for signal processing
- G06F2218/02—Preprocessing
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Computer Hardware Design (AREA)
- Evolutionary Computation (AREA)
- Geometry (AREA)
- General Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Feedback Control In General (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
Description
技术领域
本发明涉及船舶动力定位控制领域,具体涉及一种基于噪残差和协方差匹配的动力定位系统噪声特性实时估计方法。
背景技术
船舶动力定位系统(Dynamic Positioning System,简称DPS)是“依赖自身的推进系统自动控制船舶航向和位置的系统”。由于动力定位系统定位成本不随水深增加而增加,对极深海域和恶劣海况均具有极强适应性,且定位能力强,故系统正越来越广泛地用于深海石油钻井平台、海洋考察船、半潜船、水下潜器、海洋补给/装卸船、海底电缆铺设、海上打捞救生以及军用舰船的定点、循迹、循线或跟踪控制上,已成为深海开发的关键技术。
动力定位船舶在工作过程中,会受到风、浪、流等环境干扰力的作用。其中,其中,风、流和二阶波浪力使船舶产生低频漂移,而一阶波浪力将使船舶产生与波浪振荡同频率的高频振荡运动。控制器在进行设计时,不需要对这些高频振荡运动做出响应,否则将造成推进器的频繁动作,加剧推进器磨损并造成不必要的能耗。因而需要通过滤波器将这些高频运动和测量信号中的噪声滤除。同时,通过状态估计给出船舶状态(位置、航向、速度、加速度等)的估计值。
动力定位系统常用的状态估计和滤波方法包括卡尔曼滤波、扩展卡尔曼滤波等。其中卡尔曼滤波只能用于线性系统,扩展卡尔曼滤波(Extended Kalman Filter,EKF)是常用的进行非线性状态估计和滤波的方法。但是EKF通过对非线性系统的Taylor展开式进行一阶截断,忽略高阶项进行线性化,截断误差将降低滤波精度,甚至使滤波发散。同时,进行线性化时需计算Jacobin矩阵,计算量大。因而,出现了无迹卡尔曼滤波(Unscented KalmanFilter,UKF)方法用于非线性系统状态估计,运用无迹变换对非线性概率密度分布进行近似,不需求导、估计精度高,现已广泛用于导航定位、信号处理、目标跟踪等领域。
船舶在动力定位过程中,海洋环境和运动状态的不断变化,使得系统的过程噪声和测量噪声统计特性都将发生变化,且很难准确表示。标准UKF滤波通过实验和试凑的方法来确定噪声协方差矩阵,往往效率低下,且作为常值设置在系统中,不能反映系统过程变化,从而影响UKF滤波精度和稳定性。因而需要通过自适应算法实时估计出航行过程中系统的过程和测量噪声特性。常见的自适应算法往往不能同时在线跟新系统的过程噪声和测量噪声特性,或者算法复杂、计算量大,影响工程应用。因而设计一种能同时反映过程和测量噪声变化,且要求算法简单,易于实现的自适应算法十分必要。
发明内容
本发明的目的是为解决以上问题,提供一种基于噪残差和协方差匹配的动力定位系统噪声特性实时估计方法,即基于无迹卡尔曼滤波(UKF),运用自适应算法实时在线估计系统过程噪声和测量噪声协方差矩阵,并进行船舶动力定位系统状态估计和滤波,从而获得较好的滤波精度和稳定性。
本发明的目的可以通过以下技术方案实现:
(1)利用自适应无迹卡尔曼滤波方法进行船舶动力定位系统的状态估计与滤波;
(2)R-adaptation:基于残差序列和开窗估计的自适应算法,在线实时估计出当前系统的测量噪声协方差矩阵Rk;
步骤(1)—(4)作为一个整体,构成了所提出的动力定位系统噪声特性实时估计方法。
步骤(1)按照UKF滤波过程进行状态估计和滤波,但与标准UKF滤波不同的是,计算过程中的过程噪声协方差矩阵Qk和测量噪声协方差矩阵Rk不再为常量,而是通过自适应算法,实时跟踪系统环境噪声变化,由其噪声特性实时估计和带入进行计算,即:
步骤(2)中基于残差序列和开窗估计的测量噪声协方差矩阵Rk自适应估计算法(R-adaptation)为:
自适应因子μk的计算方法为:
与现有技术相比,本发明采用UKF滤波,不需对系统模型进行线性化处理,相较于卡尔曼滤波和扩展卡尔曼滤波具有更好的状态估计和滤波效果。此外,在UKF滤波基础上引入自适应算法,对测量噪声和过程噪声协方差矩阵进行实时估计与更新。由于在对过程噪声协方差矩阵进行更新时,仅在检测到滤波发散时才进行,所以计算量小,且方法简单,易于工程实现。自适应算法的应用使动力定位系统在复杂海况与测试环境下,通过实时更新系统测量噪声协方差和过程噪声协方差矩阵,使系统跟踪环境变化,从而提高状态估计和滤波精度。
附图说明
图1为本发明的噪声特性实时估计流程图。
图2为船舶动力定位系统状态估计和控制系统原理图
图3为自适应UKF和UKF估计船位均方根误差比较曲线。
具体实施方式
下面结合附图和实施例对本发明做进一步描述。
一种基于噪残差和协方差匹配的动力定位系统噪声特性实时估计方法,即基于无迹卡尔曼滤波(UKF),运用自适应算法实时在线估计系统过程噪声和测量噪声协方差矩阵,并进行船舶动力定位系统状态估计和滤波,从而获得较好的滤波精度和稳定性。
如图1所示,本发明实施步骤如下:
(1)利用自适应无迹卡尔曼滤波方法进行船舶动力定位系统的状态估计与滤波;
(2)R-adaptation:基于残差序列和开窗估计的自适应算法,在线实时估计出当前系统的测量噪声协方差矩阵Rk;
步骤(1)—(4)作为一个整体,构成了所提出的动力定位系统噪声特性实时估计方法。
步骤(1)中按照UKF滤波过程进行状态估计和滤波,但与标准UKF滤波不同的是,计算过程中的过程噪声协方差矩阵Qk和测量噪声协方差矩阵Rk不再为常量,而是通过自适应算法,实时跟踪系统环境噪声变化,由其噪声特性实时估计和带入进行计算,过程为:
时间更新:
步骤(2)中基于残差序列和开窗估计的测量噪声协方差矩阵Rk自适应估计算法(R-adaptation)为:
自适应因子μk的计算方法为:
以下对本发明的实施例进行说明,应当理解,此处所描述的实施例仅用于说明和解释本发明,并不用于限定本发明。
为验证本发明所提出的一种基于噪残差和协方差匹配的动力定位系统噪声特性实时估计方法的可行性,建立了动力定位船舶状态估计和非线性PID控制闭环系统。如图2所示,船舶运动受到风、浪、流环境干扰力的影响,而使船舶偏离其设定船位。所设计自适应状态估计滤波器接收包含测量噪声的测量船位信号,通过所设计算法滤除测量噪声,以及海浪高频运动分量,仅将低频船位估计值输出作为控制器的输入。控制器根据估计船位和期望船位的偏差进行运算,得到所需控制力,并控制动力定位船舶运动,使其保持在设定船位上。
在Matlab中建立图2所示仿真分析模型,系统仿真时间设定为600s。为验证自适应UKF滤波器对系统噪声和测量噪声统计特性的在线估计性能,在初始的300s,船舶受到波浪干扰频率设为1.0rad/s,对应的三一波高为1.5m,浪级4级。之后的300s,波浪干扰频率设为0.55rad/s,对应的三一波高为5m,浪级6级,对应的测量噪声也变为初始200s时的2倍。
为验证所提自适应算法的优越性,将采用自适应UKF滤波和UKF滤波的状态估计结果进行了比较,图3为两者的估计船位均方根误差的比较曲线。图中虚线表示AUKF滤波均方根误差,实线表示UKF滤波均方根误差。
均方根误差(Root mean square error,RMSE)的定义为:
由图3可以看出,在仿真参数设定相同的情况下,UKF滤波由于在计算过程中不能对过程噪声和测量噪声进行实时校正,因而状态估计和滤波效果相较于自适应UKF滤波为差。当海浪状态发生突变时,采用UKF滤波时估计船位的均方根误差随之增大,说明UKF滤波没有对环境突变的自适应能力。反之,采用本发明的自适应算法进行状态估计时,由于能实时估计出系统的过程噪声和测量噪声协方差矩阵,即使海况发生突变,估计船位的均方根误差并没有发生大的改变,这证明了所发明的动力定位系统噪声特性实时估计算法可行,能提高UKF状态估计滤波的精度和稳定性。
Claims (2)
1.一种基于噪残差和协方差匹配的动力定位系统噪声特性实时估计方法,其特征在于,所述方法包含以下步骤:
(1)利用自适应无迹卡尔曼滤波方法进行船舶动力定位系统的状态估计与滤波;
(2)R-adaptation:基于残差序列和开窗估计的自适应算法,在线实时估计出当前系统的测量噪声协方差矩阵Rk;
运用基于残差和协方差匹配的自适应无迹卡尔曼滤波AUKF实时在线估计系统过程噪声和测量噪声特性,并进行船舶动力定位系统状态估计和滤波,计算过程中的过程噪声协方差矩阵和测量噪声协方差矩阵通过自适应算法进行实时估计,以实时跟踪系统环境噪声变化,并由其噪声特性实时估计和带入进行计算,即:
(2)定义:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810169650.7A CN108460210B (zh) | 2018-03-01 | 2018-03-01 | 一种基于噪残差和协方差匹配的动力定位系统噪声特性实时估计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810169650.7A CN108460210B (zh) | 2018-03-01 | 2018-03-01 | 一种基于噪残差和协方差匹配的动力定位系统噪声特性实时估计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108460210A CN108460210A (zh) | 2018-08-28 |
CN108460210B true CN108460210B (zh) | 2021-09-14 |
Family
ID=63216952
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810169650.7A Active CN108460210B (zh) | 2018-03-01 | 2018-03-01 | 一种基于噪残差和协方差匹配的动力定位系统噪声特性实时估计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108460210B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111044906B (zh) * | 2019-12-10 | 2022-11-15 | 深圳市鹏诚新能源科技有限公司 | 一种基于极大似然准则的锂离子电池能量状态估算方法 |
CN111025909B (zh) * | 2019-12-23 | 2023-02-14 | 哈尔滨工程大学 | 船舶运动控制系统的Kalman三自由度解耦滤波方法 |
CN112418051B (zh) * | 2020-11-18 | 2024-05-03 | 温州大学 | 一种用于非线性动态系统非高斯噪声下的状态估计方法 |
CN112671373B (zh) * | 2020-12-21 | 2024-04-26 | 北京科技大学 | 一种基于误差控制的卡尔曼滤波自适应滤波算法 |
CN117290670B (zh) * | 2023-11-27 | 2024-01-26 | 南京中鑫智电科技有限公司 | 一种基于增强滤波器算法的变压器套管绝缘状态估计方法 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105807767A (zh) * | 2016-03-04 | 2016-07-27 | 武汉理工大学 | 在动力定位中跟踪环境力突变的自适应滤波方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103838970B (zh) * | 2014-03-07 | 2016-09-14 | 武汉理工大学 | 面向深海船舶动力定位的高精度实时状态估计方法及系统 |
CN107742026A (zh) * | 2017-10-16 | 2018-02-27 | 江苏科技大学 | 一种船舶动力定位系统非线性状态估计方法 |
-
2018
- 2018-03-01 CN CN201810169650.7A patent/CN108460210B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105807767A (zh) * | 2016-03-04 | 2016-07-27 | 武汉理工大学 | 在动力定位中跟踪环境力突变的自适应滤波方法 |
Non-Patent Citations (3)
Title |
---|
Fault estimation of satellite reaction wheels using covariance based adaptive unscented Kalman filter;Afshin Rahimi等;《Acta Astronautica》;20170207;第160-162页 * |
基于新息和残差的自适应UKF算法;周卫东 等;《宇航学报》;20100731;第31卷(第7期);1798-1804 * |
改进的强跟踪UKF算法及其在INS_GPS组合导航中的应用;胡高歌等;《中国惯性技术学报》;20141031;第22卷(第5期);第635-637页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108460210A (zh) | 2018-08-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108460210B (zh) | 一种基于噪残差和协方差匹配的动力定位系统噪声特性实时估计方法 | |
CN107168312B (zh) | 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法 | |
Deng et al. | Adaptive unscented Kalman filter based estimation and filtering for dynamic positioning with model uncertainties | |
CN108427414B (zh) | 一种自主水下航行器水平面自适应轨迹跟踪控制方法 | |
CN108052009B (zh) | 基于滤波反步法的水面目标救援跟踪观测控制器设计方法 | |
CN108445762B (zh) | 基于ukf滤波和约束模型预测控制的动力定位控制方法 | |
CN109032136B (zh) | 基于主从分布式模型预测控制的欠驱动多无人船编队跟踪方法 | |
CN108388738A (zh) | 一种船舶动力定位系统噪声和状态实时估计自适应滤波方法 | |
Rigatos | Sensor fusion-based dynamic positioning of ships using Extended Kalman and Particle Filtering | |
CN103605886A (zh) | 一种船舶动力定位系统多模型自适应融合滤波方法 | |
CN104316025A (zh) | 一种基于船体姿态信息估计海浪浪高的系统 | |
CN110687793B (zh) | 一种基于输入增量的船舶动力定位系统非线性无偏预测控制方法 | |
CN113467231A (zh) | 基于侧滑补偿ilos制导律的无人艇路径跟踪方法 | |
CN102411657A (zh) | 自由航行状态下耙吸挖泥船动力定位的滤波器设计方法 | |
CN109521798A (zh) | 基于有限时间扩张状态观测器的auv运动控制方法 | |
CN111025909B (zh) | 船舶运动控制系统的Kalman三自由度解耦滤波方法 | |
Deng et al. | Adaptive observer based backstepping controller design for dynamic ship positioning | |
Liu | Pre-filtered backstepping control for underactuated ship path following | |
CN113608534A (zh) | 一种无人艇跟踪控制方法及系统 | |
CN110687795B (zh) | 一种基于目标计算的船舶动力定位系统非线性无偏预测控制方法 | |
CN105807767B (zh) | 在动力定位中跟踪环境力突变的自适应滤波方法 | |
CN114200966B (zh) | 一种基于感知信息的无人航行器目标定方位等距跟踪方法 | |
CN109782778A (zh) | 一种基于无模型自适应定深控制方法 | |
Xiao | Ship Dynamic Positioning Control Based on Nonlinear Fuzzy Algorithm for a Smart Port City | |
Hui et al. | Research on AUV Cooperative Positioning Technology Based on Improved-EKF with Error Estimation |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |