Radar Target Tracking for Unmanned Surface Vehicle Based on Square Root Sage–Husa Adaptive Robust Kalman Filter
Dynamic information such as the position and velocity of the target detected by marine radar is frequently susceptible to external measurement white noise generated by the oscillations of an unmanned surface vehicle (USV) and target. Although the Sage–Husa adaptive Kalman filter (SHAKF) has been app...
Main Authors: | , , , , |
---|---|
Format: | Article |
Language: | English |
Published: |
MDPI AG
2022-04-01
|
Series: | Sensors |
Subjects: | |
Online Access: | https://www.mdpi.com/1424-8220/22/8/2924 |
_version_ | 1827619419305541632 |
---|---|
author | Shuanghu Qiao Yunsheng Fan Guofeng Wang Dongdong Mu Zhiping He |
author_facet | Shuanghu Qiao Yunsheng Fan Guofeng Wang Dongdong Mu Zhiping He |
author_sort | Shuanghu Qiao |
collection | DOAJ |
description | Dynamic information such as the position and velocity of the target detected by marine radar is frequently susceptible to external measurement white noise generated by the oscillations of an unmanned surface vehicle (USV) and target. Although the Sage–Husa adaptive Kalman filter (SHAKF) has been applied to the target tracking field, the precision and stability of SHAKF remain to be improved. In this paper, a square root Sage–Husa adaptive robust Kalman filter (SR-SHARKF) algorithm together with the constant jerk model is proposed, which can not only solve the problem of filtering divergence triggered by numerical rounding errors, inaccurate system mathematics, and noise statistical models, but also improve the filtering accuracy. First, a novel square root decomposition method is proposed in the SR-SHARKF algorithm for decomposing the covariance matrix of SHAKF to assure its non-negative definiteness. After that, a three-segment approach is adopted to balance the observed and predicted states by evaluating the adaptive scale factor. Finally, the unbiased and the biased noise estimators are integrated while the interval scope of the measurement noise is constrained to jointly evaluate the measurement and observation noise for better adaptability and reliability. Simulation and experimental results demonstrate the effectiveness of the proposed algorithm in eliminating white noise triggered by the USV and target oscillations. |
first_indexed | 2024-03-09T10:29:51Z |
format | Article |
id | doaj.art-1f53cafe76df46fe813e6554d85a7fdc |
institution | Directory Open Access Journal |
issn | 1424-8220 |
language | English |
last_indexed | 2024-03-09T10:29:51Z |
publishDate | 2022-04-01 |
publisher | MDPI AG |
record_format | Article |
series | Sensors |
spelling | doaj.art-1f53cafe76df46fe813e6554d85a7fdc2023-12-01T21:22:59ZengMDPI AGSensors1424-82202022-04-01228292410.3390/s22082924Radar Target Tracking for Unmanned Surface Vehicle Based on Square Root Sage–Husa Adaptive Robust Kalman FilterShuanghu Qiao0Yunsheng Fan1Guofeng Wang2Dongdong Mu3Zhiping He4College of Marine Electrical Engineering, Dalian Maritime University, Dalian 116026, ChinaCollege of Marine Electrical Engineering, Dalian Maritime University, Dalian 116026, ChinaCollege of Marine Electrical Engineering, Dalian Maritime University, Dalian 116026, ChinaCollege of Marine Electrical Engineering, Dalian Maritime University, Dalian 116026, ChinaCollege of Marine Electrical Engineering, Dalian Maritime University, Dalian 116026, ChinaDynamic information such as the position and velocity of the target detected by marine radar is frequently susceptible to external measurement white noise generated by the oscillations of an unmanned surface vehicle (USV) and target. Although the Sage–Husa adaptive Kalman filter (SHAKF) has been applied to the target tracking field, the precision and stability of SHAKF remain to be improved. In this paper, a square root Sage–Husa adaptive robust Kalman filter (SR-SHARKF) algorithm together with the constant jerk model is proposed, which can not only solve the problem of filtering divergence triggered by numerical rounding errors, inaccurate system mathematics, and noise statistical models, but also improve the filtering accuracy. First, a novel square root decomposition method is proposed in the SR-SHARKF algorithm for decomposing the covariance matrix of SHAKF to assure its non-negative definiteness. After that, a three-segment approach is adopted to balance the observed and predicted states by evaluating the adaptive scale factor. Finally, the unbiased and the biased noise estimators are integrated while the interval scope of the measurement noise is constrained to jointly evaluate the measurement and observation noise for better adaptability and reliability. Simulation and experimental results demonstrate the effectiveness of the proposed algorithm in eliminating white noise triggered by the USV and target oscillations.https://www.mdpi.com/1424-8220/22/8/2924target trackingunmanned surface vehicleSage–Husa adaptive Kalman filtersquare root Sage–Husa adaptive robust Kalman filterpositionvelocity |
spellingShingle | Shuanghu Qiao Yunsheng Fan Guofeng Wang Dongdong Mu Zhiping He Radar Target Tracking for Unmanned Surface Vehicle Based on Square Root Sage–Husa Adaptive Robust Kalman Filter Sensors target tracking unmanned surface vehicle Sage–Husa adaptive Kalman filter square root Sage–Husa adaptive robust Kalman filter position velocity |
title | Radar Target Tracking for Unmanned Surface Vehicle Based on Square Root Sage–Husa Adaptive Robust Kalman Filter |
title_full | Radar Target Tracking for Unmanned Surface Vehicle Based on Square Root Sage–Husa Adaptive Robust Kalman Filter |
title_fullStr | Radar Target Tracking for Unmanned Surface Vehicle Based on Square Root Sage–Husa Adaptive Robust Kalman Filter |
title_full_unstemmed | Radar Target Tracking for Unmanned Surface Vehicle Based on Square Root Sage–Husa Adaptive Robust Kalman Filter |
title_short | Radar Target Tracking for Unmanned Surface Vehicle Based on Square Root Sage–Husa Adaptive Robust Kalman Filter |
title_sort | radar target tracking for unmanned surface vehicle based on square root sage husa adaptive robust kalman filter |
topic | target tracking unmanned surface vehicle Sage–Husa adaptive Kalman filter square root Sage–Husa adaptive robust Kalman filter position velocity |
url | https://www.mdpi.com/1424-8220/22/8/2924 |
work_keys_str_mv | AT shuanghuqiao radartargettrackingforunmannedsurfacevehiclebasedonsquarerootsagehusaadaptiverobustkalmanfilter AT yunshengfan radartargettrackingforunmannedsurfacevehiclebasedonsquarerootsagehusaadaptiverobustkalmanfilter AT guofengwang radartargettrackingforunmannedsurfacevehiclebasedonsquarerootsagehusaadaptiverobustkalmanfilter AT dongdongmu radartargettrackingforunmannedsurfacevehiclebasedonsquarerootsagehusaadaptiverobustkalmanfilter AT zhipinghe radartargettrackingforunmannedsurfacevehiclebasedonsquarerootsagehusaadaptiverobustkalmanfilter |