Attitude Calculation Method Based on CPF-EKF for Large Load Plant Protection UAV

WU Helong, BAI Yue, PEI Xinbiao, MA Ping, PENG Cheng, GAO Huibin

Abstract

In order to solve the shortcomings of traditional artificial spraying pesticides and more efficient prevention and treatment of diseases and pests, a pesticide spraying system based on sixteen rotor unmanned aerial vehicle (UAV) was designed. The sixteen-rotor UAV’s basic structure and attitude calculation method were explained. The whole system was full of 10kg, cruising speed can reach 5m/s, and the flight time was more than 10min. The traditional extended Kalman filter (EKF) attitude calculation method cannot meet the work requirements under the strong vibration condition of the large load UAV. The attitude angle calculation accuracy was not high and the attitude angle divergence was easily caused. A CPF-EKF algorithm based on 20 dimensional state quantity was proposed. The bias error of gyroscopes, accelerometers and magnetometers were added as the state quantity, which made the optimal estimation of the attitude angle of the three axes more accurate. Complementary filtering (CPF) was treated as an EKF detection module. When the EKF had the divergence trend, the EKF was reset, thus the EKF divergence was avoided simply and efficiently. Using actual flight data to verify the algorithm, the static experiment showed that the precision of the roll angle and the pitch angle of the algorithm were ±0.05°, the precision of the yaw angle was±0.2°. The dynamic experiment showed that the precision of the roll angle and the pitch angle of the algorithm were±0.1°, the precision of the yaw angle was±0.5°, and the algorithm had good real-time performance.


Keywords: sixteen-rotor UAV, pesticide spraying system, extended Kalman filter, complementary filtering


Download Full Text:

PDF


References


ZHANG Dongvan, LAN Yubin, CHEN Liping,et al. Research progress and prospect of agricultural aviation application technology in China[J/OL]. Transactions of the Chinese Society for Agricultural Machinery, 2014, 45 ( 10) : 53 -59. (in Chinese)

2013,44(5): 194 -201. http:www. j- csam. org/jcsam/ch/reader/viev_abstract, aspx? flag = l&file_no = 20130534&journal_id = jcsam. DOI: 10. 6041/j. issn. 1000- 1298.2013.05.034.

XUE Xinvu, LAN Yubin. Analysis of status and development trend of American agriculture aviation technology [ J/OL ]. Transactions of the Chinese Society for Agricultural Machinery, 2013,44(5) ; 194 -201. (in Chinese)

http: //www. j-csam. org/jcsam/ch/reader/view_abstract. aspx? flag = l&file_no = 20160103&journal_id = jcsam. DOI: 10. 6041/j. issn. 1000-1298.2016.01.003. WANG Ling, LAN Yubin, HOFFMANN W , et al. Design of variable spraying system and influencing factors on droplets deposition of small UAV[J/OL]. Transactions of the Chinese Society for Agricultural Machinery, 2016, 47( 1 ) ; 15 -22. (in Chinese)

http://www.j-csam.org/jcsam/ch/reader/view_abslract. aspx? flag = l&file_no = 20160101 &journal_id = jcsam. 001:10.6041/ j. issn. 1000-1298.2016.01.001. XU Dongfu, BAI Yue, GONG Xun, et al. Design of trichogramma delivering system based on hex-rotor UAV [J/OL]. Transactions of the Chinese Society for Agricultural Machinery, 2016, 47 ( 1 ) : 1 - 7. (in Chinese)

ZHANG Dong, JIAO Songming, LIU Yanquan. Fused attitude estimation algorithm based on complementary filtering and Kalman filtering [ J ]. Transducer and Mircrosystem Technologies ,2017 ,36 ( 3 ) ;62 -69. (in Chinese)

