Accurate global localization is crucial for autonomous navigation and planning. To this end, various GPS-aided Visual-Inertial Odometry (GPS-VIO) fusion algorithms are proposed in the literature. This paper presents a novel GPS-VIO system that is able to significantly benefit from the online calibration of the rotational extrinsic parameter between the GPS reference frame and the VIO reference frame. The behind reason is this parameter is observable. This paper provides novel proof through nonlinear observability analysis. We also evaluate the proposed algorithm extensively on diverse platforms, including flying UAV and driving vehicle. The experimental results support the observability analysis and show increased localization accuracy in comparison to state-of-the-art (SOTA) tightly-coupled algorithms.@en

Unmanned Aerial Systems (UAS) have rapidly gained attraction in recent years as a promising solution to revolutionize numerous applications and meet the growing demand for efficient and timely delivery services due to their highly automated operation framework. Beyond Visual Line of Sight (BVLOS) operations, in particular, offer new means of delivering added-value services via a wide range of applications. This "plateau of productivity" holds enormous promise, but it is challenging to equip the drone with affordable technologies which support the BVLOS use case. To close this gap, this work showcases the convergence of the automotive and aviation industries to advance BVLOS aviation for UAS in a practical setting by studying a combination of Commercial Off-The-Shelf (COTS) technologies and systems. A novel risk-based approach of investigating the key technological components, architectures, algorithms, and protocols is proposed that facilitate highly reliable and autonomous BVLOS operations, aiming to enhance the alignment between market and operational needs and to better identify integration requirements between the different capabilities to be developed.@en

Gaussian process state-space models are a widely used modelling paradigm for learning and estimation in dynamical systems. Reduced-rank Gaussian process state-space models combine spectral characterization of dynamical systems with Hilbert space methods to enable learning, which scales linearly with the length of the time series. However, the current state of the art algorithms struggle to deal efficiently with the dimensionality of the state-space parameters. In this work, we propose a domain-aware reduced-rank Gaussian process model which uses the relationship between state dimensions to reduce the computational cost, by potentially orders of magnitude in comparison to the state-of-the-art, while maintaining comparable performance. We conduct simulations to showcase the performance and reduced computational cost of our proposed method, in comparison with the state-of-the-art learning method, and propose future research directions. @en

A new method for joint ranging and Phase Offset (PO) estimation of multiple drones/aircrafts is proposed in this paper. The proposed method employs the superimposed uncoordinated Automatic Dependent Surveillance-Broadcast (ADS-B) packets broadcasted by drones/aircrafts for joint range and PO estimation. It jointly estimates range and PO prior to ADS-B packet decoding; thus, it can improve air safety when packet decoding is infeasible due to packet collision. Moreover, it enables coherent detection of ADS-B packets, which can result in more reliable multiple target tracking in aviation systems using cooperative sensors for detect and avoid (DAA). By minimizing the Kullback-Leibler Divergence (KLD) statistical distance measure, we show that the received complex baseband signal coming from K uncoordinated drones/aircrafts corrupted by Additive White Gaussian Noise (AWGN) at a single antenna receiver can be approximated by an independent and identically distributed (i.i.d.) Gaussian Mixture (GM) with 2^{K} mixture components in the two-dimensional (2D) plane. While direct joint Maximum Likelihood Estimation (MLE) of range and PO from the derived GM Probability Density Function (PDF) leads to an intractable maximization, our proposed method employs the Expectation-Maximization (EM) algorithm to estimate the modes of the 2D Gaussian mixture followed by a reordering estimation technique through combinatorial optimization to estimate range and PO. An extension to a multiple antenna receiver is also investigated in this article. While the proposed estimator can estimate the range of multiple drones/aircrafts with a single receive antenna, a larger number of drones/aircrafts can be supported with higher accuracy by the use of multiple antennas at the receiver. The effectiveness of the proposed estimator is supported by simulation results. We show that the proposed estimator can jointly estimate the range of multiple drones/aircrafts accurately.

@en

Consensus control of multiagent systems arises in various applications such as rendezvous and formation control. The input to these algorithms, e.g., the (relative) positions of neighboring agents need to be measured using various sensors. Recent works aim to reconstruct these positions, i.e., achieve localization using Euclidean distance measurements instead of displacements, for cost efficiency and scalability. However, this approach inherently introduces ambiguities, such as a rotation or a reflection, which can cause stability issues in practice without corrections by some anchors. In this letter, we conduct a thorough analysis of the stability of consensus control in the presence of localization-induced rotational ambiguities, in several scenarios including, e.g., proper and improper rotation, and the homogeneity of rotations. We give stability criteria and stability margin on the rotations, which are numerically verified with two traditional examples of consensus control.

