Monday, March 14, 2022

How does Inertial Positioning Solve the Problem of Gyroscope Drift and Magnetic Field Interference?

In order to solve the problems of integral error and magnetic field interference of gyroscope and electronic compass in attitude calculation of navigation system, a fusion algorithm of Kalman filter and complementary filter was proposed. First, the electronic compass and gyroscope are obtained through the Kalman filter to obtain the optimally estimated quaternion. Then, the complementary filtering algorithm is used to compensate for the drift of the gyroscope to obtain the corrected quaternion. Then, the obtained quaternion and Kalman filters are used to obtain the optimally estimated quaternion, and the second optimal estimation of the quaternion is conducted through the Kalman filter. Then output attitude Angle. The results of the proposed algorithm, the complementary filtering algorithm, and the non-filtering algorithm are compared in the experiment. Experiments show that the algorithm can not only effectively solve the divergence of azimuth error, but also effectively solve the magnetic field interference, and achieve high precision azimuth output.

For more info Ericco Gyro Sensor.

With the development of miniaturized inertial devices represented by MEMS (Micro-Electromechanical Systems) sensors, the inertial positioning technology based on strapdown inertial navigation principle and MEMS sensors is increasingly paid attention to. Especially in indoor, underground, mine, underwater, battlefield, and other occasions where satellite signals are difficult to receive [1].In view of the above problems, the electronic compass is often used to correct the gyro. In the indoor, underground, mine, underwater, and other processes, the magnetometer is more prone to interference, resulting in greater deviation of orientation. To solve the problems of magnetometer vulnerable to interference and gyro integral drift, there have been numerous fusion algorithms, such as Kalman filter, untracked Kalman filter (UKF), extended Kalman filter (EKF), etc. [2-4]. These filtering methods need to establish accurate state equations and observation equations. There is another filtering algorithm that extends on the basis of complementary filterings, such as classical complementary filtering and complementary filtering algorithm based on gradient descent method [3-6]. However, the accuracy of this filtering algorithm is not high. Face these problems, this paper proposes an inertial positioning algorithm of Kalman filtering and complementary filtering fusion, the algorithm in the design of Kalman filter, the accelerometer and magnetometer fusion of quaternion as observed value, using the gyroscope of a quaternion as a status value, through the data fusion filtering, complete the quaternion optimal estimate for the first time, For the gyro drift problem, the designed complementary filter is used to compensate the gyro drift, and the corrected angular velocity is obtained, and then the continuously updated quaternion after correction is obtained. Then, the optimal estimation quaternion completed at the first time is estimated through the second Kalman filter, and then the high-precision attitude angle is output.

If interested, pls contact us: info@ericcointernational.com.

No comments:

Post a Comment

Choose a suitable IMU to make your drone flight more stable and safe

         As one of the core components of drones, IMU plays an irreplaceable role. Its high precision, fast response and freedom from extern...