Integrated Sensing and Communication (ISAC) has the potential to enhance both energy and spectral efficiency in modern communication systems. Although Probability Hypothesis Density (PHD)-based Simultaneous Localization and Mapping (SLAM) is a key algorithm for positioning and environmental mapping in ISAC, the advantages of multi-base-station (multi-BS) fusion remain underexplored, despite the considerable attention given to multi-sensor and multi-user data fusion in existing research. This paper leverages the distinct roles of Line-of-Sight (LoS) and Non-Line-of-Sight (NLoS) channel parameters, employing LoS for agent localization and NLoS for environment mapping. An Extended Kalman Filter (EKF) framework is proposed to fuse LoS path angle parameters for localization, for which the corresponding Cramér-Rao Lower Bound (CRLB) is derived. To facilitate landmark mapping, a virtual reference point (VRP) is introduced to model reflecting surfaces consistently across base stations (BSs), replacing the conventional approach of using multiple virtual anchors for multiple BSs. Furthermore, map fusion algorithms are developed to address the challenges of merging PHD-SLAM maps with varying observation quality and overlapping fields of view. To reduce the computational complexity of particle-based PHD-SLAM, agent location estimates derived from EKF fusion are used as priors, significantly improving particle efficiency and enabling the unified exploitation of LoS and NLoS data for comprehensive situational awareness. Simulation and experimental results confirm that the proposed EKF-based LoS fusion strategy significantly improves sensing performance while maintaining low computational overhead.

Simultaneous localization and mapping (SLAM) plays a critical role in integrated sensing and communication (ISAC) systems for sixth-generation (6G) millimeter-wave (mmWave) networks, enabling environmental awareness and precise user equipment (UE) positioning. While cooperative multi-user SLAM has demonstrated potential in leveraging distributed sensing, its application within multi-modal ISAC systems remains limited, particularly in terms of theoretical modeling and communication-layer integration. This paper proposes a novel multi-modal SLAM framework that addresses these limitations through three key contributions. First, a Bayesian estimation framework is developed for cooperative multi-user SLAM, along with a two-stage algorithm for robust radio map construction under dynamic and heterogeneous sensing conditions. Second, a multi-modal localization strategy is introduced, fusing SLAM results with camera-based multi-object tracking and inertial measurement unit (IMU) data via an error-aware model, significantly improving UE localization in multi-user scenarios. Third, a sensing-aided beam management scheme is proposed, utilizing global radio maps and localization data to generate UE-specific prior information for beam selection, thereby reducing inter-user interference and enhancing downlink spectral efficiency. Simulation results demonstrate that the proposed system improves radio map accuracy by up to 60%, enhances localization accuracy by 37.5%, and significantly outperforms traditional methods in both indoor and outdoor environments.

The advancement of millimeter-wave communication technology heralds new sensing capabilities. By leveraging channel multipath parameter estimates, we can harness simultaneous localization and mapping (SLAM) for precise user equipment (UE) localization and radio map construction in 6 G communication systems. Particularly in multi-UE scenarios, SLAM empowers base stations to amalgamate the local radio maps of various UEs efficiently. This study introduces a novel Bayesian framework specifically designed for multi-UE SLAM, complemented by a tailored factor graph. We also unveil a two-stage multi-UE SLAM algorithm. Our simulation results reveal that this algorithm substantially enhances radio map construction accuracy by $\mathbf{4 8. 5 \%}$ and UE localization accuracy by $13.5 \%$, outperforming single-UE cases. Moreover, the algorithm demonstrates remarkable adaptability to environmental changes, showcasing its potential for long-term evolution in dynamic settings.

Simultaneous localization and mapping (SLAM) is a key technology that provides user equipment (UE) tracking and environment mapping services, enabling the deep integration of sensing and communication. The millimeter-wave (mmWave) communication, with its larger bandwidths and antenna arrays, inherently facilitates more accurate delay and angle measurements than sub-6 GHz communication, thereby providing opportunities for SLAM. However, none of the existing works have realized the SLAM function under the 5G new radio (NR) standard due to specification and hardware constraints. In this study, we investigate how 5G mmWave communication systems can achieve situational awareness without changing the transceiver architecture and 5G NR standard. We implement 28-GHz mmWave transceivers that deploy OFDM-based 5G NR waveform with 160-MHz channel bandwidth, and we realize beam management following the 5G NR. Furthermore, we develop an efficient successive cancellation-based angle extraction approach to obtain angles of arrival and departure from the reference signal received power measurements. On the basis of angle measurements, we propose an angle-only SLAM algorithm to track UE and map features in the radio environment. Thorough experiments and ray tracing-based computer simulations verify that the proposed angle-based SLAM can achieve submeter-level localization and mapping accuracy with a single base station and without the requirement of strict time synchronization. Our experiments also reveal many propagation properties critical to the success of SLAM in 5G mmWave communication systems.

The millimeter-wave (mmWave) communication technology, which employs large-scale antenna arrays, enables inherent sensing capabilities. Simultaneous localization and mapping (SLAM) can utilize channel multipath angle estimates to realize integrated sensing and communication design in 6G communication systems. However, existing works have ignored the significant overhead required by the mmWave beam management when implementing SLAM with angle estimates. This study proposes a joint beam management and SLAM design that utilizes the strong coupling between the radio map and channel multipath for simultaneous beam management, localization, and mapping. In this approach, we first propose a hierarchical sweeping and sensing service design. The path angles are estimated in the hierarchical sweeping, enabling angle-based SLAM with the aid of an inertial measurement unit (IMU) to realize sensing service. Then, feature-aided tracking is proposed that utilizes prior angle information generated from the radio map and IMU. Finally, a switching module is introduced to enable flexible switching between hierarchical sweeping and feature-aided tracking. Simulations show that the proposed joint design can achieve sub-meter level localization and mapping accuracy (with an error < 0.5 m). Moreover, the beam management overhead can be reduced by approximately 40% in different wireless environments.