Electronic compass with self-adaptive azimuth angle correction function

Abstract

The invention discloses an electronic compass with a self-adaptive azimuth angle correction function, which belongs to the technical field of electronic compasses and comprises an environment sensing layer, a data processing layer, a fusion algorithm layer and an output and application layer. The environment sensing layer comprises a multi-axis magnetometer array, an attitude sensor group and a data synchronization module, the data processing layer comprises a dynamic interference detection module and a reference model construction module, and the fusion algorithm layer comprises a hybrid filter engine and a dynamic weight distributor. And the output and application layer comprises tilt compensation, azimuth angle calculation and a multi-protocol interface. According to the method, conventional dynamic noise is processed through the extended Kalman filter, and sudden interference is handled through resampling of the particle filter, so that the azimuth angle has an error lt under 100 [mu] T transient interference; the weight of the sensor is adjusted in real time based on the magnetic field gradient, and systematic deviation caused by failure of a single sensor is avoided.

Images