@en

Gaussian process regression (GPR), is a powerful non-parametric approach for data modeling, which has garnered considerable interest in the past decade, however its widespread application is impeded by the significant computational burden for larger datasets. The computational complexity for both inference and hyperparameter learning in GPs lead to O(N³) for N training points. The current state-of-the-art approximations, such as structured kernel interpolation (SKI)-based methods e.g., Kernel Interpolation for Scalable Structured Gaussian Process (KISSGP), have emerged to mitigate this challenge by providing a scalable inducing point alternatives. However, the choice of the optimal number of grid points, which influences the accuracy and efficiency of the model, typically remains fixed and is chosen arbitrarily. In this work, we introduce a novel approximation framework, Malleable KISSGP (MKISSGP), which dynamically adjusts grid points using a new hyperparameter of the model called density, which adapts to the changes in the kernel hyperparameters in each training iteration. In comparison with the state-of-the-art KISSGP and irrespective of changes in hyperparameters, our proposed MKISSGP algorithm exhibits consistent error levels in the reconstruction of the kernel matrix, and offers reduced computational complexity. We present extensive simulations to validate the improved performance of the proposed MKISSGP, and give directions for future research.

@en

In this paper, we propose a new method for joint ranging and Phase Offset (PO) estimation of multiple transponder-equipped aviation vehicles (TEAVs), including Manned Aerial Vehicles (MAVs) and Unmanned Aerial Vehicles (UAVs). The proposed method employs the overlapping uncoordinated Automatic Dependent Surveillance-Broadcast (ADS-B) packets broadcasted by the TEAVs for joint range and PO estimation prior to ADS-B packet decoding; thus, it can improve air safety when packet decoding is infeasible due to packet collision. Moreover, it enables coherent detection of ADS-B packets, which can result in more reliable multiple target tracking in aviation systems using cooperative sensors for sense and avoid. By minimizing the Kullback-Leibler Divergence (KLD), we show that the received complex baseband signal, coming from K uncoordinated TEAVs, which is corrupted by Additive White Gaussian Noise (AWGN) at a single antenna receiver can be approximated by an independent and identically distributed (i.i.d.) Gaussian Mixture (GM) with 2^K mixture components in the two-dimensional plane. The proposed estimator employs the Expectation-Maximization (EM) algorithm to estimate the modes of the 2D Gaussian mixture followed by a reordering estimation technique to jointly estimate range and PO. Simulation results show that the proposed joint estimator outperforms excising methods, such as the time segmentation method and the blind adaptive beamforming.

@en

Efficient path planning is key for safe autonomous navigation over complex and unknown terrains. Lunar Zebro (LZ), a project of the Delft University of Technology, aims to deploy a compact rover, no larger than an A4 sheet of paper and weighing not more than 3 kilograms. In this work, we introduce a Robust Artificial Potential Field (RAPF) algorithm, a new path-planning algorithm for reliable local navigation solution for lunar microrovers. RAPF leverages and improves state of the art Artificial Potential Field (APF)-based methods by incorporating the position of the robot in the generation of bacteria points and considering local minima as regions to avoid. We perform both simulations and on field experiments to validate the performance of RAPF, which outperforms state-of-the-art APF-based algorithms by over 15% in reachability within a similar or shorter planning time. The improvements resulted in a 200% higher success rate and 50% lower computing time compared to the conventional APF algorithm. Near-optimal paths are computed in real-time with limited available processing power. The bacterial approach of the RAPF algorithm proves faster to execute and smaller to store than path planning algorithms used in existing planetary rovers, showcasing its potential for reliable lunar exploration with computationally constrained and energy constrained robotic systems.

@en

A cooperative sense and avoid (SAA) algorithm for safe navigation of small-sized unmanned aerial vehicles (UAVs) within an airspace is proposed in this article. The proposed method relies upon cooperation between the UAV and the surrounding transponder-equipped aviation obstacles. To do so, the aviation obstacles share their altitude and identification code with the UAV by using the Mode S operation of the secondary surveillance radar (SSR) after interrogation. The proposed SAA algorithm benefits from the estimate of the aviation obstacle's elevation angle for ranging. This results in more accurate ranging compared to the round-trip time-based ranging, which is currently used in existing SAA systems. We also propose a low-complexity and accurate radial velocity estimator for the Mode S operation of the SSR, which is employed in the proposed SAA system. Furthermore, by considering the pulse-position modulation of the transponder reply as a waveform of pulse radar with random pulse repetition intervals, the maximum unambiguous radial velocity is obtained. The proposed SAA is equipped with an intruder identification method that determines the risk level of the surrounding transponder-equipped aviation obstacles. Given the estimated parameters, the intruder identification method classifies the aviation obstacles into high- medium-, and low-risk intruders. The output of the classifier enables the UAV to plan its path or maneuver for safe navigation accordingly. The root mean square error of the proposed estimators are analytically derived, and the effectiveness of our SAA solution is confirmed through simulation experiments.