CHEN Mengvuan, XIE Yijian, CHEN Yuedong. Attitude estimation of MEMS based on improved quaternion complementer! filter [ [J ]. Journal of Electronic Measurement and Instrumentation ,2015 ,29( 9 ) : 1391 - 1397. (in Chinese)

ZHANG Xin, BAI Yue, ZHAO Changjun, et al. Improved adaptive extended Kalman algorithm for attitude estimation of multi-rotor UAV[J]. Optics and Precise Engineering, 2014, 22(12) :3384 -3390. (in Chinese)

PENG Cheng. On the attitude and trajectory tracking control for a coaxial eight-rotor unmanned aircraft [ D ] . Changchun: Jilin University, 2015. ( in Chinese)

XU Dongfu,PEI Xinbiao, BAI Yue, el al. Altitude information fusion method for unmanned aerial vehicles[J]. High Technology Letters, 2017, 23(2) : 165 - 172.

ZHANG С Y. Approach to adaptive filtering algorithm [J]. Acta Aeronauticaet Astronautica Sinica, 1998, 19 ( Supp. 1 ) ;97 - 100. (in Chinese)

http://www.j-csam. org/jcsam/ch/reader/view_abstract. aspx? flag = l&file_no = 20120609&joumal_id = jcsam. DOI: 10. 6041/j. issn. 1000- 1298.2012.06.009. RU Yu,JIA Zhicheng,FAN Qingni,et al. Remote control spraying system based on unmanned helicopter[ J/OL]. Transactions of the Chinese Society for Agricultural Machinery ,2012 ,43 (6 ) : 47 -52. (in Chinese)

SAGE A P, HUSA G W. Adaptive filtering with unknown prior statist [C] // Proceeding of the Joint Automatic Control Conference, 1969; 760 -769.

DOU Jingxin, KONG Xiangxi, WEN Bangchun. Backstepping sliding mode active disturbance rejection control of quadrotor attitude and its stability [ J ]. Journal of Northeastern University ,2016 ,37 ( 10) : 1415 - 1420. (in Chinese)

http://www. j-csam. org/jcsam/ch/reader/view_abstract, aspx? flag = l&file_no = 20130535&journal_id = jcsam. D01:10. 6041/j. issn. 1000-1298.2013.05.035.LI Jiyu,ZHANG Tiemin,PENG Xiaodong,et al. The field location information collection platform design based on the four-rotor aircraft [J ]. Transactions of the Chinese Society for Agricultural Machinery ,2013 ,44( 5 ) ; 202 -206. ( in Chinese)

2017,48(9) : 17 - 23. http; //www. j-csam. org/jcsam/ch/reader/view_abstract. aspx? flag = l&file_no = 20170902&journal_id = jcsam. DOI: 10. 6041/j. issn. 1000-1298.2017.09.002.

MI AO Cunxiao, CHU Huanxin, SUN Zhihui, et al. Wheel turning angle measurement system based on double GNSS antennas and single gyro[ J ]. Transactions of the Chinese Society for Agricultural Machinery ,2017 ,48 (9 ) : 17 -23. (in Chinese)

GONG Xun, BAI Yue, ZHAO Changjun, et al. Novel Hex — rotor aircraft and its autonomous flight control system [J ]. Optics and Precise Engineering, 2012 ,20( 11): 1995 - 2002. (in Chinese)

ZHANG Wen, SUN Ruisheng. Research on performance comparison of EKF and UKF and their application [J]. Journal of Nanjing University of Science and Technology ,2015 ,39 ( 5 ) : 614 -618. (in Chinese)

http: // www. j-csam. org/jcsam/ch/reader/view_abstract. aspx? flag = 1 &file_no = 20150501 &journal_id = jcsam. DOI; 10. 6041/ j. issn. 1000-1298.2015.05.001.

ZHAO Dean, JIA Weikuan, ZHANG Yun, et al. Design of agriculture robot autonomous navigation control based on improved self-adaptive filter [ J/OL ]. Transactions of the Chinese Society for Agricultural Machinery ,2015 ,46 ( 5 ) ;1 -6. (in Chinese)

XU Yazhao, HE Qiusheng, WANG Shaojiang, et al. An improved adaptive Kalman filtering algorithm[ J ]. Journal of Taiyuan University of Science and Technology ,2016 ,37( 3 ) : 163 - 168. (in Chinese)


Refbacks

  • There are currently no refbacks.