Joint CKF-PHD Filter and Map Fusion for 5G Multi-cell SLAM

5G is expected to enable simultaneous vehicle localization and environment mapping (SLAM). Furthermore, vehicular networks will be covered with 5G small cells, wherein the map information is collected at each base station (BS) and then fused so as to promote the overall performance of SLAM. In 5G multi-cell SLAM, there are challenges such as the unknown number of targets, uncertainty regarding the association between the targets and the measurements, unknown types of targets, as well as map management among BSs. To address those challenges, we propose a new method for 5G multi-cell SLAM which comprises a joint cubature Kalman filter and multi-model probability hypothesis density, and a map fusion routine. Simulation results demonstrate that the proposed method solves the aforementioned challenges and also improves vehicle state and map estimates.