This paper is concerned with cooperative Terrain Aided Navigation of a network of aircraft using fusion of Radar Altimeter and inter-node range measurements. State inference is performed using a Rao-Blackwellized Particle Filter with online measurement noise statistics estimation. For terrain coverage measurement noise parameter identification, an online Expectation Maximization algorithm is proposed, where local sufficient statistics at each node are calculated in the E-step, which are then distributed to neighboring nodes using a random gossip algorithm to perform the M-step at each node. Simulation results show that improvement on positioning and calibration performance can be achieved compared to a non-cooperative approach.
['Andre R. Braga', 'Marcelo G. S. Bruno', 'Carsten Fritsche', 'Fredrik Gustafsson']
Cooperative navigation and coverage identification with random gossip and sensor fusion