The accurate initial attitude is essential to affect the navigation result of Rotary Strapdown Inertial Navigation System (SINS), which is usually calculated by initial alignment. But marine mooring Rotary SINS has to withstand dynamic disturbance, such as the interference angular velocities and accelerations caused by surge and sway. In order to overcome the limit of dynamic disturbance under the marine mooring condition, an alignment method using novel adaptive Kalman filter for marine mooring Rotary SINS is developed in this paper. This alignment method using the gravity in the inertial frame as a reference is discussed to deal with the lineal and angular disturbances. Secondly, the system error model for fine alignment in the inertial frame as a reference is established. Thirdly, PWCS and SVD are used to analyze the observability of the system error model for fine alignment. Finally, a novel adaptive Kalman filter with measurement residual to estimate measurement noise variance is designed. The simulation results demonstrate that the proposed method can achieve better accuracy and stability for marine Rotary SINS.
The distributed SLAM system has a similar estimation performance and requires only one-fifth of the computation time compared with centralized particle filter. However, particle impoverishment is inevitably because of the random particles prediction and resampling applied in generic particle filter, especially in SLAM problem that involves a large number of dimensions. In this paper, particle filter use in distributed SLAM was improved in two aspects. First, we improved the important function of the local filters in particle filter. The adaptive values were used to replace a set of constants in the computational process of importance function, which improved the robustness of the particle filter. Second, an information fusion method was proposed by mixing the innovation method and the number of effective particles method, which combined the advantages of these two methods. And this paper extends the previously known convergence results for particle filter to prove that improved particle filter converges to the optimal filter in mean square as the number of particles goes to infinity. The experiment results show that the proposed algorithm improved the virtue of the DPF-SLAM system in isolate faults and enabled the system to have a better tolerance and robustness.
Fast simultaneous localization and mapping (FastSLAM) is an efficient algorithm for autonomous navigation of mobile vehicle. However, FastSLAM must reconfigure the entire vehicle state equation when the feature points change, which causes an exponential growth in quantities of computation and difficulties in isolating potential faults. In order to overcome these limitations, an improved FastSLAM, based on the distributed structure, is developed in this paper. There are two state estimation parts designed in this improved FastSLAM. Firstly, a distributed unscented particle filter is used to avoid reconfiguring the entire system equation in the vehicle state estimation part. Secondly, in the landmarks estimation part, the observation model is designed as a linear one to update the landmarks states by using the linear observation errors. Then, the convergence of the proposed and improved FastSLAM algorithm is given in the sense of mean square. Finally, the simulation results show that the proposed distributed algorithm could reduce the computational complexity with high accuracy and high fault-tolerance performance.
scite is a Brooklyn-based organization that helps researchers better discover and understand research articles through Smart Citations–citations that display the context of the citation and describe whether the article provides supporting or contrasting evidence. scite is used by students and researchers from around the world and is funded in part by the National Science Foundation and the National Institute on Drug Abuse of the National Institutes of Health.