Abstract— This paper presents an extension to a state of
the art Visual-Inertial state estimation package (OKVIS) in
order to accommodate data from an underwater acoustic
sensor. Mapping underwater structures is important in several
fields, such as m