Dong-fu XU, Yue BAI, Xun GONG, et al. Correction of 3-axis magnetic compass in multi-rotor UAV under variable control amounts[J]. Optics and precision engineering, 2016, 24(8): 1940-1947.
DOI:
Dong-fu XU, Yue BAI, Xun GONG, et al. Correction of 3-axis magnetic compass in multi-rotor UAV under variable control amounts[J]. Optics and precision engineering, 2016, 24(8): 1940-1947. DOI: 10.3788/OPE.20162408.1940.
Correction of 3-axis magnetic compass in multi-rotor UAV under variable control amounts
To use effectively the magnetic compass in a multi-rotor Unmanned Aerial Vehicle(UAV) in special environments
this paper researches the magnetic deviation correction method when it works at a large current and a variable control amount. Firstly
the variation patterns of magnetic deviation were derived and an error model was established. The relationship between hard magnetic error and the control amount was also analyzed. Then
a spatial linear fitting method was proposed based on Total Least Square (TLS). Finally
the relationship between hard magnetic error and control amount was adopted to implement the hard magnetic compensation of the UAV. In this way
the magnetic deviation was adaptively compensated and the compass was corrected in real time. Experimental results indicate that the hard magnetic deviation from the changed control amount can be counteracted by proposed method
and the yaw error of the UAV reduces from 15°to less than 3°during the flight. It concludes that the method proposed in this paper effectively corrects the yaw error of the magnetic compass when it works at the high current and large control amount and the navigation accuracy and capability to variable loads of the UAV is improved greatly.
QIU M SH, JIANG B, XU D ZH, et al.. Robust dynamics surface fault tolerant control design for attitude control systems of UAV[J].Systems Engineering and Electronics, 2014, 36(9): 1798-1803.
GONG X, BAI Y, ZHAO CH J, et al.. Hex-Rotor aircraft and its autonomous flight control system [J]. Opt. Precision Eng., 2012, 20(11): 2450-2458. (in Chinese)
ZHANG X, BAI Y, ZHAO CH J, et al.. Improved adaptive extended Kalman algorithm for attitude estimation of multi-rotor UAV [J]. Opt. Precision Eng., 2014, 22(12): 3384-3390. (in Chinese)
SEBESTA K D, BOIZOT N. A real-time adaptive high-gain EKF, applied to a quadcopter inertial navigation system [J].IEEE Transactionson Industrial Electronics, 2014, 61(1): 495-503.
GRZONKA S, GRISETTI G, BURGARD W. A fully autonomous indoor quadrotor[J].Robotics, IEEE Transactions on, 2012, 28(1): 90-100.
FANG J, SUN H, CAO J, et al.. A novel calibration method of magnetic compass based on ellipsoid fitting[J]. Instrumentation and Measurement, IEEE Transactions on, 2011, 60(6): 2053-2061.
MARKOVIC R, KRAJNC A, MATKO D. Calibration of a solid-state magnetic compass using angular-rate information from low-cost sensors[J]. Science, Measurement & Technology, IET, 2011, 5(2): 54-58.
LI M, ROUF V T, THOMPSON M J, et al..Three-axis Lorentz-force magnetic sensor for electronic compass applications[J].Microelectromechanical Systems, Journal of, 2012, 21(4): 1002-1010.
FARAJIDAVAR A, BLOCK J M, GHOVANLOO M. A comprehensive method for magnetic sensor calibration: A precise system for 3-D tracking of the tongue movements[C].Engineering in Medicine and Biology Society (EMBC), 2012 Annual International Conference of the IEEE. IEEE, 2012: 1153-1156.
CAI T J, LIU Y, SONG J, et al.. Embedded integrated GPS/MIMU/compass navigation system[J]. Chinese Journal of Scientific Instrument, 2010, 31(12): 2695-2699.
LIU SH B, Study on automatic magnetic deviation compensation of mafntic heading measurement for UAV [J]. Acta Aeronautica et Astronautica Sinica, 2007, 28(2): 411-414.
MARKOVIC R, KRAJNC A, MATKO D. Calibration of a solid-state magnetic compass using angular-rate information from low-cost sensors[J]. Science, Measurement & Technology, IET, 2011, 5(2): 54-58.
DING K, SHENG Y, OU J K. Methods of line-fitting based on total least-squares [J]. Journal of Liaoning Technical University (Natural Science), 2010, 29(1): 44-47.
HAN F J, XU J, SONG SH ZH. Adaptive attitude estimation filtering with low-cost multi-sensors for MAHRS[J]. Opt. Precision Eng., 2011, 19(12): 3007-3015.