To improve the ability of autonomous navigation for Unmanned Surface Vehicles (USVs), multi-sensor integrated navigation based on Inertial Navigation System (INS), Celestial Navigation System (CNS) and Doppler Velocity Log (DVL) is proposed. The CNS position and the DVL velocity are introduced as the reference information to correct the INS divergence error. The autonomy of the integrated system based on INS/CNS/DVL is much better compared with the integration based on INS/GNSS alone. However, the accuracy of DVL velocity and CNS position are decreased by the measurement noise of DVL and bad weather, respectively. Hence, the INS divergence error cannot be estimated and corrected by the reference information. To resolve the problem, the Adaptive Information Sharing Factor Federated Filter (AISFF) is introduced to fuse data. The information sharing factor of the Federated Filter is adaptively adjusted to maintaining multiple component solutions usable as back-ups, which can improve the reliability of overall system. The effectiveness of this approach is demonstrated by simulation and experiment, the results show that for the INS/CNS/DVL integrated system, when the DVL velocity accuracy is decreased and the CNS cannot work under bad weather conditions, the INS/CNS/DVL integrated system can operate stably based on the AISFF method.

Pedestrian-positioning technology based on the foot-mounted micro inertial measurement unit (MIMU) plays an important role in the field of indoor navigation and has received extensive attention in recent years. However, the positioning accuracy of the inertial-based pedestrian-positioning method is rapidly reduced because of the relatively low measurement accuracy of the measurement sensor. The zero-velocity update (ZUPT) is an error correction method which was proposed to solve the cumulative error because, on a regular basis, the foot is stationary during the ordinary gait; this is intended to reduce the position error growth of the system. However, the traditional ZUPT has poor performance because the time of foot touchdown is short when the pedestrians move faster, which decreases the positioning accuracy. Considering these problems, a forward and reverse calculation method based on the adaptive zero-velocity interval adjustment for the foot-mounted MIMU location method is proposed in this paper. To solve the inaccuracy of the zero-velocity interval detector during fast pedestrian movement where the contact time of the foot on the ground is short, an adaptive zero-velocity interval detection algorithm based on fuzzy logic reasoning is presented in this paper. In addition, to improve the effectiveness of the ZUPT algorithm, forward and reverse multiple solutions are presented. Finally, with the basic principles and derivation process of this method, the MTi-G710 produced by the XSENS company is used to complete the test. The experimental results verify the correctness and applicability of the proposed method.

Accurate heading is one of the critical issues in vehicle navigation. To achieve accurate and stable navigation in all weather conditions, a combination of local sensors, such as gyroscopes, and global sensors, such as magnetometers, is typically used to fuse information. This information fusion enables the system to achieve both local accuracy and global, drift-free heading estimation during long-term navigation. The sensitivity of magnetometers to various coupled magnetic interferences often leads to a decrease in the accuracy of heading estimation. To enhance the system’s anti-interference ability, this article proposes a method for magnetometer/gyroscope integration based on random magnetic interference detection. First, random magnetic interference is separated from constant magnetic interference, and a linear model using redundant information from magnetometer/gyroscope is established, which can be processed by Pearson correlation coefficient (PCC) to complete random magnetic interference detection across all motion states. Then, random magnetic interference data are eliminated to improve constant magnetic interference calibration based on rectangular path. Finally, adaptive Kalman filtering (AKF) is implemented based on the random magnetic interference detection results to improve the accuracy of magnetometer/gyroscope heading estimation. The effectiveness of the proposed algorithm is verified by actual test.

Foot-mounted Inertial Pedestrian-Positioning Systems (FIPPSs) based on Micro Inertial Measurement Units (MIMUs), have recently attracted widespread attention with the rapid development of MIMUs. The can be used in challenging environments such as firefighting and the military, even without augmenting with Global Navigation Satellite System (GNSS). Zero Velocity Update (ZUPT) provides a solution for the accumulated positioning errors produced by the low precision and high noise of the MIMU, however, there are some problems using ZUPT for FIPPS, include fast-initial alignment and unobserved heading misalignment angle, which are addressed in this paper. Our first contribution is proposing a fast-initial alignment algorithm for foot-mounted inertial/magnetometer pedestrian positioning based on the Adaptive Gradient Descent Algorithm (AGDA). Considering the characteristics of gravity and Earth’s magnetic field, measured by accelerometers and magnetometers, respectively, when the pedestrian is standing at one place, the AGDA is introduced as the fast-initial alignment. The AGDA is able to estimate the initial attitude and enhance the ability of magnetic disturbance suppression. Our second contribution in this paper is proposing an inertial/magnetometer positioning algorithm based on an adaptive Kalman filter to solve the problem of the unobserved heading misalignment angle. The algorithm utilizes heading misalignment angle as an observation for the Kalman filter and can improve the accuracy of pedestrian position by compensating for magnetic disturbances. In addition, introducing an adaptive parameter in the Kalman filter is able to compensate the varying magnetic disturbance for each ZUPT instant during the walking phase of the pedestrian. The performance of the proposed method is examined by conducting pedestrian test trajectory using MTi-G710 manufacture by XSENS. The experimental results verify the effectiveness and applicability of the proposed method.

Foot-mounted inertial pedestrian positioning (FIPP) plays an important role for facilitating pedestrian activities. It is suitable for indoor environment applications where global navigation satellite systems are unavailable such as during firefighting and military actions. However, the positioning error of FIPP can increase rapidly due to the measurement noise of the sensors. Zero Velocity Update (ZUPT) is an error correction method proposed to solve this accumulative error. However, the heading misalignment angle, which results in a continuous increase in the positioning error, cannot be estimated by ZUPT. In order to solve this problem, the improved ZUPT based on the Improved Attitude Algorithm (IAA) according to accelerometer measurements is proposed in this paper. When a pedestrian is in the stance phase, the horizontal attitude is estimated by using accelerometer measurements. According to the relationship between the heading misalignment angle and horizontal attitude, the heading misalignment angle is obtained by a series of mathematical derivations. By taking the velocity error and the attitude misalignment angle as observations, the heading misalignment angle and positioning error can be estimated and compensated for through the Kalman filter. Finally, we use MTI-G710 sensor manufactured by XSENS for the actual test and the experiment results show that the proposed method is effectively correct.

In the process of ship autonomous navigation, the complex changes of the external environment lead to unknown statistical characteristics of star sensor measurement noise, which brings the estimation results of standard Kalman filtering divergence, and gyroscope on-line calibration cannot be effectively carried out. In view of the above problems, this paper proposed a gyroscope on-line calibration method assisted by star sensor based on forgetting factor selection of a Sage-Husa filter. According to the angular velocity, the output of gyroscope, and quaternion obtained from star sensor, the system error model with unknown noise statistical characteristics is established. Based on the judgment method of fuzzy logic, the error quaternion is used as the input, and the fuzzy rule is used to select the parameters of the adaptive filtering. Therefore, the measurement noise parameters of the filter are constantly estimated and corrected. Finally, the algorithm is verified by simulation test. The simulation results show that the proposed method can effectively estimate the gyroscope drift, scale factor under the case of changes in the external environment, and improve the accuracy and applicability of the navigation system.