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...

Full description

Bibliographic Details
Main Authors: Shuanghu Qiao, Yunsheng Fan, Guofeng Wang, Dongdong Mu, Zhiping He
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