4.6 Article

Five-State Extended Kalman Filter for Estimation of Speed over Ground (SOG), Course over Ground (COG) and Course Rate of Unmanned Surface Vehicles (USVs): Experimental Results

Journal

SENSORS
Volume 21, Issue 23, Pages -

Publisher

MDPI
DOI: 10.3390/s21237910

Keywords

unmanned surface vehicle (USV); Kalman filter; course autopilot; course over ground; speed over ground

Ask authors/readers for more resources

The article discusses a solution for small USV navigation systems that utilizes a five-state extended Kalman filter (EKF) aided by GNSS latitude-longitude measurements to estimate heading, speed, and course rate. The method is efficient, easy to implement, suitable for autopilot systems, and can improve performance.
Small USVs are usually equipped with a low-cost navigation sensor suite consisting of a global navigation satellite system (GNSS) receiver and a magnetic compass. Unfortunately, the magnetic compass is highly susceptible to electromagnetic disturbances. Hence, it should not be used in safety-critical autopilot systems. A gyrocompass, however, is highly reliable, but it is too expensive for most USV systems. It is tempting to compute the heading angle by using two GNSS antennas on the same receiver. Unfortunately, for small USV systems, the distance between the antennas is very small, requiring that an RTK GNSS receiver is used. The drawback of the RTK solution is that it suffers from dropouts due to ionospheric disturbances, multipath, interference, etc. For safety-critical applications, a more robust approach is to estimate the course angle to avoid using the heading angle during path following. The main result of this article is a five-state extended Kalman filter (EKF) aided by GNSS latitude-longitude measurements for estimation of the course over ground (COG), speed over ground (SOG), and course rate. These are the primary signals needed to implement a course autopilot system onboard a USV. The proposed algorithm is computationally efficient and easy to implement since only four EKF covariance parameters must be specified. The parameters need to be calibrated for different GNSS receivers and vehicle types, but they are not sensitive to the working conditions. Another advantage of the EKF is that the autopilot does not need to use the COG and SOG measurements from the GNSS receiver, which have varying quality and reliability. It is also straightforward to add complementary sensors such as a Doppler Velocity Log (DVL) to the EKF to improve the performance further. Finally, the performance of the five-state EKF is demonstrated by experimental testing of two commercial USV systems.

Authors

I am an author on this paper
Click your name to claim this paper and add it to your profile.

Reviews

Primary Rating

4.6
Not enough ratings

Secondary Ratings

Novelty
-
Significance
-
Scientific rigor
-
Rate this paper

Recommended

Article Robotics

Vision-based positioning system for auto-docking of unmanned surface vehicles (USVs)

Oystein Volden, Annette Stahl, Thor I. Fossen

Summary: This paper introduces an independent stereo-vision based positioning system for docking operations, which utilizes a learning-based object detection model and a mix of data-driven and traditional computer vision methods to achieve robust detections in outdoor environments. Experimental results show the system's accuracy and reliability in various docking scenarios.

INTERNATIONAL JOURNAL OF INTELLIGENT ROBOTICS AND APPLICATIONS (2022)

Article Engineering, Marine

Line-of-sight path-following control utilizing an extended Kalman filter for estimation of speed and course over ground from GNSS positions

Thor Fossen

Summary: This article introduces a design method for ship control systems for path following, which uses heading and course angle autopilots in conjunction with a proportional line-of-sight guidance law. For smaller vessels where expensive gyrocompasses cannot be afforded, feedback control is achieved by computing ground course and speed using global navigation satellite systems. An extended Kalman filter is used to efficiently estimate the ground course and speed, and can be extended to include other sensory systems. By combining target-tracking models and kinematic equations, the filter's convergence and accuracy are significantly improved. Simulation studies demonstrate the successful estimation of ground course and speed during path following, eliminating the need for a compass when combined with a course autopilot.

JOURNAL OF MARINE SCIENCE AND TECHNOLOGY (2022)

Article Robotics

Hijacking of unmanned surface vehicles: A demonstration of attacks and countermeasures in the field

Petter Solnor, Oystein Volden, Kristoffer Gryte, Slobodan Petrovic, Thor Fossen