@en

Accurate global localization is crucial for autonomous navigation and planning. To this end, various GPS-aided Visual-Inertial Odometry (GPS-VIO) fusion algorithms are proposed in the literature. This paper presents a novel GPS-VIO system that is able to significantly benefit from the online calibration of the rotational extrinsic parameter between the GPS reference frame and the VIO reference frame. The behind reason is this parameter is observable. This paper provides novel proof through nonlinear observability analysis. We also evaluate the proposed algorithm extensively on diverse platforms, including flying UAV and driving vehicle. The experimental results support the observability analysis and show increased localization accuracy in comparison to state-of-the-art (SOTA) tightly-coupled algorithms.

@en

Sensor calibration is an indispensable task in any networked cyberphysical system. In this paper, we consider a sensor network plagued with offset errors, measuring a rank-1 signal subspace, where each sensor collects measurements under a linear model with additive zero-mean Gaussian noise. Under varying assumptions on the underlying noise covariance, we investigate the effect of using an arbitrary reference for estimating the sensor offsets, in contrast to the 'average of all the unknown offsets' as a reference. We first show that the average reference yields an efficient minimum variance unbiased estimator. If the underlying noise is homoscedastic in nature, then we prove the average reference yields a factor 2 improvement on the variance, as compared to any arbitrarily chosen reference within the network. Furthermore, when the underlying noise is independent but not identical, we derive an expression for the improvement offered by the average reference. We demonstrate our results using the problem of clock synchronization in sensor networks, and discuss directions for future work.

@en

Gaussian Process (GP) is a flexible non-parametric method which has a wide variety of applications e.g., field estimation using multi-agent systems. However, the training of the hyperparameters suffers from high computational complexity. Recently, distributed hyperparameter optimization with proximal gradients has been proposed to reduce complexity, however only for a network with a central station. In this work, exploiting edge-based constraints, we propose two fully-distributed algorithms pxADMMfd and pxADMMfd,fast for a network of multi-agent systems, which do not rely on a central station. In addition, asynchronous versions of the algorithms are also proposed to reduce the synchronization overhead in heterogeneous networks. Simulations are conducted for a field estimation problem, using both artificial, and real-world datasets, which show that the proposed fully-distributed algorithms successfully converge, at the cost of an increased number of iterations.@en

Multi-agent networks are known for their scalability, robustness, flexibility, and are typically tasked with a variety of tasks such as target tracking, surveillance, traffic control, and environmental monitoring. Distributed Particle Filters (DPF) are often employed when the for non-linear parameter estimation with non-Gaussian noise. In this paper, we propose a novel distributed particle filter whose transmitted quantities are particles. The fusion process of particles is implemented in a distributed and iterative fashion. To reduce the communication overhead, we adopt the Gaussian process-enhanced resampling algorithm, which reduces the size of local particle set, while still ensures acceptable filtering performance. To determine the local particle set after the communication, we propose two solutions. Our first algorithm (GP-DPF) adopts a “scoring mechanism”, allowing local agents score the received particles and using the scores as the selection criterion. Our second proposed solution (FA-DPF) is a meta-heuristic approach, which uses the well known firefly algorithm as a selection method for particle-based distributed particle filtering. Our simulations demonstrate the superiority of our proposed algorithms under the condition of limited communication and computational resources against other state-of-the-art distributed particle filters.@en

In this paper, we study path planning algorithms of resource constrained mobile agents in unknown cluttered environments, which include but are not limited to various terrestrial missions e.g., search and rescue missions by drones in jungles, and space missions e.g., navigation of rovers on the Moon. In particular, we focus our attention on artificial potential field (APF) based methods, in which the target is attractive while the obstacles are repulsive to the mobile agent. In this paper, we propose two major updates to the classical APF algorithm which significantly improve the performance of path planning using APF. First, we propose to improve an existing classical method that replaces the gradient descent optimization of the potential field cost function on a continuous domain with a combinatorial optimization on a set of predefined points (called bacteria points) around the agent's current location. Our proposition includes an adaptive hyperparameter that changes the value of the potential function associated to each bacteria point based on the current environmental measurements. Our proposed solution improves the navigation performance in terms of convergence to the target at the expense of minimal increase in computational complexity. Second, we propose an improved potential field cost function of the bacteria points by introducing a new branching cost function which further improves the navigation performance. The algorithms were tested on a set of Monte Carlo simulation trials where the environment changes for each trial. Our simulation results show 25% lower navigation time and around 300% higher success rate compared to the conventional potential field method, and we present future directions for research.@en

