High-accuracy localization systems for non-line-of-sight (NLOS) environments have been a popular focus of research on indoor positioning. In particular, the use of ultra-wideband (UWB) technology for ...ranging is emerging as an effective method of indoor localization due to its high accuracy. To improve the overall performance of UWB systems, combining UWB technology with an inertial navigation system (INS) is a commonly used indoor positioning approach. However, UWB measurements are affected by outliers under the NLOS propagation of radio signals. In addition, INS tend to suffer from error accumulation without constraints imposed by observations from other sensors. To address these problems, an adaptive robust extended Kalman filter algorithm based on tightly coupled UWB/INS/floor map integration is proposed, with which the noise in the UWB observations can be adaptively adjusted. The integrated system performs NLOS identification based on a map line segment matching algorithm; then, abnormal observations are abandoned, or their weights are reduced to prevent the error accumulation of the INS from being incorrectly constrained. Finally, an evaluation based on experimental data shows the significant enhancement achieved with the proposed algorithm based on the integration of UWB technology, an INS and a floor map, which can achieve a 2-D positioning accuracy that corresponds to a root mean square error of 0.27 m. Thus, substantial improvements can be achieved for long-term operation in NLOS environments using the proposed integration scheme.
Recently, the integration of an inertial navigation system (INS) and the Global Positioning System (GPS) with a two-antenna GPS receiver has been suggested to improve the stability and accuracy in ...harsh environments. As is well known, the statistics of state process noise and measurement noise are critical factors to avoid numerical problems and obtain stable and accurate estimates. In this paper, a modified extended Kalman filter (EKF) is proposed by properly adapting the statistics of state process and observation noises through the innovation-based adaptive estimation (IAE) method. The impact of innovation perturbation produced by measurement outliers is found to account for positive feedback and numerical issues. Measurement noise covariance is updated based on a remodification algorithm according to measurement reliability specifications. An experimental field test was performed to demonstrate the robustness of the proposed state estimation method against dynamic model errors and measurement outliers.
To address the limitations of LiDAR dynamic target detection methods, which often require heuristic thresholding, indirect computational assistance, supplementary sensor data, or postdetection, we ...propose an innovative method based on multidimensional features. Using the differences between the positions and geometric structures of point cloud clusters scanned by the same target in adjacent frame point clouds, the motion states of the point cloud clusters are comprehensively evaluated. To enable the automatic precision pairing of point cloud clusters from adjacent frames of the same target, a double registration algorithm is proposed for point cloud cluster centroids. The iterative closest point (ICP) algorithm is employed for approximate interframe pose estimation during coarse registration. The random sample consensus (RANSAC) and four-parameter transformation algorithms are employed to obtain precise interframe pose relations during fine registration. These processes standardize the coordinate systems of adjacent point clouds and facilitate the association of point cloud clusters from the same target. Based on the paired point cloud cluster, a classification feature system is used to construct the XGBoost decision tree. To enhance the XGBoost training efficiency, a Spearman's rank correlation coefficient-bidirectional search for a dimensionality reduction algorithm is proposed to expedite the optimal classification feature subset construction. After preliminary outcomes are generated by XGBoost, a double Boyer-Moore voting-sliding window algorithm is proposed to refine the final LiDAR dynamic target detection accuracy. To validate the efficacy and efficiency of our method in LiDAR dynamic target detection, an experimental platform is established. Real-world data are collected and pertinent experiments are designed. The experimental results illustrate the soundness of our method. The LiDAR dynamic target correct detection rate is 92.41%, the static target error detection rate is 1.43%, and the detection efficiency is 0.0299 s. Our method exhibits notable advantages over open-source comparative methods, achieving highly efficient and precise LiDAR dynamic target detection.
In 2020, the BeiDou-3 global navigation satellite system (BDS-3) was officially completed and put into service. Currently, network real-time kinematic (RTK) technology is considered the main means ...through which to improve the positioning accuracy of the BeiDou navigation satellite system (BDS). This paper proposes a long-range undifferenced network RTK (URTK) algorithm, based on multi-frequency observation data of the BDS. First, the multi-frequency phase integer ambiguity resolution (AR) model considering atmospheric error parameters is designed, and the multi-frequency phase integer ambiguity of the long-range BDS reference station is determined. Then, the undifferenced integer ambiguity of each reference station is obtained, using linear variation based on the accurately determined phase integer ambiguity between reference stations, and the undifferenced observation error of each reference station is calculated. Considering the weakening spatial correlation of the observation errors between long-range stations, undifferenced classification error corrections of a reference station network are separated, according to different error characteristics. Finally, the inverse distance weighting method is employed to calculate the classification undifferenced error correction of the rover station. The rover station corrects the observation error through applying the undifferenced error correction to achieve high-precision positioning. The measured data of a long-range continuous operation reference station (CORS) network are selected for an experiment. The results show that the proposed algorithm can quickly and accurately realize the resolution of the BDS integer ambiguity of a reference station network and establish an undifferenced area error correction model in order to achieve accurate classification of undifferenced error correction values for a rover station. In China, the BDS-3 is superior to the global positioning system (GPS) in terms of the satellite number, position dilution of precision (PDOP) value, AR success rate, stability, and convergence time. The results show that the AR success rate, stability, and convergence time increase with the operational frequency, and the BDS-3 can achieve centimeter-level positioning of single-system rover stations without relying on the GPS.
High-precision Global Navigation Satellite Systems (GNSS) orbits are critical for real-time clock estimation and precise positioning service; however, the prediction error grows gradually with the ...increasing prediction session. In this study, we present a new efficient precise orbit determination (POD) strategy referred to as the epoch-parallel processing to reduce the orbit update latency, in which a 24-h processing job is split into several sub-sessions that are processed in parallel and then stacked to solve and recover parameters subsequently. With a delicate handling of parameters crossing different sub-sessions, such as ambiguities, the method is rigorously equivalent to the one-session batch solution, but is much more efficient, halving the time-consuming roughly. Together with paralleling other procedures such as orbit integration and using open multi-processing (openMP), the multi-GNSS POD of 120 satellites using 90 stations can be fulfilled within 30 min. The lower update latency enables users to access orbits closer to the estimation part, that is, 30–60-min prediction with a 30-min update latency, which significantly improves the orbit quality. Compared to the hourly updated orbit, the averaged 1D RMS values of predicted orbit in terms of overlap for GPS, GLONASS, Galileo, and BDS MEO are improved by 39%, 35%, 41%, and 37%, respectively, and that of BDS GEO and IGSO satellites is improved by 47%. We also demonstrate that the boundary discontinuities of half-hourly orbit are within 2 cm for the GPS, GLONASS, and Galileo satellites, and for BDS the values are 2.6, 15.5, and 9.8 cm for MEO, GEO, and IGSO satellites, respectively. This method can also be implemented for any batch-based GNSS processing to improve the efficiency.
Reliable absolute positioning is indispensable in long-term positioning systems. Although simultaneous localization and mapping based on light detection and ranging (LiDAR-SLAM) is effective in ...global navigation satellite system (GNSS)-denied environments, it can provide only local positioning results, with error divergence over distance. Ultrawideband (UWB) technology is an effective alternative; however, non-line-of-sight (NLOS) propagation in complex indoor environments severely affects the precision of UWB positioning, and LiDAR-SLAM typically provides more robust results under such conditions. For robust and high-precision positioning, we propose an improved-UWB/LiDAR-SLAM tightly coupled (TC) integrated algorithm. This method is the first to combine a LiDAR point cloud map generated via LiDAR-SLAM with position information from UWB anchors to distinguish between line-of-sight (LOS) and NLOS measurements through obstacle detection and NLOS identification (NI) in real time. Additionally, to alleviate positioning error accumulation in long-term SLAM, an improved-UWB/LiDAR-SLAM TC positioning model is constructed using UWB LOS measurements and LiDAR-SLAM positioning information. Parameter solving using a robust extended Kalman filter (REKF) to suppress the effect of UWB gross errors improves the robustness and positioning performance of the integrated system. Experimental results show that the proposed NI method using the LiDAR point cloud can efficiently and accurately identify UWB NLOS errors to improve the performance of UWB ranging and positioning in real scenarios. The TC integrated method combining NI and REKF achieves better positioning effectiveness and robustness than other comparative methods and satisfactory control of sensor errors with a root-mean-square error of 0.094 m, realizing subdecimeter indoor positioning.
Network RTK (NRTK), one of the primary means of high-precision real-time kinematic positioning (RTK), has been widely used. The key to providing highly accurate positioning is the ambiguity of the ...reference station being correctly fixed, but the atmospheric errors must be handled carefully, which seriously affects the efficiency of ambiguity fixing. This paper aims to improve the efficiency of ambiguity fixing by studying the time-varying characteristics of atmospheric errors. Once reasonable constraints are imposed on atmospheric parameters in the uncombined observation model, it can better fix ambiguity. Atmospheric parameters are estimated by random walk at the reference station, and the power spectral density (PSD) of atmosphere is determined by real-time observations, instead of using empirical values or empirical models that do not consider atmospheric variations. The experimental results showed that the real-time estimated PSD can improve the ambiguity fixing time by 18.4% and the ambiguity fixing success rate for the reference station by 11.7%, compared with using empirical PSD for atmospheric parameters. Unlike general NRTK positioning based on differential error correction values, undifferenced NRTK estimates the integer ambiguity and undifferenced error correction value at a single reference station, ensuring the independence of the error correction value of each reference station, and it can be easily broadcast and received through the network, which is more convenient for realizing high-precision RTK positioning for users.
This paper mainly studies the improvement of the efficiency and out-of-domain reliability of gravity matching navigation for underwater vehicles. To overcome the traversal low-efficiency problem of ...the traditional terrain contour matching (TERCOM) algorithm and improve the positioning reliability of its out-of-domain mismatches, a novel soft-margin local semicircular-domain re-searching model (SLSR) is proposed by integrating the soft-margin circular grid matching (SCGM) mechanism and the local semicircular grid re-matching (LSGR) mechanism. SCGM uses three times the inertial navigation cumulative error and adds the unit grid resolution as the soft margin boundary to generate the soft-margin circular domain, which contributes to reducing in-domain matching grid points and enhancing the matching efficiency of algorithms. Then the optimal matching position in this soft-margin circular domain is obtained by using the optimization principle of matching indices. LSGR is triggered when the optimal matching position of SCGM is located near the soft-margin circular-domain boundary. It employs this optimal matching point as the center and the unit inertial navigation error as the radius to recreate the semicircular local re-searching matched grid domain (termed as semicircular domain). Moreover, the optimal matching point in this semicircular domain is obtained by the matching index optimization principle, and then it is compared and updated to obtain the final best matching position of SLSR. The simulation results show that SCGM and LSGR of the proposed SLSR method can effectively improve the matching efficiency and out-of-domain matching reliability of underwater navigation, respectively. Under the same testing conditions for the tracking starting points from three gravity regions, the number of out-of-domain mismatches of SLSR, compared with TERCOM, are lower up to 92.68%, 90.24% and 98.62%, while the average matching accuracies are relatively improved by 88.37%, 85.48% and 83.66%, which verifies the validity and feasibility of the proposed SLSR model on improving the efficiency and out-of-domain reliability of underwater gravity matching navigation.
Craters on the lunar surface are the most direct method for the study of geological processes and are of great significance to the study of lunar evolution. In order to fill the research gap on small ...craters (diameter less than 3 m), we focus on the small craters around the moving path of the Yutu-2 lunar rover and carry out a 3D reconstruction and geometrical morphology analysis on them. First, a self-calibration model with multiple feature constraints is used to calibrate the navigation camera and obtain the internal and external parameters. Then, the sequence images with overlapping regions from neighboring stations are used to obtain the precise position of the rover through the bundle adjustment (BA) method. After that, a cross-scale cost aggregation for a stereo matching network is proposed to obtain a parallax map, which can further obtain 3D point clouds of the lunar surface. Finally, the indexes of the craters are extracted (diameter D, depth d, and depth–diameter ratio dr), and the different indicators are fitted and analyzed. The results suggest that CscaNet has an anomaly percentage value of 1.73% in the KITTI2015 dataset, and an EPE of 0.74 px in the SceneFlow dataset, both of which are superior to GC-Net, DispNet, and PSMnet, and have higher reconstruction accuracy. The correlation between D and d is high and exhibits a positive correlation, while the correlation between D and dr is low. The geometric morphology expressions of small craters fitted by using D and d are significantly different from the expressions proposed by other scholars for large craters. This study provides a priori knowledge for the subsequent Von Karmen crater survey mission in the SPA Basin.
In this study, we propose a tightly coupled integrated method of ultrawideband (UWB) and light detection and ranging (LiDAR)-based simultaneous localization and mapping (SLAM) for global navigation ...satellite system (GNSS)-denied environments to achieve high-precision positioning with reduced drift. Specifically, we focus on non-line-of-sight (NLOS) identification and correction. In previous work, we utilized laser point cloud maps to identify and exclude NLOS measurements in real time to attenuate their severe effects on the integrated system. However, the complete exclusion of NLOS measurements will likely lead to deterioration in the dilution of precision (DOP) for the remaining line-of-sight (LOS) anchors, counterproductively introducing large positioning errors into the integrated system. Therefore, this study considers the ranging accuracy and geometric distribution of UWB anchors and innovatively proposes an NLOS correction method using a grey prediction model. For a poor line-of-sight (LOS) anchor geometric distribution, the grey prediction model is used to fill in the gaps by predicting the NLOS measurements based on historical measurements. Including the corrected measurements effectively improves the original poor geometric configuration, improving the system positioning accuracy. Since conventional filtering-based fusion methods are exceedingly sensitive to measurement outliers, we use state-of-the-art factor graph optimization (FGO) to tightly integrate the UWB measurements (LOS and corrected measurements) with LiDAR-SLAM. The temporal correlation between measurements and the redundant system measurements effectively enhance the robustness of the integrated system. Experimental results show that the tightly coupled integrated method combining NLOS correction and FGO improves the positioning accuracy under a poor geometric distribution, increases the system availability, and achieves better positioning than filtering-based fusion methods with a root-mean-square error of 0.086 m in the plane direction, achieving subdecimeter indoor high-precision positioning.