An Enhanced Collaborative Localization Method Based on Belief Propagation Aided by 3D Terrain Modelling

Navigation system performance degrades significantly in complex environments. It is important to analyze satellite visibility through 3D terrain modelling and separate the satellite signals propagated by NLOS to suppress the NLOS error. However, the traditional 3D terrain modelling visibility analysis method based on the pure terrain cover angle is only suitable for determining the visibility of GNSS satellites and may incorrectly separate LOS propagate measurement signals from members with low relative ranges and elevation angles under air–ground swarm conditions. To this end, this paper proposes a belief-propagating cooperative navigation method based on air–ground visibility analysis, which avoids mistakenly separating close-range LOS cooperative navigation signals by simultaneously considering the distances, elevation angles, and azimuths of the signal sources relative to the air–ground swarm members. The simulation shows that the cooperative navigation NLOS identification method based on air–ground visibility analysis proposed in this paper can more accurately realize the separation of NLOS signals under cooperative conditions than the traditional pure angular 3D terrain modelling visibility analysis method can, and the localization error of the members to be assisted is significantly reduced.