| Wu Helong(吴和龙)* **,Pei Xinbiao*,Li Jihui* **,Gao Huibin*,Bai Yue*.[J].高技术通讯(英文),2020,26(2):125~135 |
|
| Attitude estimation method based on extended Kalman filter algorithm with 22 dimensional state vector for low-cost agricultural UAV |
| |
| DOI：doi：10.3772/j.issn.1006-6748.2020.02.001 |
| 中文关键词: |
| 英文关键词: coaxial sixteen-rotor unmanned aerial vehicle (UAV), extended Kalman filter (EKF), quaternion, low-cost |
| 基金项目: |
| Author Name | Affiliation | | Wu Helong(吴和龙)* ** | (*Changchun Institute of Optics， Fine Mechanics and Physics， Chinese Academy of Sciences， Changchun 130033， P.R.China)
(**University of Chinese Academy of Sciences， Beijing 100049， P.R.China) | | Pei Xinbiao* | (*Changchun Institute of Optics， Fine Mechanics and Physics， Chinese Academy of Sciences， Changchun 130033， P.R.China) | | Li Jihui* ** | (*Changchun Institute of Optics， Fine Mechanics and Physics， Chinese Academy of Sciences， Changchun 130033， P.R.China)
(**University of Chinese Academy of Sciences， Beijing 100049， P.R.China) | | Gao Huibin* | (*Changchun Institute of Optics， Fine Mechanics and Physics， Chinese Academy of Sciences， Changchun 130033， P.R.China) | | Bai Yue* | (*Changchun Institute of Optics， Fine Mechanics and Physics， Chinese Academy of Sciences， Changchun 130033， P.R.China) |
|
| Hits: 1532 |
| Download times: 1286 |
| 中文摘要: |
| |
| 英文摘要: |
| To overcome the shortcomings of traditional artificial spraying pesticides and make more efficient prevention of diseases and pests, a coaxial sixteen-rotor unmanned aerial vehicle (UAV) with pesticide spraying system is designed. The coaxial sixteen-rotor UAV’s basic structure and attitude estimation method are explained. The whole system weights 25kg, cruising speed can reach 15m/s, and the flight time is more than 20 min. When the UAV takes large load, the traditional extended Kalman filter (EKF) attitude estimation method can not meet the work requirements under the condition of strong vibration, the attitude measure accuracy is poor and the attitude angle divergence is easily caused. Hence an attitude estimation method based on EKF algorithm with 22 dimensional state vector is proposed which can solve these problems. The UAV system consists of STM32F429 as controller, integrating following measure sensors: accelerometer and gyroscope MPU6000, magnetometer LSM303D, GPS NEO-M8N and barometer. The attitude unit quaternion, velocity, position, earth magnetic field, biases error of gyroscope, accelerometer and magnetometer are introduced as the inertial navigation systems (INS) state vector, while magnetometer, global positioning system (GPS) and barometer are introduced as observation vector, thus making the estimate of the navigation information more accurate. The control strategy of coaxial sixteen-rotor UAV is based on the control method of combining active disturbance rejection control (ADRC) and proportion integral derivative (PID) control. Actual flight data are used to verify the algorithm, and the static experiment shows that the precision of roll angle and pitch angle of the algorithm are ±0.1°, the precision of yaw angle is ±0.2°. The attitude angle output of MTi sensor is used as reference. The dynamic experiment shows that the accuracy of attitude estimated by EKF algorithm is quite similar to that of MTi’s output, moreover, the algorithm has good real-time performance which meets the need of high maneuverability of agricultural UAV. |
|
View Full Text
View/Add Comment Download reader |
| Close |
|
|
|
