RESUMO
This paper proposes a method for determining a pedestrian's indoor location based on an UWB (ultra-wideband) and vison fusion algorithm. Firstly, an UWB localization algorithm based on EKF (extended Kalman filter) is proposed, which can achieve indoor positioning accuracy of 0.3 m. Secondly, a method to solve scale ambiguity and repositioning of the monocular ORB-SLAM (oriented fast and rotated brief-simultaneous localization and mapping) algorithm based on EKF is proposed, which can calculate the ambiguity in real time and can quickly reposition when the vision track fails. Lastly, two experiments were carried out, one in a corridor with sparse texture and the other with the light brightness changing frequently. The results show that the proposed scheme can reliably achieve positioning accuracy on the order of 0.2 m; with the combination of algorithms, the scale ambiguity of monocular ORB-Slam can be solved, with the failed vision trace repositioned by UWB, and the positioning accuracy of UWB can be improved, making it suitable for pedestrian location in indoor environments with sparse texture and frequent light brightness changes.
RESUMO
This paper propose a scheme for indoor pedestrian location, based on UWB (Ultra Wideband)/PDR (Pedestrian Dead Reckoning) and Floor Map data. Firstly, a robust algorithm that uses Tukey weight factor and a pathological parameter for UWB positioning is proposed. The ill-conditioned position problem is solved for a scene where UWB anchors are placed on the same elevation of a narrow corridor. Secondly, a heading angle-computed strategy of PDR is put forward. According to the UWB positioning results, the location of pedestrians is mapped to the Floor Map, and 16 possible azimuth directions with 22.5° interval in this position are designed virtually. Compared to the heading angle of PDR, the center direction of the nearest interval is adopted as the heading. However, if the difference between the head angles of PDR and the nearest map direction is less than five degrees, the heading angle of PDR is regarded as the moving heading. Thirdly, an EKF (Extended Kalman Filter) algorithm is suggested for UWB/PDR/Floor Map fusion. By utilizing the positioning results of UWB, PDR, and the possible heading angle of Floor Map, high precision positioning results are acquired. Finally, two experimental scenarios are designed in a narrow corridor and computer room at a university. The accuracy of pedestrian positioning when all the data are available is verified in the first scenario; the positioning accuracy of a situation where part of UWB is unlock is verified in the second scenario. The results show that the proposed scheme can reliably achieve decimeter-level positioning.
RESUMO
In this paper, a new emergency positioning technique is proposed based on ad hoc GNSS/UWB (Global Navigation Satellite System/Ultra-Wideband) network. The main innovations of the program are reflected in two aspects. First of all, a unified coordinate frame for indoor and outdoor environments is constructed dynamically with GNSS/UWB integration. In the outdoor environments, the high accuracy positioning can be achieved with GNSS/UWB equipment. The high-accuracy indoor coordinate is obtained by measuring the range observations between adjacent network nodes and outdoor GNSS/UWB nodes, and the range information of the UWB network is transmitted to the cloud server center. A network adjustment algorithm is proposed to improve the positioning accuracy of the UWB network. Secondly, a UWB indoor location algorithm based on robust EKF (Extended Kalman Filter) is proposed. By analyzing the transfer characteristics of gross error in EKF model, a new robust EKF model is established. The model is constructed based on the statistical characteristics of redundant observation components and prediction residual. The robust equivalent gain matrix is constructed, and the robust positioning solution of UWB is obtained with iteration. The global test is carried out first to further improve the real-time operation efficiency. Finally, a field indoor and outdoor seamless positioning experiment was carried out to verify the effectiveness of the proposed algorithm. The results show that the positioning accuracy of UWB emergency network nodes (anchors) can reach 0.35 m. Based on the network, the positioning accuracy of the tag can reach 0.38 m by applying the improved robust EKF positioning algorithm, which is improved by 20.83% and 73.43% compared with standard EKF and least square method, respectively.
RESUMO
Inertial Navigation System (INS) is often combined with Global Navigation Satellite System (GNSS) to increase the positioning accuracy and continuity. In complex urban environments, GNSS/INS integrated systems suffer not only from dynamical model errors but also GNSS observation gross errors. However, it is hard to distinguish dynamical model errors from observation gross errors because the observation residuals are affected by both of them in a loosely-coupled integrated navigation system. In this research, an optimal Radial Basis Function (RBF) neural network-enhanced adaptive robust Kalman filter (KF) method is proposed to isolate and mitigate the influence of the two types of errors. In the proposed method, firstly a test statistic based on Mahalanobis distance is treated as judging index to achieve fault detection. Then, an optimal RBF neural network strategy is trained on-line by the optimality principle. The network's output will bring benefits in recognizing the above two kinds of filtering fault and the system is able to choose a robust or adaptive Kalman filtering method autonomously. A field vehicle test in urban areas with a low-cost GNSS/INS integrated system indicates that two types of errors simulated in complex urban areas have been detected, distinguished and eliminated with the proposed scheme, success rate reached up to 92%. In particular, we also find that the novel neural network strategy can improve the overall position accuracy during GNSS signal short-term outages.
RESUMO
Precise Point Positioning (PPP) makes use of the undifferenced pseudorange and carrier phase measurements with ionospheric-free (IF) combinations to achieve centimeter-level positioning accuracy. Conventionally, the IF ambiguities are estimated as float values. To improve the PPP positioning accuracy and shorten the convergence time, the integer phase clock model with between-satellites single-difference (BSSD) operation is used to recover the integer property. However, the continuity and availability of stand-alone PPP is largely restricted by the observation environment. The positioning performance will be significantly degraded when GPS operates under challenging environments, if less than five satellites are present. A commonly used approach is integrating a low cost inertial sensor to improve the positioning performance and robustness. In this study, a tightly coupled (TC) algorithm is implemented by integrating PPP with inertial navigation system (INS) using an Extended Kalman filter (EKF). The navigation states, inertial sensor errors and GPS error states are estimated together. The troposphere constrained approach, which utilizes external tropospheric delay as virtual observation, is applied to further improve the ambiguity-fixed height positioning accuracy, and an improved adaptive filtering strategy is implemented to improve the covariance modelling considering the realistic noise effect. A field vehicular test with a geodetic GPS receiver and a low cost inertial sensor was conducted to validate the improvement on positioning performance with the proposed approach. The results show that the positioning accuracy has been improved with inertial aiding. Centimeter-level positioning accuracy is achievable during the test, and the PPP/INS TC integration achieves a fast re-convergence after signal outages. For troposphere constrained solutions, a significant improvement for the height component has been obtained. The overall positioning accuracies of the height component are improved by 30.36%, 16.95% and 24.07% for three different convergence times, i.e., 60, 50 and 30 min, respectively. It shows that the ambiguity-fixed horizontal positioning accuracy has been significantly improved. When compared with the conventional PPP solution, it can be seen that position accuracies are improved by 19.51%, 61.11% and 23.53% for the north, east and height components, respectively, after one hour convergence through the troposphere constraint fixed PPP/INS with adaptive covariance model.
RESUMO
The integration of Global Navigation Satellite Systems (GNSS) carrier phases with Inertial Navigation System (INS) measurements is essential to provide accurate and continuous position, velocity and attitude information, however it is necessary to fix ambiguities rapidly and reliably to obtain high accuracy navigation solutions. In this paper, we present the notion of combining the Global Positioning System (GPS), the BeiDou Navigation Satellite System (BDS) and low-cost micro-electro-mechanical sensors (MEMS) inertial systems for reliable navigation. An adaptive multipath factor-based tightly-coupled (TC) GPS/BDS/INS integration algorithm is presented and the overall performance of the integrated system is illustrated. A twenty seven states TC GPS/BDS/INS model is adopted with an extended Kalman filter (EKF), which is carried out by directly fusing ambiguity fixed double-difference (DD) carrier phase measurements with the INS predicted pseudoranges to estimate the error states. The INS-aided integer ambiguity resolution (AR) strategy is developed by using a dynamic model, a two-step estimation procedure is applied with adaptively estimated covariance matrix to further improve the AR performance. A field vehicular test was carried out to demonstrate the positioning performance of the combined system. The results show the TC GPS/BDS/INS system significantly improves the single-epoch AR reliability as compared to that of GPS/BDS-only or single satellite navigation system integrated strategy, especially for high cut-off elevations. The AR performance is also significantly improved for the combined system with adaptive covariance matrix in the presence of low elevation multipath related to the GNSS-only case. A total of fifteen simulated outage tests also show that the time to relock of the GPS/BDS signals is shortened, which improves the system availability. The results also indicate that TC integration system achieves a few centimeters accuracy in positioning based on the comparison analysis and covariance analysis, even in harsh environments (e.g., in urban canyons), thus we can see the advantage of positioning at high cut-off elevations that the combined GPS/BDS brings.