Summary: Driven by advances in information and communication technologies, industries are increasingly using unmanned and autonomous vehicles for various services. However, these vehicles are susceptible to cyber-physical attacks, and the true impact of these attacks and corresponding security measures are unclear. This study demonstrates advanced manipulation attacks against an underactuated Unmanned Surface Vehicle (USV) and proposes countermeasures using state-of-the-art cryptography. Through field experiments, the study shows the effects of these attacks on the guidance, navigation, and control system, and the effectiveness of the proposed countermeasures.

JOURNAL OF FIELD ROBOTICS (2022)

Article Engineering, Marine

Online wave direction and wave number estimation from surface vessel motions using distributed inertial measurement arrays and phase-time-path-differences

Johann A. Dirdal, Roger Skjetne, Jan Rohac, Thor Fossen

Summary: This study demonstrates the generalization of the phase-time-path-differences (PTPDs) method to a portable shipboard array of sensors for estimating wave direction and wave number, proposing an unscented Kalman filter algorithm for online estimation. Experimental results confirm the feasibility of estimating wave parameters from the motions of a surface vessel equipped with inertial measurement units (IMUs).

OCEAN ENGINEERING (2022)

Article Engineering, Electrical & Electronic

Towards Oblivious Guidance Systems for Autonomous Vehicles

Petter Solnor, Slobodan Petrovic, Thor I. Fossen

Summary: We propose encrypted guidance systems that can be remotely hosted without revealing confidential information to the host. By operating on encrypted position measurements, encrypted waypoints, and the bearing between each waypoint, our guidance system effectively prevents the cloud host from identifying the vehicle's position. Through field experiments, we demonstrate the practicality of an encrypted guidance system for autonomous vehicles.

IEEE TRANSACTIONS ON VEHICULAR TECHNOLOGY (2023)

Article Computer Science, Information Systems

An Amplitude-Phase Representation of the North-East-Down Kinematic Differential Equations

Thor I. Fossen

Summary: The aim of this paper is to develop a kinematic model for vehicle path-following systems, where control inputs are the pitch and yaw angles $(\theta, \psi)$ together with the surge velocity $u$. The outer control loop is designed as a nonlinear path-following guidance law, while the inner control loops use commercial autopilot systems to stabilize the pitch and yaw angles. The main contribution is a novel kinematic amplitude-phase representation of the North-East-Down (NED) positional rates, which replaces the traditional Euler angle rotation matrix representation, allowing for the design of vehicle guidance laws using nonlinear control theory and Lyapunov stability analysis.

IEEE ACCESS (2023)

Article Engineering, Marine

Operability analysis of control system for ROV launch-and-recovery from autonomous surface vessel

Celine Tran, Ivan Gushkov, Kristoffer Nordvik, Simen T. Roang, Simen B. Lysthaug, Babak Ommani, Thor I. Fossen, Vahid Hassani, Vidar Smines, Tor A. Johansen

Summary: This paper investigates the analysis of control systems designed to maximize the operability limits for launching and recovering ROVs from small unmanned surface vessels (USVs). Through numerical simulation analysis, the choice of control algorithms and tuning parameters is found to have a significant impact on the system's operability, which should be carefully designed and tuned to optimize the operability limits for specific sea states, weather conditions, and operational setups.

OCEAN ENGINEERING (2023)

Article Automation & Control Systems

Feedback error-state Kalman filter with time-delay compensation for hydroacoustic-aided inertial navigation of underwater vehicles

Thor I. Fossen

Summary: This article serves as a tutorial for engineers to develop and implement low-cost underwater vehicle inertial navigation systems. It introduces the use of a discrete-time unit quaternion error-state Kalman filter for sensor fusion and highlights the need for long-endurance autonomous underwater vehicles. The open-source filter architecture allows for additional sensor integration, and the article also aims to enable in-house development of strapdown INS for vendors of low-cost AUV systems. A case study of an AUV with standard sensor suite demonstrates the performance of the ESKF aided by time-delayed position measurements.

CONTROL ENGINEERING PRACTICE (2023)

Article Automation & Control Systems

An Adaptive Line-of-Sight (ALOS) Guidance Law for Path Following of Aircraft and Marine Craft

Thor I. Fossen

