Autonomous navigation and localization are the foundations of unmanned intelligent systems, therefore, continuous, stable, and reliable position services in unknown environments are especially important for autonomous navigation and localization. Aiming at the problem where GNSS cannot continuously localize in complex environments due to weak signals, poor penetration ability, and susceptibility to interference and that visual navigation and localization are only relative, this paper proposes a GNSS-aided visual dynamic localization method that can provide global localization services in unknown environments. Taking the three frames of images and their corresponding GNSS coordinates as the constraint data, the GNSS coordinate system and world coordinate system transformation matrix are obtained through horn coordinate transformation, and the relative positions of the subsequent image sequences in the world coordinate system are obtained through epipolar geometry constraints, homography matrix transformations, and 2D–3D position and orientation solving, which ultimately yields the global position data of unmanned carriers in GNSS coordinate systems when GNSS is temporarily unavailable. Both the dataset validation and measured data validation showed that the GNSS initial-assisted positioning algorithm could be applied to situations where intermittent GNSS signals exist, and it can provide global positioning coordinates with high positioning accuracy in a short period of time; however, the algorithm would drift when used for a long period of time. We further compared the errors of the GNSS initial-assisted positioning and GNSS continuous-assisted positioning systems, and the results showed that the accuracy of the GNSS continuous-assisted positioning system was two to three times better than that of the GNSS initial-assisted positioning system, which proved that the GNSS continuous-assisted positioning algorithm could maintain positioning accuracy for a long time and it had good reliability and applicability in unknown environments.
Abstract The unmanned aerial vehicle (UAV) and the unmanned ground vehicle (UGV) can complete complex tasks through information sharing and ensure the mission execution capability of multiple unmanned carrier platforms. At the same time, cooperative navigation can use the information interaction between multi‐platform sensors to improve the relative navigation and positioning accuracy of the entire system. Aiming at the problem of deviation of the system model due to gross errors in sensor measurement data or strong manoeuvrability in complex environments, a robust and adaptive UGV‐UAV relative navigation and positioning algorithm is proposed. In this paper, the relative navigation and positioning of UGV‐UAV is studied based on inertial measurement unit (IMU)/Vision. Based on analyzing the relative kinematics model and sensor measurement model, a leader (UGV)‐follow (UAV) relative navigation model is established. In the implementation of the relative navigation and positioning algorithm, the robust adaptive algorithm and the non‐linear Kalman filter (extended Kalman filter [EKF]) algorithm are combined to dynamically adjust the system state parameters. Finally, a mathematical simulation of the accompanying and landing process in the UGV‐UAV cooperative scene is carried out. The relative position, velocity and attitude errors calculated by EKF, Robust‐EKF and Robust‐Adaptive‐EKF algorithms are compared and analyzed by simulating two cases where the noise obeys the Gaussian distribution and the non‐Gaussian distribution. The results show that under the non‐Gaussian distribution conditions, the accuracy of the Robust‐Adaptive‐EKF algorithm is improved by about two to three times compared with the EKF and Robust‐EKF and can almost reach the relative navigation accuracy under the Gaussian distribution conditions. The robust self‐adaptive relative navigation and positioning algorithm proposed in this paper has strong adaptability to the uncertainty and deviation of system modelling in complex environments, with higher accuracy and stronger robustness.
With the increasingly widespread application of UAV intelligence, the need for autonomous navigation and positioning is becoming more and more important. To solve the problem that UAV cannot perform localization in complex scenes, a new multi-source fusion framework factor graph optimization algorithm is used for UAV localization state estimation in this paper, which is based on IMU/GNSS/VO multi-source sensors. Based on the factor graph model and the iSAM incremental inference algorithm, a multi-source fusion model of IMU/GNSS/VO is established, including the IMU pre-integration factor, IMU bias factor, GNSS factor, and VO factor. Mathematical simulations and validations on the EuRoC dataset show that, when the selected sliding window size is 30, the factor graph optimization (FGO) algorithm can not only meet the requirements of real time and accuracy at the same time, but it also achieves a plug-and-play function in the event of local sensor failures. Finally, compared with the traditional federated Kalman algorithm and the adaptive federated Kalman algorithm, the positioning accuracy of the FGO algorithm in this paper is improved by 1.5-2-fold, and can effectively improve autonomous navigation system robustness and flexibility in complex scenarios. Moreover, the multi-source fusion framework in this paper is a general algorithm framework that can satisfy other scenarios and other types of sensor combinations.
With the widespread development of multiple sensors for UGVs, the multi-source fusion-navigation system, which overcomes the limitations of the use of a single sensor, is becoming increasingly important in the field of autonomous navigation for UGVs. Because federated filtering is not independent between the filter-output quantities, owing to the use of the same state equation in each of the local sensors, a new kinematic and static multi-source fusion-filtering algorithm based on the error-state Kalman filter (ESKF) is proposed in this paper for the positioning-state estimation of UGVs. The algorithm is based on INS/GNSS/UWB multi-source sensors, and the ESKF replaces the traditional Kalman filter in kinematic and static filtering. After constructing the kinematic EKSF based on GNSS/INS and the static ESKF based on UWB/INS, the error-state vector solved by the kinematic ESKF was injected and set to zero. On this basis, the kinematic ESKF filter solution was used as the state vector of the static ESKF for the rest of the static filtering in a sequential form. Finally, the last static ESKF filtering solution was used as the integral filtering solution. Through mathematical simulations and comparative experiments, it is demonstrated that the proposed method converges quickly, and the positioning accuracy of the method was improved by 21.98% and 13.03% compared to the loosely coupled GNSS/INS and the loosely coupled UWB/INS navigation methods, respectively. Furthermore, as shown by the error-variation curves, the main performance of the proposed fusion-filtering method was largely influenced by the accuracy and robustness of the sensors in the kinematic ESKF. Furthermore, the algorithm proposed in this paper demonstrated good generalizability, plug-and-play, and robustness through comparative analysis experiments.
Multi-source autonomous navigation-dependable decision making has a crucial impact on the overall performance of navigation systems. To solve the problem of overall system robustness caused by the intelligent-dependable decision making difficulties of navigation systems from different sources, on an unmanned ground vehicle (UGV) as the carrier, a new multi-source fusion algorithm based on cost function is proposed in this paper. The algorithm uses INS/GNSS/UWB as the sensor data source and is solved by using error-state Kalman filter (ESKF)-based kinematic and static multi-source filtering. After the RSS, positioning residual and positioning stability are selected as parameters and weighted, and the cost function is constructed. The structure of the filtering can be adapted according to the cost function in complex environments. Through mathematical simulation and comparative experiments, the positioning accuracy of the algorithm is improved by 75.9% and 74.44%, respectively, compared to federated filter and traditional ESKF-based kinematic and static filtering. It also improves the reliability, decision-making ability, and robustness of multi-source autonomous navigation system.
As an important component of autonomous intelligent systems, the research on autonomous positioning algorithms used by UAVs is of great significance. In order to resolve the problem whereby the GNSS signal is interrupted, and the visual sensor lacks sufficient feature points in complex scenes, which leads to difficulties in autonomous positioning, this paper proposes a new robust adaptive positioning algorithm that ensures the robustness and accuracy of autonomous navigation and positioning in UAVs. On the basis of the combined navigation model of vision/inertial navigation and satellite/inertial navigation, based on ESKF, a multi-source fusion model based on a federated Kalman filter is here established. Furthermore, a robust adaptive localization algorithm is proposed, which uses robust equivalent weights to estimate the sub-filters, and then uses the sub-filter state covariance to adaptively assign information sharing coefficients. After simulation experiments and dataset verification, the results show that the robust adaptive algorithm can effectively limit the impact of gross errors in observations and mathematical model deviations and can automatically update the information sharing coefficient online according to the sub-filter equivalent state covariance. Compared with the classical federated Kalman algorithm and the adaptive federated Kalman algorithm, our algorithm can meet the real-time requirements of navigation, and the accuracy of position, velocity, and attitude measurement is improved by 2-3 times. The robust adaptive localization algorithm proposed in this paper can effectively improve the reliability and accuracy of autonomous navigation systems in complex scenes. Moreover, the algorithm is general-it is not intended for a specific scene or a specific sensor combination- and is applicable to individual scenes with varied sensor combinations.
In this paper, an improved cubature Kalman filtering (CKF) is proposed using the Sigmoid function to address the problems of positioning accuracy degradation and large deviations in ultra-wideband (UWB) indoor positioning in non-line-of-sight environments. The improved CKF is based on the squared range difference (SRD) model of the time difference of arrival (TDOA) algorithm. The inaccurate impact of model estimation under non-Gaussian noise is reduced by updating the measurement noise matrix in real time. The covariance matrix is estimated using singular value decomposition (SVD) to solve the problem of degraded state estimation performance. The filtering effect of the improved CKF algorithm is evaluated by referring to the checkpoints in the dynamic trajectory. The experimental results show that the proposed algorithm effectively mitigates the impact of UWB ranging outliers in the occluded experimental environment, which makes the dynamic positioning trajectory smoother, better fitted, and more stable. The algorithm improves the positioning accuracy by up to 39.29% compared with the SRD model used alone.
'/%3e%3cuse xlink:href='%23a' transform='rotate(23.036 .093 25.536)'/%3e%3cuse xlink:href='%23a' transform='rotate(45.87 1.273 16.18)'/%3e%3cuse xlink:href='%23a' transform='rotate(69.945 .996 12.078)'/%3e%3cuse xlink:href='%23a' transform='rotate(20.66 -19.689 31.932)'/%3e%3c/svg%3e)
'/%3e%3cuse xlink:href='%23a' transform='translate(288.889 -214.211)'/%3e%3cuse xlink:href='%23a' transform='translate(108 342.749)'/%3e%3cuse xlink:href='%23a' transform='translate(469.189 342.749)'/%3e%3c/svg%3e)