Road roughness significantly affects vehicle vibrations and ride quality. We introduce a Kalman filter (KF)-based method for estimating road roughness in terms of the international roughness index (IRI) by fusing inertial and speed measurements, offering a cost-effective solution for pavement monitoring. The method involves system identification on a physical vehicle to estimate realistic model parameters, followed by KF-based reconstruction of the longitudinal road profile to compute IRI values. It explores IRI estimation using vertical and lateral vibrations, the latter more common in modern vehicles. Validation on 230 km of real-world data shows promising results, with IRI estimation errors ranging from 1% to 10% of the reference values. However, accuracy deteriorates significantly when using only lateral vibrations, highlighting their limitations. These findings demonstrate the potential of KF-based estimation for efficient road roughness monitoring.

Due to recent events that have demonstrated the vulnerabilities of global navigation satellite systems (GNSS) there has been an increased interest in alternative methods for localization. One traditional alternative method is terrain-aided navigation (TAN), where a platform localizes itself by measuring the terrain elevation and comparing it to a digital elevation map (DEM). While single-agent TAN has been extensively studied, multi-agent TAN remains less explored. This paper addresses the multi-agent TAN problem with a focus on its properties. We formulate a weighted least squares (WLS) estimator for computing a snapshot solution to the problem and formulate a CramérRao Lower Bound (CRLB) to evaluate it. Using the expressions for the estimator and the CRLB we are able to highlight some insightful properties of the problem. The findings are verified in a simulation study where we evaluate the performance with respect to the altitude sensor accuracy, the group formation accuracy, the number of agents and their formation. Notably, we observe that the solution is relatively insensitive to errors in agent position, suggesting that low-accuracy inertial navigation systems and distance sensors are sufficient for determining their positions. Increasing the number of agents beyond a few seems to have a large effect on both the efficiency and robustness of the estimator, which lessens as the number of agents increases. However, increasing the number of agents does not compensate for poor altitude sensor quality. Additionally, while spatial separation between agents is important for effective map utilization, further separation beyond a certain point does not enhance performance. These findings provide design guidelines for multi-agent TAN systems and identify areas for further research.

As human settlement expands into the natural habitats of wild animals, the conflicts between humans and wildlife increases. The human-elephant conflict causes a tremendous amount of damage, often to poor villages close to the savannah. In this paper, we continue our earlier reported research on a geophone network aimed for elephant localisation by focusing on the detection challenge. We have now collected larger sets of seismic data with footsteps from both elephants and other big animals including humans. To detect the footsteps, a method is developed that analyses features of the geophone signal, which are then compared to those of an elephant footstep. The method detects $54 \%$ of the footsteps and has a classification accuracy of $89 \%$. Subsequently, the detected elephant footstep is used to calculate the direction of arrival (DOA) angle using a delay-andsum beamformer. The direction to an elephant is estimated with good precision on distances ranging from 8 to 30 meters. This research, not only, showcases a practical solution for mitigating human-elephant conflicts, but also underscores the potential of seismic technology in wildlife management and conservation efforts.

The Particle filter can in theory estimate the state of any nonlinear system, but in practice it suffers from an exponential complexity in terms of the number of particles as the dimension of the state increases. The marginalized particle filter can potentially reduce this problem by improving the estimates, particularly for lower number of particles. However, it turns out that for certain systems, it does not provide any improvement in the accuracy of the estimate. The core cause of degeneracy is linked to when the uncertainty of the linear state conditioned on the nonlinear state is 0. Conditions for determining when this occurs are presented and applied to common constant velocity, constant acceleration and constant jerk models with various sampling methods. Interestingly, some combinations are useful while others should be avoided. These findings are supported using simulated systems.

Network-centric multitarget tracking under communication constraints is considered, where dimension-reduced track estimates are exchanged. Previous work on target tracking in this subfield has focused on fusion aspects only and derived optimal ways of reducing dimensionality based on fusion performance. In this work we propose a novel problem formalization where estimates are reduced based on association performance. The problem is analyzed theoretically and problem properties are derived. The theoretical analysis leads to an optimization strategy that can be used to partly preserve association quality when reducing the dimensionality of communicated estimates. The applicability of the suggested optimization strategy is demonstrated numerically in a multitarget scenario.

Human-wildlife conflicts are a global problem which is central to the Global Goal 15 (life on land). One particular case is elephants, that can cause harm to both people, property and crops. An early warning system that can detect and warn people in time would allow effective mitigation measures. The proposed method is based on a small local network of geophones that sense the seismic waves of elephant footsteps. It is known that elephant footsteps induce low frequency ground waves that can be picked up by geophones in the ground. First, a method is described that detect the particular signature of such footsteps, and then the detections are used to estimate the direction of arrival (DOA). Finally, a Kalman filter is applied to the measurements in order to track the elephant. Field tests performed at a local zoo shows promising results with accurate DOA estimates at 15 meters distance and acceptable accuracy at 40 meters.

We consider a decentralized sensor network of multiple nodes with limited communication capability where the cross-correlations between local estimates are unknown. To reduce the bandwidth the individual nodes determine which subset of local information is the most valuable from a global perspective. Three information selection methods (ISM) are derived. The proposed ISM require no other information than the communicated estimates. The simulation evaluation shows that by using the proposed ISM it is possible to determine which subset of local information is globally most valuable such that both reduced bandwidth and high performance are achieved.