Summary: This brief introduces a new nonlinear adaptive line-of-sight (ALOS) guidance law that compensates for drift forces and is proven to have uniform semiglobal exponential stability. It outperforms the classical integral line-of-sight (ILOS) and adaptive ILOS guidance laws when dealing with rapidly varying sideslip angles caused by disturbances.

IEEE TRANSACTIONS ON CONTROL SYSTEMS TECHNOLOGY (2023)

Article Engineering, Marine

Constrained control allocation for dynamic ship positioning using deep neural network

Robert Skulstad, Guoyuan Li, Thor I. Fossen, Houxiang Zhang

Summary: Dynamic positioning (DP) is a key technology for ship autonomy, allowing ships to maintain position and maneuver at low speeds using thrusters. However, traditional control allocation methods that handle thruster constraints may require significant computational resources. In this study, a neural network was trained to evaluate the mapping between motion controller requests and thruster commands, resulting in similar performance with reduced power consumption when compared to state-of-the-art control allocation methods.

OCEAN ENGINEERING (2023)

Article Engineering, Marine

Development and experimental evaluation of visual-acoustic navigation for safe maneuvering of unmanned surface vehicles in harbor and waterway areas

Oystein Volden, David Cabecinhas, Antonio Pascoal, Thor I. Fossen

Summary: Accurate navigation data is crucial for safe ship maneuvering in narrow harbor environments. This study proposes a GNSS-free sensor suite consisting of visual, acoustic, and inertial sensors to aid navigation in harbor environments. The system utilizes a doppler velocity log and a visual fiducial system for robust state estimation. Benchmarking against a dual-antenna real-time kinematic GNSS receiver, the proposed system demonstrates the benefits of supplementing landmark-based navigation with acoustic measurements in adverse scenarios. Overall, it can enhance safety in harbor maneuvering.

OCEAN ENGINEERING (2023)

Article Engineering, Marine

A phase-time-path-difference approach for online wave direction and wave number estimation from measured ship motions in zero and forward speed using a single inertial measurement unit

Johann A. Dirdal, Roger Skjetne, Jan Rohac, Thor I. Fossen

Summary: This study investigates the potential of a new signal-based approach for shipboard wave estimation. The approach uses phase-time-path-differences (PTPDs) from shipboard sensors to determine wave propagation direction and wave number. The researchers propose a methodology using fast Fourier transform (FFT), unscented Kalman filter (UKF), and a single inertial measurement unit (IMU) to estimate the wave parameters. The experimental results show that the proposed method achieves similar accuracy and online performance compared to existing wave measurement technology, while being cost-effective, easy to install, flexible, and robust against environmental influences.

OCEAN ENGINEERING (2023)

Article Computer Science, Information Systems

Development and Experimental Validation of Visual-Inertial Navigation for Auto-Docking of Unmanned Surface Vehicles

Oystein Volden, Annette Stahl, Thor I. Fossen

Summary: Docking is a critical operation for autonomous surface vehicles, and a low-cost visual-inertial navigation system is proposed for automatic docking of small vehicles. The system uses easily identifiable tags as a reference on the dockside and fuses camera-tag pose and inertial data to estimate the vehicle's state. The proposed method performs well on regular and adverse weather conditions and can supplement traditional navigation systems for docking operations.

IEEE ACCESS (2023)

Proceedings Paper Automation & Control Systems

Collaborative Collision Avoidance for Autonomous Ships Using Informed Scenario-Based Model Predictive Control

Melih Akdag, Thor I. Fossen, Tor A. Johansen

Summary: There are several collision avoidance algorithms available for autonomous ships, but most of them only use observed position and velocity information without considering other ships' intentions. As the use of large-sized autonomous ships in logistics increases, it becomes crucial for autonomous ships to collaborate and negotiate with other ships in order to prevent collisions.

IFAC PAPERSONLINE (2022)

Article Engineering, Electrical & Electronic

A Hybrid Approach to Motion Prediction for Ship Docking-Integration of a Neural Network Model Into the Ship Dynamic Model

Robert Skulstad, Guoyuan Li, Thor Fossen, Bjornar Vik, Houxiang Zhang

Summary: This article proposes a tool for onboard support that offers position predictions based on an integration of a supervised machine learning (ML) model of the ship into the ship dynamic model, significantly improving the prediction accuracy during docking operations.

IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT (2021)

No Data Available