In this article, we focus on addressing the nonlinear filtering problem with unknown measurement noise covariance and measurement outliers, which may be encountered in the application in strapdown inertial navigation system/global positioning system integrated navigation system. Although the existing methods, such as the adaptive Kalman filter, are widely used in the integrated navigation system, their estimation accuracy is poor, this paper proposes a variational Bayesian-based robust cubature Kalman filter to address this problem, which not only retains the adaptivity when the measurement noise is unknown but also exhibits robustness in the presence of measurement outliers, First, the variational Bayesian method is applied to the estimation of measurement noise, then the maximum correntropy criterion is introduced to replace the minimum mean square error criterion, which improves the robust performance of the filter. The numerical simulation demonstrates that the proposed filter outperforms the existing filters both in estimation accuracy and robustness, and the effectiveness of the proposed filter is verified on the integrated navigation system.

In complex environments, path planning is the key for unmanned aerial vehicles (UAVs) to perform military missions autonomously. This paper proposes a novel algorithm called flight cost-based Rapidly-exploring Random Tree star (FC-RRT*) extending the standard Rapidly-exploring Random Tree star (RRT*) to deal with the safety requirements and flight constraints of UAVs in a complex 3D environment. First, a flight cost function that includes threat strength and path length was designed to comprehensively evaluate the connection between two path nodes. Second, in order to solve the UAV path planning problem from the front-end, the flight cost function and flight constraints were used to inspire the expansion of new nodes. Third, the designed cost function was used to guide the update of the parent node to allow the algorithm to consider both the threat and the length of the path when generating the path. The simulation and comparison results show that FC-RRT* effectively overcomes the shortcomings of standard RRT*. FC-RRT* is able to plan an optimal path that significantly improves path safety as well as maintains has the shortest distance while satisfying flight constraints in the complex environment. This paper has application value in UAV 3D global path planning.

The real-time path planning of unmanned aerial vehicles (UAVs) in dynamic environments with moving threats is a difficult problem. To solve this problem, this paper proposes a time-based rapidly exploring random tree (time-based RRT*) algorithm, called the hierarchical rapidly exploring random tree algorithm based on potential function lazy planning and low-cost optimization (HPO-RRT*). The HPO-RRT* algorithm can guarantee path homotopy optimality and high planning efficiency. This algorithm uses a hierarchical architecture comprising a UAV perception system, path planner, and path optimizer. After the UAV perception system predicts moving threats and updates world information, the path planner obtains the heuristic path. First, the path planner uses the bias sampling method based on the artificial potential field function proposed in this paper to guide sampling to improve the efficiency and quality of sampling. Then, the tree is efficiently extended by the improved time-based lazy collision checking RRT* algorithm to obtain the heuristic path. Finally, a low-cost path optimizer quickly optimizes the heuristic path directly to optimize the path while avoiding additional calculations. Simulation results show that the proposed algorithm outperforms the three existing advanced algorithms in terms of addressing the real-time path-planning problem of UAVs in a dynamic environment.

IMU fault diagnosis and information reconstruction are important to the safety of the autonomous underwater vehicle. To improve the fault tolerance of AUV to IMU faults, an IMU fault diagnosis and information reconstruction method based on the analytical redundancy is proposed in this paper. First, the IMU analytical method is constructed with the help of the autonomous underwater vehicle kinematic model, and the analytical relationship between IMU signal and innovation is given. Next, the t-test method and decoupling matrix method are designed to get fault diagnosis results for gyroscopes and accelerometers. Furthermore, the IMU fault estimation method based on innovation has been designed to estimate IMU faults and realize IMU signal reconstruction. The experiment results demonstrate the effectiveness and efficiency of the proposed method, showing its feasibility for IMU faults.

Aimed at improving upon the disadvantages of the single centralized Kalman filter for integrated navigation, including its fragile robustness and low solution accuracy, a nonlinear double model based on the improved decentralized federated extended Kalman filter (EKF) for integrated navigation is proposed. The multisensor error model is established and simplified in this paper according to the near-ground short distance navigation applications of small unmanned aerial vehicles (UAVs). In order to overcome the centralized Kalman filter that is used in the linear Gaussian system, the improved federated EKF is designed for multisensor-integrated navigation. Subsequently, because of the navigation requirements of UAVs, especially for the attitude solution accuracy, this paper presents a nonlinear double model that consists of the nonlinear attitude heading reference system (AHRS) model and nonlinear strapdown inertial navigation system (SINS)/GPS-integrated navigation model. Moreover, the common state parameters of the nonlinear double model are optimized by the federated filter to obtain a better attitude. The proposed algorithm is compared with multisensor complementary filtering (MSCF) and multisensor EKF (MSEKF) using collected flight sensors data. The simulation and experimental tests demonstrate that the proposed algorithm has a good robustness and state estimation solution accuracy.

Aimed at improving the nonlinear integrated navigation solution performance of multiple low-cost sensors fusion, this paper presents a multilayer loosely-coupled, local-global, and step-optimized MF5DCKF (Multisensor Federated fifth-degree Cubature Kalman filter) state estimation algorithm for the small unmanned aerial vehicle (UAV). This method establishes a multilayer nonlinear integrated navigation model composed of the nonlinear attitude and heading reference system (AHRS) error model, strapdown inertial navigation system/global positioning system (SINS/GPS) error model, and strapdown inertial navigation system/barometer (SINS/BARO) error model to enhance the robustness and richness of the navigation module. Further, based on the above navigation models, a loosely-coupled error state fusion frame is designed to obtain the local convergent state vector. Simultaneously, a three-layer fifth-degree Cubature Kalman filter is proposed to improve the local state estimation accuracy. Subsequently, to optimize the estimated local state, this paper presents a novel distributed MF5DCKF scheme fusing the local state vector to calculate the global optimal state parameters in a step-optimized process. The experimental flight test results show that the proposed algorithm achieves a higher state solution accuracy and a better convergent performance compared with some conventional multisensor fusion algorithms. The new algorithm framework can provide applicability and reliability for the small UAV during the flight.