Modern maritime navigation is heavily dependent on satellite systems. Availability of an accurate position is critical for safe operations, but satellite-based navigation systems are vulnerable to interference, jamming, and spoofing. In this work, we propose a method for maritime navigation independent of GNSS, able to provide absolute positioning of the vessel based on marine radar scans. A measurement model is presented where a Digital Elevation Model is used to predict the output of a marine radar, given a hypothetical position. The model, as used by an on-line particle filter, is used to track the movements of a ship from real recorded data. This demonstrates the feasibility of this method for robust positioning, without the need of external positioning signals, in a maritime environment. The tracking only uses sensors commonly available on maritime vessels, and demonstrates its application using freely available elevation data.

A wearable microphone array platform is used to localize stationary sound sources and amplify the sound in the desired directions using several beamforming methods. The platform is equipped with inertial sensors and a magnetometer allowing predictions of source locations during orientation changes and compensation for the displacement in the array configuration. The platform is modular, open and 3D printed to allow for easy reconfiguration of the array and for reuse in other applications, e.g., mobile robotics. The software components are based on open source. A new method for source localization and signal reconstruction using Taylor expansion of the signals is proposed. This and various standard and non-standard Direction of Arrival (DOA) methods are evaluated in simulation and experiments with the platform to track and reconstruct multiple and single sources. Results show that sound sources can be localized and tracked robustly and accurately while rotating the platform and that the proposed method outperforms standard methods at reconstructing the signals.

In this paper, recursive Bobrovsky-Zakai bounds for filtering, prediction and smoothing of nonlinear dynamic systems are presented. The similarities and differences to an existing Bobrovsky-Zakai bound in the literature for the filtering case are highlighted. The tightness of the derived bounds are illustrated on a simple example where a linear system with non-Gaussian measurement likelihood is considered. The proposed bounds are also compared with the performance of some well-known filters/predictors/smoothers and other Bayesian bounds.

A model-based method to perform odometry using an array of magnetometers that sense variations in a local magnetic field is presented. The method requires no prior knowledge of the magnetic field, nor does it compile any map of it. Assuming that the local variations in the magnetic field can be described by a curl and divergence free polynomial model, a maximum likelihood estimator is derived. To gain insight into the array design criteria and the achievable estimation performance, the identifiability conditions of the estimation problem are analyzed and the Cramér-Rao bound for the one-dimensional case is derived. The analysis shows that with a second-order model it is sufficient to have six magnetometer triads in a plane to obtain local identifiability. Further, the Cramér-Rao bound shows that the estimation error is inversely proportional to the ratio between the rate of change of the magnetic field and the noise variance, as well as the length scale of the array. The performance of the proposed estimator is evaluated using real-world data. The results show that, when there are sufficient variations in the magnetic field, the estimation error is of the order of a few percent of the displacement. The method also outperforms current state-of-the-art method for magnetic odometry.

This paper deals with state inference and parameter identification in Jump Markov Non-Linear System. The state inference problem is solved efficiently using a recently proposed Rao-Blackwellized Particle Filter, where the discrete state is integrated out analytically. Within the RBPF framework, Recursive Maximum Likelihood parameter identification is performed using gradient ascent algorithms. The proposed learning method has the advantage over (online) Expectation Maximization methods, that it can be easily applied to cases where the probability density functions defining the Jump Markov Non-Linear System are not members of the exponential family. Two benchmark problems illustrate the parameter identification performance.

Acoustic frequency tracking of a harmonic signal with continuously varying frequency is considered. The Rao-Blackwellized point mass filter (RBPMF), previously proposed by the authors for mechanical vibration tracking, is applied to the problem. The RBPMF is compared with two periodogram-based methods, and the similarities and differences between them are explained. Both experimental and simulation results in a Doppler frequency tracking scenario are presented, and the results show that the RBPMF can have significantly less estimation error than the competing methods.

This paper presents a method for identifying dynamic models of Autonomous Underwater Vehicles (AUV) from logged data and a physically motivated model structure. Such models are instrumental for model-based control system design, but also for integrated navigation systems. We motive our work from the perspective of developing second generation integrated navigation systems, which use a sensor fusion approach to merge external information with a dynamic model for purposes of redundancy, integrity, and for fault detection and isolation.

This contribution presents a unified framework for localization and tracking in sensor networks based on fusing a variety of signal energy measurements as provided by for instance acoustic, seismic, magnetic, radio, microwave and infrared sensors. The received energy from such sensors generally decays exponentially, and a log range model is introduced for the sensor observations in logarithmic scale, which is linear in transmitted power and the path loss exponent. Field trial sensor data confirms the validity of the log range model. The novelty in this contribution lies in a systematic least squares approach to eliminate these nuisance parameters and also the sensor noise variances. Details on how to solve the resulting low-dimensional non-linear least squares criterion are given, and how to extend the algorithms to target tracking. Explicit formulas for the Cramer-Rao lower bound are given for both localization and tracking.

This contribution aims at unifying two trends in applied particle filtering (PF). The first trend is the major impact in simultaneous localization and mapping (slam) applications, utilizing the FastSLAM algorithm. The second one is the implications of the marginalized particle filter (MPF) or the Rao-Blackwellized particle filter (RBPF) in positioning and tracking applications. An algorithm is introduced, which merges FastSLAM and MPF, and the result is an MPF algorithm for slam applications, where state vectors of higher dimensions can be used. Results using experimental data from a 3D slam development environment, fusing measurements from inertial sensors (accelerometer and gyro) and vision are presented.

In augmented reality (AR), the position and orientation of the camera have to be estimated with high accuracy and low latency. This nonlinear estimation problem is studied in the present paper. The proposed solution makes use of measurements from inertial sensors and computer vision. These measurements are fused using a Kalman filtering framework, incorporating a rather detailed model for the dynamics of the camera. Experiments show that the resulting filter provides good estimates of the camera motion, even during fast movements