Relaxing The Planar Assumption: 3d State Estimation For An Autonomous Surface Vessel

Autonomous Surface Vessels (ASVs) are increasingly being proposed as tools to automate environmental data collection, bathymetric mapping and shoreline monitoring. For many applications it can be assumed that the boat operates on a 2D plane. However, with the involvement of exteroceptive sensors like cameras or laser rangefinders, knowing the 3D pose of the boat becomes critical. In this paper, we formulate three different algorithms based on 3D extended Kalman filter state estimation for ASV localization. We compare them using field testing results with ground truth measurements, and demonstrate that the best performance is achieved with a model-based solution in combination with a complementary filter for attitude estimation. Furthermore, we present a parameter identification methodology and show that it also yields accurate results when used with inexpensive sensors. Finally, we present a long-term series (i.e. over a full year) of shoreline monitoring data sets and discuss the need for map maintenance routines based on a variant of the Iterative Closest Point algorithm.