Recently, cross-source point cloud registration from different sensors has become a significant research focus. Although current methods have advanced homogenous point cloud registration, challenges persist in the cross-source domain due to varying point cloud densities from different sensors and missing points caused by different viewing angles, which have hindered its development. To address these issues, we propose HybridFusion, a novel algorithm designed specifically for cross-source point cloud registration in outdoor large-scale scenes, accommodating various sensors and viewing angles. Due to the unique characteristics of point clouds, it is not a singular module, but rather a coarse-to-fine process. To extract similarity information from cross-source point clouds, local patches of the point cloud are subjected to similarity matching. Subsequently, precise alignment is performed using their distinctive features, including 2D boundary points. Finally, the poses obtained from multiple patches are fused to achieve the final registration. Our proposed approach is extensively evaluated through both qualitative and quantitative experiments with existing methods. Additionally, a novel metric for point cloud completion is introduced. The results establish our method as the state-of-the-art solution for cross-source point cloud registration, with a remarkable 70% increase in accuracy compared to recent approaches.
Accurate self-localization and mutual state estimation are essential for autonomous aerial swarm operations in cooperative exploration, target tracking, and search-and-rescue missions. However, achieving reliable formation positioning in GNSS-denied environments remains a significant challenge. This paper proposes a UAV formation positioning system that integrates inertial navigation with data link-based relative measurements to improve positioning accuracy. Each UAV independently estimates its flight state in real time using onboard IMU data through an inertial navigation fusion method. The estimated states are then transmitted to other UAVs in the formation via a data link, which also provides relative position measurements. Upon receiving data link information, each UAV filters erroneous measurements, time aligns them with its state estimates, and constructs a relative pose optimization factor graph for real-time state estimation. Furthermore, a data selection strategy and a sliding window algorithm are implemented to control data accumulation and mitigate inertial navigation drift. The proposed method is validated through both simulations and real-world two-UAV formation flight experiments. The experimental results demonstrate that the system achieves a reduction in positioning error compared to using data link measurements alone. This approach provides a robust and reliable solution for maintaining precise relative positioning in formation flight without reliance on GNSS.
To address the inherent scale ambiguity and positioning drift in monocular visual Simultaneous Localization and Mapping (SLAM), this paper proposes a novel localization method that integrates monocular visual SLAM with Ultra-Wideband (UWB) ranging information. This method enables high-precision localization for unmanned aerial vehicles (UAVs) in complex environments without global navigation information. The proposed framework, IVU-AutoNav, relies solely on distance measurements between a fixed UWB anchor and the UAV’s UWB device. Initially, it jointly solves for the position of the UWB anchor and the scale factor of the SLAM system using the scale-ambiguous SLAM data and ranging information. Subsequently, a pose optimization equation is formulated, which integrates visual reprojection errors and ranging errors, to achieve precise localization with a metric scale. Furthermore, a global optimization process is applied to enhance the global consistency of the localization map and optimize the positions of the UWB anchors and scale factor. The proposed approach is validated through both simulation and experimental studies, demonstrating its effectiveness. Experimental results show a scale error of less than 1.8% and a root mean square error of 0.23 m, outperforming existing state-of-the-art visual SLAM systems. These findings underscore the potential and efficacy of the monocular visual-UWB coupled SLAM method in advancing UAV navigation and localization capabilities.