Affine formation control of multiagent systems has recently received increasing attention in various applications. The distributed control of these agents, under single integrator dynamics, relies on the observations of relative positions of the neighboring agents, which when unavailable is detrimental to the mission. In this paper, we propose an adaptive fusion estimator of the relative positions under intermittent and consecutive observation loss settings. A relative affine localization (RAL) solution is developed by exploiting the geometry of affine formation, which is then embedded into a distributed relative Kalman filtering (RKF) framework, leading to the geometry-aware relative Kalman filter (GA-RKF). We show through simulations that the GA-RKF exhibits enhanced robustness to both intermittent and consecutive observation losses, as compared to RAL and existing state-of-art methods.

@en

In multi-sensor systems, several sensors produce data streams, commonly, at different frequencies. If they are let running wild without synchronization, after a period of time, they are likely to be disordered, presenting as simultaneous measures that have been recorded at different times. That can be disastrous in many data fusion applications. This paper is about their temporal synchronization and ordering, so they can be coherently fused. Some sensors do not have timestamps from which order the streams, and even if they have, they may be not trustable for different reasons. First, we define mathematically the problem of multi-sensor data stream synchronization. Then, we handle the problem of estimating the actual time of sensor measurement using mean or median filters. Next, we address the issue of reconstructing incoming sensor data streams according to the estimated sensor measurement times while maintaining minimal latency and synchronization error by employing an adaptive stream buffering technique utilized in distributed multimedia systems. In order to test our methods, we have recorded an easy-to-use dataset with a radar and a lidar sensors without timestamps. We define a synchronization event that is easily identifiable by a human annotator in both sensor streams. From this dataset, a suitable filter for timestamp estimation is selected, and an analysis of the effects of the stream synchronization algorithm’s parameters on buffering latency and synchronization error is presented. Finally, the solution is efficiently implemented on a FPGA @en

Given a network of N static nodes in D-dimensional space and the pairwise distances between them, the challenge of estimating the coordinates of the nodes is a well-studied problem. However, for numerous application domains, the nodes are mobile and the estimation of relative kinematics (e.g., position, velocity and acceleration) is a challenge, which has received limited attention in literature. In this paper, we introduce a time-varying Grammian-based data model for estimating the relative kinematics of mobile nodes with polynomial trajectories, given the time-varying pairwise distance measurements between the nodes. Furthermore, we consider a scenario where the nodes have on-board accelerometers, and extend the proposed data model to include these accelerometer measurements. We propose closed-form solutions to estimate the relative kinematics, based on the proposed data models. We conduct simulations to showcase the performance of the proposed estimators, which show improvement against state-of-the-art methods.

@en

Distributed multi-agent systems (MAS) offer higher robustness and scalability compared to single-agent systems employing centralized solutions. The challenge of learning unknown environmental phenomenons can be regarded as learning a hidden function, which can be modeled through non-parametric methods e.g., Gaussian Processes (GP). Our main challenge is to develop a distributed non-parametric model e.g., GP for environment monitoring. In this work, we specifically focus on developing fully-distributed algorithm for GP hyperparameter optimization. An example of hyperparameter set is θ = {sf , l1, l2} for a squared exponential kernel, where signal variance sf indicates the range of function, and the characteristic lengths l1, l2 indicate the smoothness. We also develop an asynchronous version to deal with heterogeneous processing time of agents. Assuming that local datasets at agents are independent with each other, we approximate hyperparameter optimization by maximizing the sum of local Likelihoods. By further defining a unique θ across the network, the problem can be regarded as a distributed consensus problem. Alternating direction method of multipliers (ADMM) with proximal θ update have been applied by Xie et al. [1], which still requires a center computing unit for auxiliary variable update. We propose a fully-distributed algorithm with centralized update replaced by local consensus. In each iteration, an agent collects auxiliary variables from neighbor agents, and use their average in new iteration. Asynchronous behavior is introduced by allowing fast agents to start new iterations without collecting update from slowest agents. Our proposed algorithm allows agents in the network to perform faster iterations and thus saving time. We perform simulations with artificially generated 2D GP field under pre-defined hyperparameter setting. Noisy measurements are randomly allocated to agents for distributed hyperparameter optimization. Simulation results show that the optimal hyperparameters at agents converge to the expected values...@en